Manipulator should publish the current joint velocity now instead of the commanded one