https://github.com/jacknlliu/iiwa_stack/blob/dd35ef91c64c72fcdb08ee9798a46629caf424aa/iiwa_ros_java/src/de/tum/in/camp/kuka/ros/ROSSmartServo.java#L425