|
|
|
@ -41,7 +41,7 @@
@@ -41,7 +41,7 @@
|
|
|
|
|
#include "rotation.h" |
|
|
|
|
|
|
|
|
|
__EXPORT void |
|
|
|
|
get_rot_matrix(enum Rotation rot, math::Matrix<3,3> *rot_matrix) |
|
|
|
|
get_rot_matrix(enum Rotation rot, math::Matrix<3, 3> *rot_matrix) |
|
|
|
|
{ |
|
|
|
|
float roll = M_DEG_TO_RAD_F * (float)rot_lookup[rot].roll; |
|
|
|
|
float pitch = M_DEG_TO_RAD_F * (float)rot_lookup[rot].pitch; |
|
|
|
@ -199,5 +199,10 @@ rotate_3f(enum Rotation rot, float &x, float &y, float &z)
@@ -199,5 +199,10 @@ rotate_3f(enum Rotation rot, float &x, float &y, float &z)
|
|
|
|
|
y = -y; |
|
|
|
|
return; |
|
|
|
|
} |
|
|
|
|
case ROTATION_PITCH_90_YAW_180: { |
|
|
|
|
tmp = x; x = z; z = tmp; |
|
|
|
|
y = -y; |
|
|
|
|
return; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|