MAVLink data integration to Prop_A

Added MAVLink compatible data structures to quaternion_flight. Minor
changes in flight controls in SENSOR_TEST. Will publish
Quaternion_Flight and Sensor_Test to Prop_A and Prop_B in near future.
Need to integrate save functions and data sharing between props