Function navtk::navutils::d_sensor_to_platform_pos_wrt_q
Defined in File derivatives.hpp
Function Documentation
-
Matrix navtk::navutils::d_sensor_to_platform_pos_wrt_q(const Vector4 &q_s_to_n, const Vector3 &l_ps_p, const Matrix3 &C_p_to_s)
Derivative of a ‘sensor to platform’ position lever arm correction, wrt the reference to sensor quaternion.
- Parameters
q_s_to_n – Sensor to reference quaternion.
l_ps_p – Platform to sensor lever arm, in the platform frame (meters).
C_p_to_s – Platform to sensor orientation (sensor mount DCM).
- Returns
Derivative (3x4) of the position translation, wrt
q_s_to_n.