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

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+