mi-task/task_1/task_1.py

26 lines
640 B
Python
Raw Normal View History

2025-05-11 15:44:54 +00:00
import time
import cv2
2025-05-14 11:25:44 +00:00
import sys
import os
2025-05-11 15:44:54 +00:00
2025-05-14 11:25:44 +00:00
# 添加父目录到路径以便能够导入utils
sys.path.append(os.path.dirname(os.path.dirname(os.path.abspath(__file__))))
from base_move.move_base_hori_line import move_to_hori_line, arc_turn_around_hori_line
observe = True
2025-05-14 12:12:57 +00:00
def run_task_1(ctrl, msg):
print('Running task 1...')
2025-05-14 11:25:44 +00:00
# v2
arc_turn_around_hori_line(ctrl, msg, angle_deg=90, left=False, observe=observe)
2025-05-15 12:08:49 +00:00
move_to_hori_line(ctrl, msg, target_distance=1, observe=observe)
arc_turn_around_hori_line(ctrl, msg, angle_deg=180, left=True, observe=observe)
move_to_hori_line(ctrl, msg, observe=observe)
2025-05-11 15:44:54 +00:00