修改钢针到达抓料点位后再收缩和在震动点不走的问题

2025-02-27 13:16:55 +08:00
parent d1d0d1a5e5
commit a9cce7ec3a
8 changed files with 2272 additions and 36 deletions
--- a/Model/Position.py
+++ b/Model/Position.py
@ -10,6 +10,10 @@ class Position:
        self.U = 0.0
        self.V = 0.0
        self.W = 0.0
+        self.a = 0.0
+        self.b = 0.0
+        self.c = 0.0
+

    def compare(self,position,is_action=False):
        distance = math.sqrt((self.X-position.X)**2+