refactor(task): 优化任务执行流程和代码结构

- 在 move_base_hori_line.py 中添加了返回中间状态的逻辑,提高了代码的可扩展性
- 优化了 QR 码扫描的处理流程,增强了代码的鲁棒性
- 在 task_1.py 中调整了任务 1 的执行流程,缩短了模拟装货的等待时间
This commit is contained in:
havoc420ubuntu 2025-05-17 03:39:27 +00:00
parent 18248d7ad9
commit 97dd5a22dc
2 changed files with 8 additions and 5 deletions

View File

@ -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}")

View File

@ -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()