Added support for velocity setpoint in mavlink_receiver and mc_pos_control