SO(3) estimator and quaternion receive by mavlink implemented
SO3 estimator code has been cleaned