mc_pos_control: max position setpoint offset limiting fixed