Cleaned up a bit.
Removed complimentary filter from send_quaternion()
Added GetAttitude callback
Added send_yaw_pitch_roll
added GetAttitude callback