diff --git a/jsk_unitree_robot/jsk_unitree_startup/scripts/unitree_service.py b/jsk_unitree_robot/jsk_unitree_startup/scripts/unitree_service.py index 9fc5c76498..1f418aad8c 100755 --- a/jsk_unitree_robot/jsk_unitree_startup/scripts/unitree_service.py +++ b/jsk_unitree_robot/jsk_unitree_startup/scripts/unitree_service.py @@ -101,6 +101,7 @@ def body_pose(self, pose): q = pose.orientation msg = HighCmd() msg.mode = 1 + msg.bodyHeight = pose.position.z msg.euler = tf.transformations.euler_from_quaternion([q.x, q.y, q.z, q.w]) # RPY self.highlevel_pub.publish(msg) return