SO(3) estimator and quaternion receive by mavlink implemented
SO3 estimator code has been cleaned
Merge pull request #541 from limhyon/master

SO(3) estimator has been debugged and cleaned.