Added convert Mavlink Command -> ROS Command
Added ability to receive commands from a ground station (untested)