Added missing global_vel_sp_sub in mc_pos_control
Added missing OFFB_TH parameter
Added NaN checks for global velocity setpoints.