Mavlink data

* Fixed some bad scaling and units
* Added more data
* Tested on quanton