mirror of
https://github.com/SHC-ASTRA/rover-ros2.git
synced 2026-04-20 11:51:16 -05:00
fix: (arm) )add timestamp to Socket voltages, change while: pass to thread.join()
This commit is contained in:
@@ -124,8 +124,7 @@ class ArmNode(Node):
|
|||||||
thread.start()
|
thread.start()
|
||||||
|
|
||||||
try:
|
try:
|
||||||
while rclpy.ok():
|
thread.join()
|
||||||
pass
|
|
||||||
except KeyboardInterrupt:
|
except KeyboardInterrupt:
|
||||||
pass
|
pass
|
||||||
|
|
||||||
@@ -252,6 +251,7 @@ class ArmNode(Node):
|
|||||||
self.arm_feedback_new.socket_voltage.v12 = float(msg.data[1]) / 100.0
|
self.arm_feedback_new.socket_voltage.v12 = float(msg.data[1]) / 100.0
|
||||||
self.arm_feedback_new.socket_voltage.v5 = float(msg.data[2]) / 100.0
|
self.arm_feedback_new.socket_voltage.v5 = float(msg.data[2]) / 100.0
|
||||||
self.arm_feedback_new.socket_voltage.v3 = float(msg.data[3]) / 100.0
|
self.arm_feedback_new.socket_voltage.v3 = float(msg.data[3]) / 100.0
|
||||||
|
self.arm_feedback_new.socket_voltage.header.stamp = msg.header.stamp
|
||||||
case 55: # Arm joint positions
|
case 55: # Arm joint positions
|
||||||
angles = [angle / 10.0 for angle in msg.data] # VicCAN sends deg*10
|
angles = [angle / 10.0 for angle in msg.data] # VicCAN sends deg*10
|
||||||
# Joint state publisher for URDF visualization
|
# Joint state publisher for URDF visualization
|
||||||
|
|||||||
Reference in New Issue
Block a user