WIP: Mavlink data

* Fixed some bad scaling and units
* Added more data