加入了关节软限位和控制话题字段

config/joint_motion_limit.yaml

@@ -0,0 +1,46 @@
+arm_joint_limits:
+  right_arm:
+    joint_1:
+      vec: 4
+      acc: 4
+    joint_2:
+      vec: 4
+      acc: 4
+    joint_3:
+      vec: 4
+      acc: 4
+    joint_4:
+      vec: 4
+      acc: 4
+    joint_5:
+      vec: 4
+      acc: 4
+    joint_6:
+      vec: 4
+      acc: 4
+    joint_7:
+      vec: 4
+      acc: 4
+
+  left_arm:
+    joint_1:
+      vec: 4
+      acc: 4
+    joint_2:
+      vec: 4
+      acc: 4
+    joint_3:
+      vec: 4
+      acc: 4
+    joint_4:
+      vec: 4
+      acc: 4
+    joint_5:
+      vec: 4
+      acc: 4
+    joint_6:
+      vec: 4
+      acc: 4
+    joint_7:
+      vec: 4
+      acc: 4

config/joint_soft_limits.yaml

@@ -0,0 +1,47 @@
+arm_joint_limits:
+  right_arm:
+    joint_1:
+      min: -167
+      max: 167
+    joint_2:
+      min: -4
+      max: 183
+    joint_3:
+      min: -154
+      max: 154
+    joint_4:
+      min: -117
+      max: 117
+    joint_5:
+      min: -154
+      max: 154
+    joint_6:
+      min: -91
+      max: 91
+    joint_7:
+      min: -91
+      max: 91
+
+  left_arm:
+    joint_1:
+      min: -167
+      max: 167
+    joint_2:
+      min: -183
+      max: 4
+    joint_3:
+      min: -154
+      max: 154
+    joint_4:
+      min: -117
+      max: 117
+    joint_5:
+      min: -154
+      max: 154
+    joint_6:
+      min: -91
+      max: 91
+    joint_7:
+      min: -91
+      max: 91
+      

src/msgs/msg/ControlActions.msg

@@ -0,0 +1,6 @@
+std_msgs/Header header
+
+uint64 system_timestamp
+string arm_ip
+
+float64[12]