Configuration control, generate end effector forces to compensate dynamics