修复控制

robot_client/robots/realman/motors_bus.py

@@ -224,11 +224,9 @@ class RealmanMotorsBus(MotorsBus):
             values = list(actionData.values())
             for k,v in enumerate(self.init_pose):
                 self.init_pose[k]+=values[k]
-            values[-1]
-            self.rmarm.rm_movev_canfd(self.init_pose[:6])
-            #把夹爪的输入范围-1到1映射为0到1
-            gripper = (actionData['gripper']+1)/2
-            self.rmarm.rm_set_gripper_position(gripper*1000, False)
+            self.rmarm.rm_movej_p(self.init_pose[:-1], 50, 0, 0, 0)
+            self.init_pose[6]+=actionData['gripper']
+            self.rmarm.rm_set_gripper_position(self.init_pose[6]*1000, False)
     
     def sync_read(self, data_name, motors = None, *, normalize = True, num_retry = 0):
         if data_name == "Present_Position":