RobWork/ROS servoing method