Merge pull request #420 from AQ-AirWolf/development

Cleaning up MavLink
fixed compilation errors
Updated MavLink:
- Reading/Writing of all parameters works now correctly
- fixed wrong unit conversions in GPS data
- added support for reading/writing waypoints (not working atm cause of timeout issues)

Added invalid altitude to invalid GPS position