diff --git a/base_move/move_base_hori_line.py b/base_move/move_base_hori_line.py index 60ec019..c5571d6 100644 --- a/base_move/move_base_hori_line.py +++ b/base_move/move_base_hori_line.py @@ -347,6 +347,10 @@ def arc_turn_around_hori_line(ctrl, msg, angle_deg=90, left=True, target_distanc bool或元组: 如果scan_qrcode为False,返回bool表示是否成功完成操作; 如果scan_qrcode为True,返回(bool, str)元组,表示(是否成功完成操作, QR码扫描结果) """ + + # 返回此任务的中间状态 + res = {} + # 启动异步QR码扫描(如果需要) qr_result = None if scan_qrcode: @@ -388,16 +392,15 @@ def arc_turn_around_hori_line(ctrl, msg, angle_deg=90, left=True, target_distanc camera_height = 0.355 # 单位: 米 r = calculate_distance_to_line(edge_info, camera_height, observe=observe) - - # 减去目标距离 - r -= target_distance - if r is None: print("无法计算到横向线的距离,停止动作") if scan_qrcode: ctrl.image_processor.stop_async_scan() return False, qr_result return False + + # 减去目标距离 + r -= target_distance if observe: print(f"当前距离: {r:.3f}米") diff --git a/task_1/task_1.py b/task_1/task_1.py index 4af1c5b..af550d7 100644 --- a/task_1/task_1.py +++ b/task_1/task_1.py @@ -58,7 +58,7 @@ def run_task_1(ctrl, msg): # move_to_hori_line(ctrl, msg, target_distance=0.6, observe=observe) print('😺 task 1 - 5 休眠,模拟装货') - ctrl.base_msg.lie_down(wait_time=5000) + ctrl.base_msg.lie_down(wait_time=3000) # TODO 比赛时改成 5s # 站起来 ctrl.base_msg.stand_up()