Refactor: Changing from LatLng to Coord2D
Core: Adding method to mavlink interface