fixing manipulatorDynamics bug