From 2265b1c89343cd615c1138fff67e29bcc2d8c1e1 Mon Sep 17 00:00:00 2001
From: swayneleong <15723182159@163.com>
Date: Wed, 28 May 2025 19:24:48 +0800
Subject: [PATCH] =?UTF-8?q?=E6=9A=82=E5=AD=98?=
MIME-Version: 1.0
Content-Type: text/plain; charset=UTF-8
Content-Transfer-Encoding: 8bit

---
 Massage/MassageControl/algorithms/arm_state.py | 1 +
 Massage/MassageControl/hardware/dobot_nova5.py | 6 ++++++
 2 files changed, 7 insertions(+)

diff --git a/Massage/MassageControl/algorithms/arm_state.py b/Massage/MassageControl/algorithms/arm_state.py
index 4fd4147..bf62988 100644
--- a/Massage/MassageControl/algorithms/arm_state.py
+++ b/Massage/MassageControl/algorithms/arm_state.py
@@ -25,6 +25,7 @@ class ArmState:
         self.desired_wrench = np.zeros(6,dtype=np.float64)
         self.desired_twist = np.zeros(6,dtype=np.float64)
         self.desired_acc = np.zeros(6,dtype=np.float64)
+        self.massage_wrench = np.zeros(6,dtype=np.float64)
 
         # 导纳计算过程变量
         self.arm_desired_twist = np.zeros(6,dtype=np.float64) 
diff --git a/Massage/MassageControl/hardware/dobot_nova5.py b/Massage/MassageControl/hardware/dobot_nova5.py
index 236ef1f..447b9a6 100644
--- a/Massage/MassageControl/hardware/dobot_nova5.py
+++ b/Massage/MassageControl/hardware/dobot_nova5.py
@@ -113,6 +113,12 @@ class dobot_nova5:
         feedback_thread.daemon = True
         feedback_thread.start()
     
+    def disable_servo(self):
+        pass
+
+    def enable_servo(self):
+        pass
+    
     def RunPoint_P_inPose(self,poses_list):
         '''
             RUNPOINT_P 以关节运动方式运动到目标点