fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-05-01 12:14:07 +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
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
src/lib/conversion/rotation.cpp
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;
}
}
}

2
src/lib/conversion/rotation.h
View File

@ -82,6 +82,7 @@ enum Rotation {
ROTATION_PITCH_90_ROLL_270 = 31,
ROTATION_PITCH_9_YAW_180 = 32,
ROTATION_PITCH_45 = 33,
ROTATION_PITCH_315 = 34,
ROTATION_MAX
};
@ -126,6 +127,7 @@ const rot_lookup_t rot_lookup[] = {
{270, 90, 0 },
{ 0, 9, 180 },
{ 0, 45, 0 },
{ 0, 315, 0 },
};
/**