Added code for propagation of the quaternion and estimate stage of the MEKF