changed quaternion declaration from float-array to Quaternion, also for the functions - not tested yet
changes to quaternion implementation and prepared messages for verification
working new quaternion control (=tested on Pixhawk)