[jsk_unitree_startup] Fix body pose to enavle up-and-down motion

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