Mavlink/ROS Interface implementation