Merge pull request #11 from ricsp/master

Publish current joint velocity instead of commanded one in manipulator