fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-07-17 00:50:36 +08:00
Code Issues Packages Projects Releases Wiki Activity

conversion: added -45 deg pitch rotation

Browse Source
This commit is contained in:
Andreas Antener
2018-01-05 11:57:58 +01:00
committed by Lorenz Meier
parent add20389f6
commit ab9ee3aa6c
2 changed files with 9 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/lib/conversion/rotation.cpp
+7
View File
@@ -272,5 +272,12 @@ rotate_3f(enum Rotation rot, float &x, float &y, float &z)
x = tmp;
return;
}
case ROTATION_PITCH_315: {
tmp = HALF_SQRT_2 * x - HALF_SQRT_2 * z;
z = HALF_SQRT_2 * z + HALF_SQRT_2 * x;
x = tmp;
return;
}
}
}