A Primer on the Differential Calculus of 3D Orientations
Quaternion kinematics for the error-state KF