feat: 增加转塔动作

2024-06-15 10:42:41 +08:00
parent 124c2d02ee
commit d9a68d408d
2 changed files with 11 additions and 7 deletions
--- a/subtask.py
+++ b/subtask.py
@@ -523,16 +523,20 @@ class up_tower():
    def exec(self):
        logger.info("找到塔")
        car_stop()
+        time.sleep(1)
        calibrate_new(tlabel.TOWER, offset = 27, run = True)
-        by_cmd.send_light(1)
-        time.sleep(0.5)
-        by_cmd.send_light(0)
+        time.sleep(1)
        # calibrate(tlabel.TOWER, 27, False, 6)
        by_cmd.send_distance_x(-10, 130)
        time.sleep(1)
        by_cmd.send_distance_y(-10, 50)
        time.sleep(3)
-        
+        by_cmd.send_angle_zhuan(10)
+        time.sleep(9)
+        by_cmd.send_distance_y(10, 50)
+        time.sleep(1)
+        by_cmd.send_angle_zhuan(0)
+        time.sleep(1)
        # while True:
        #     pass
        # 下一动作预备位置