refactor(base_move): improve horizontal line alignment and task 1 execution
- Simplify the horizontal line alignment process in move_base_hori_line.py - Update task_1.py to use the improved alignment function for better accuracy
This commit is contained in:
parent
5d586c2999
commit
28254f23c1
@ -91,17 +91,12 @@ def align_to_horizontal_line(ctrl, msg, observe=False, max_attempts=3):
|
||||
info(f"计算旋转角度: {angle_to_rotate:.2f}度", "角度")
|
||||
info(f"当前累积旋转: {accumulated_angle:.2f}度", "累积")
|
||||
|
||||
<<<<<<< HEAD
|
||||
# 使用turn_degree函数执行旋转,增加精度参数
|
||||
info(f"旋转角度: {angle_to_rotate:.2f}度", "旋转")
|
||||
turn_success = turn_degree(ctrl, msg, angle_to_rotate, absolute=False, precision=True)
|
||||
info(f"旋转结果: {turn_success}", "旋转结果")
|
||||
|
||||
# 等待稳定
|
||||
=======
|
||||
# 执行旋转
|
||||
turn_success = turn_degree(ctrl, msg, angle_to_rotate, absolute=False, precision=True)
|
||||
>>>>>>> 6b15e9be908cb3e330a29e326449540f312dec4e
|
||||
time.sleep(0.3)
|
||||
|
||||
# 计算实际旋转角度
|
||||
|
@ -24,10 +24,10 @@ def run_task_1(ctrl, msg):
|
||||
section('任务1:寻找横线并绕行', "启动")
|
||||
info('开始执行任务1...', "启动")
|
||||
|
||||
# # TEST better align
|
||||
# aligned = align_to_horizontal_line(ctrl, msg, observe=observe)
|
||||
# print(aligned)
|
||||
# return
|
||||
# TEST better align
|
||||
aligned = align_to_horizontal_line(ctrl, msg, observe=observe)
|
||||
print(aligned)
|
||||
return
|
||||
|
||||
# v2
|
||||
section('任务1-1:转弯并扫描QR码', "移动")
|
||||
|
Loading…
x
Reference in New Issue
Block a user