Added new messages and services to handle extra APM messages and waypoint/vehicle commands