URGENT bugfix of MAVLink to Coord2D conversion

Fixed some bugs related to MAVlink and our Coord2D Library.

The issue is caused because of the mavlink standard: https://github.com/DroidPlanner/droidplanner/blob/master/Mavlink/mavlinkGenerator/message_definitions/common.xml#L327

We should probably be switching to NED too.