Fixed rounding error
Add some debuging mavlink messages
Use Equation-Of-Motion Matlab function for quaternion integration
Publish electricity status also if no controller runs
MAVLINK parameter for MAX THRUST \n Carefull: There is a bug in matlab allocation where max thrust is not respected.