mc_pos_control: use MPC_XXX_FF to adjust setpoint on reset