From 9ace3b0668eb2315a8defa3a19b8c8f4e0b9ec6b Mon Sep 17 00:00:00 2001 From: yjinzero Date: Thu, 13 Feb 2025 21:57:05 +0900 Subject: [PATCH] debug qlen --- deploy/deploy_real/state_pub.py | 3 +++ 1 file changed, 3 insertions(+) diff --git a/deploy/deploy_real/state_pub.py b/deploy/deploy_real/state_pub.py index 26e4091..9ac4563 100644 --- a/deploy/deploy_real/state_pub.py +++ b/deploy/deploy_real/state_pub.py @@ -41,6 +41,9 @@ class StatePublisher(Node): joint_state.header.stamp = now.to_msg() joint_state.name = self.joint_names joint_state.position = [0.0 for _ in self.joint_names] + + print('a', len(self.joint_names)) + print('b', len(self.low_state.motor_state)) for i in range(len(self.low_state.motor_state)): joint_state.position[i] = self.low_state.motor_state[i].q self.joint_pub.publish(joint_state)