如何解决ROBIRG迷宫中特定位置右侧无墙导致的无限循环问题？

问题背景 #

现有5×5规格的ROBIRG迷宫，机器人初始位置与朝向随机。当前导航代码存在缺陷：当机器人处于(4,3)、(4,4)、(3,3)、(3,4)这四个位置且右侧无墙时，会陷入无限循环。

当前代码如下：

辅助转向函数 #

def turn_right():
    turn_left()
    turn_left()
    turn_left()    

主导航逻辑 #

# ROBIRG迷宫为5×5规格
# 机器人在迷宫中的初始位置与朝向随机
while not at_goal():       # 机器人到达终点前，循环持续运行
    if right_is_clear():   # 机器人检测右侧是否无障碍物，若是则右转  
        turn_right()
        move()             # 问题：上述四个位置右侧无墙时，机器人会反复执行右转+移动，陷入循环
    elif front_is_clear():
        move()
    else:
        turn_left()   
        if wall_in_front():
            turn_left()
        else:
            move()

问题根源 #

原逻辑的核心问题是：在这四个位置，机器人的右侧路径是“回头路”，但代码没有判断目标位置是否已访问过，导致机器人反复在同一段路径往返，触发无限循环。

解决方案 #

方案一：记录已访问位置（通用型） #

通过维护一个已访问位置的集合，在准备向右移动前，先判断目标位置是否已经去过。如果是，则跳过右转操作，避免重复路径。

修改后的代码如下：

def turn_right():
    turn_left()
    turn_left()
    turn_left()    

# 初始化已访问集合，记录机器人走过的位置
visited = set()
# 假设get_position()返回(x,y)格式的当前坐标，比如(4,3)
current_pos = get_position()
visited.add(current_pos)

while not at_goal():
    current_pos = get_position()
    if current_pos not in visited:
        visited.add(current_pos)
    
    if right_is_clear():
        # 计算右转后移动一步的目标坐标，需根据机器人朝向规则实现get_right_position()
        right_target = get_right_position()
        if right_target not in visited:
            turn_right()
            move()
            continue
    # 右侧为已访问路径或有墙，优先尝试向前
    if front_is_clear():
        front_target = get_front_position()
        if front_target not in visited:
            move()
            continue
    # 前方和右侧都无法通行，尝试左转调整方向
    turn_left()
    if front_is_clear():
        move()
    else:
        # 左转后仍有墙，直接掉头
        turn_left()

关键补充实现说明

• get_position()：返回机器人当前的(x,y)坐标
• get_right_position()：根据当前朝向计算右转后一步的坐标，示例规则：
  • 朝向上时，右侧为右，目标坐标(x+1, y)
  • 朝向右时，右侧为下，目标坐标(x, y-1)
  • 朝向下时，右侧为左，目标坐标(x-1, y)
  • 朝向左时，右侧为上，目标坐标(x, y+1)
• get_front_position()：同理，计算当前朝向正前方一步的坐标

方案二：调整移动优先级（简化型，仅适配当前迷宫） #

如果不想维护访问集合，可以调整移动逻辑的优先级：优先向前移动，再考虑右侧，最后左转。这种方式能让机器人在目标位置优先选择向前路径，避免反复右转。

def turn_right():
    turn_left()
    turn_left()
    turn_left()    

while not at_goal():
    if front_is_clear():
        move()
    elif right_is_clear():
        turn_right()
        move()
    else:
        turn_left()

注意：该方案仅适用于当前指定的迷宫布局，通用性不如方案一。

内容的提问来源于stack exchange，提问作者Akshay Sandipog