Quat removed, now I am using RMAT.
Neutrals could be probably replaced by BODY_TO_IMU_PHI/THETA, however I dont know about a better way how to implement the mag offset.