Merge pull request #107 from 708yamaguchi/publish-error

Publish error in /servo_states
iory · Nov 4, 2024 · 4beb54f · 4beb54f
2 parents a83c7d0 + f7054d6
commit 4beb54f
Showing 1 changed file with 2 additions and 3 deletions.
diff --git a/ros/kxr_controller/node_scripts/rcb4_ros_bridge.py b/ros/kxr_controller/node_scripts/rcb4_ros_bridge.py
@@ -978,16 +978,15 @@ def publish_joint_states(self):
                 if idx is None:
                     continue
                 position = np.deg2rad(av[idx])
-                effort = torque_vector[idx]
+                effort = np.deg2rad(torque_vector[idx])
                 msg.position.append(position)
                 msg.effort.append(effort)
                 msg.name.append(name)
                 servo_state_msg = ServoState(
                     header=msg.header,
                     name=name,
                     position=position,
-                    error=effort,
-                    temperature=temperatures)
+                    error=effort)
                 if temperatures is not None and len(temperatures) > idx:
                     servo_state_msg.temperature = temperatures[idx]
                 if currents is not None and len(currents) > idx: