working control for position of MPC controller end effector