ROS node uses offsets for desired and actual positions

Tested on Cob3-3