Class with utility methods for body fixed frame conversions.
|
template<typename Ta , typename Tb , typename Tc > |
static void | toBodyFrame (Ta phi, Ta theta, Ta psi, Tb vx, Tb vy, Tb vz, Tc *u, Tc *v, Tc *w) |
|
template<typename Ta , typename Tb , typename Tc > |
static void | toInertialFrame (Ta phi, Ta theta, Ta psi, Tb u, Tb v, Tb w, Tc *vx, Tc *vy, Tc *vz) |
|
template<typename Ta , typename Tb , typename Tc >
static void DUNE::Coordinates::BodyFixedFrame::toBodyFrame |
( |
Ta |
phi, |
|
|
Ta |
theta, |
|
|
Ta |
psi, |
|
|
Tb |
vx, |
|
|
Tb |
vy, |
|
|
Tb |
vz, |
|
|
Tc * |
u, |
|
|
Tc * |
v, |
|
|
Tc * |
w |
|
) |
| |
|
inlinestatic |
Inertial to body frame conversion of linear velocities.
Given the angles of a body in respect to the reference axes (psi, theta, psi) and its inertial frame linear velocities (u_in,v_in,w_in) calculate the body fixed linear velocities (u,v,w).
- Parameters
-
phi | pitch angle |
theta | roll angle |
psi | yaw angle |
vx | linear velocity in x-axis in the inertial frame |
vy | linear velocity in y-axis in the inertial frame |
vz | linear velocity in z-axis in the inertial frame |
u | on return, linear velocity in x-axis in the body-fixed frame |
v | on return, linear velocity in y-axis in the body-fixed frame |
w | on return, linear velocity in z-axis in the body-fixed frame |
template<typename Ta , typename Tb , typename Tc >
static void DUNE::Coordinates::BodyFixedFrame::toInertialFrame |
( |
Ta |
phi, |
|
|
Ta |
theta, |
|
|
Ta |
psi, |
|
|
Tb |
u, |
|
|
Tb |
v, |
|
|
Tb |
w, |
|
|
Tc * |
vx, |
|
|
Tc * |
vy, |
|
|
Tc * |
vz |
|
) |
| |
|
inlinestatic |
Body to inertial frame conversion of linear velocities.
Given the angles of a body in respect to the reference axes (psi, theta, psi) and its body frame linear velocities (u,v,w) calculate the body fixed linear velocities (u_in,v_in,w_in)
- Parameters
-
phi | pitch angle |
theta | roll angle |
psi | yaw angle |
u | linear velocity in x-axis in the body-fixed frame |
v | linear velocity in y-axis in the body-fixed frame |
w | linear velocity in z-axis in the inertial frame |
vx | on return, linear velocity in x-axis in the inertial frame |
vy | on return, linear velocity in y-axis in the inertial frame |
vz | on return, linear velocity in z-axis in the inertial frame |
Referenced by DUNE::Navigation::BasicNavigation::onDispatchNavigation().