Publish current joint velocity instead of commanded one in manipulator

Other minor changes are also contained in these commits (see commit comments)