update 投料逻辑完善

Config/FeedLine.ini

@@ -6,18 +6,6 @@ safeposition_z = 737.267822
 safeposition_u = -2.196312
 safeposition_v = -4.094595
 safeposition_w = -5.294128
-photoposition_x = 534.907898
-photoposition_y = 5.525342
-photoposition_z = 737.267822
-photoposition_u = -2.196312
-photoposition_v = -4.094595
-photoposition_w = -5.294128
-midposition_x = 638.432
-midposition_y = 16.854
-midposition_z = 406.721
-midposition_u = -3.256
-midposition_v = 7.334
-midposition_w = -4.307
 brokenposition1_x = 357.269
 brokenposition1_y = 478.874
 brokenposition1_z = 209.979
@@ -30,24 +18,20 @@ brokenposition2_z = 209.979
 brokenposition2_u = -3.100
 brokenposition2_v = -3.198
 brokenposition2_w = 49.945
+shakeposition_x = 357.269
+shakeposition_y = 478.874
+shakeposition_z = 209.979
+shakeposition_u = -3.100
+shakeposition_v = -3.198
+shakeposition_w = 49.945
 dropBagposition_x = 357.269
 dropBagposition_y = 478.874
 dropBagposition_z = 209.979
 dropBagposition_u = -3.100
 dropBagposition_v = -3.198
 dropBagposition_w = 49.945
-zipBagposition_x = 357.269
-zipBagposition_y = 478.874
-zipBagposition_z = 209.979
-zipBagposition_u = -3.100
-zipBagposition_v = -3.198
-zipBagposition_w = 49.945
-feedposition_x = 315.549
-feedposition_y = 427.090
-feedposition_z = 209.985
-feedposition_u = -2.793
-feedposition_v = -1.829
-feedposition_w = 50.000
+
+
 dropDelay_time = 3
 shakeDelay_time = 6
 [FeedLine2]