\subsection{Rigid body \& IMU kinematics}