Any-goalbidirectionalA*pathfindingreference
创始人
2024-08-22 08:30:31
0次

双向A算法是一种常用的路径规划算法,如何实现任意起点和终点的双向A算法呢?这里提供一种参考实现:

def any_goal_bidirectional_A_star(start, goals, heuristic_func, neighbor_func, distance_func): # 初始化起点和终点列表 start_to_goals = {goal: [start, float('inf')] for goal in goals} goal_to_starts = {start: [goal, float('inf')] for goal in goals}

# 初始化搜索队列和已经访问过的点集
forward_queue = PriorityQueue()
backward_queue = PriorityQueue()
forward_closed = set()
backward_closed = set()

# 将起点和终点添加到搜索队列中
forward_queue.put(start_to_goals[goals[0]], start_to_goals[goals[0]][1] + heuristic_func(start, goals[0]))
backward_queue.put(goal_to_starts[goals[0]], goal_to_starts[goals[0]][1] + heuristic_func(start, goals[0]))

while not forward_queue.empty() and not backward_queue.empty():
    # 前向搜索一步
    forward_node, forward_f_value = forward_queue.get()
    forward_curr, forward_dist = forward_node
    forward_closed.add(forward_curr)

    # 找到与前向搜索相同的点
    back_node, back_f_value = goal_to_starts.get(forward_curr, [None, float('inf')])
    if back_node is not None:
        # 找到路径
        path = [forward_node[0]]
        while forward_curr != start:
            path.append(start_to_goals[forward_curr][0])
            forward_curr = start_to_goals[forward_curr][0]

        path = list(reversed(path))
        while back_node[0] != start:
            path.append(back_node[0])
            back_node = goal_to_starts[back_node[0]]

        return path

    # 扩展前向搜索节点
    for neighbor in neighbor_func(forward_curr):
        if neighbor in forward_closed:
            continue

        new_dist = forward_dist + distance_func(forward_curr, neighbor)

相关内容

热门资讯

玩家必看透视器!牛将军互娱透视... 玩家必看透视器!牛将军互娱透视器多功能AI攻略,牛将军互娱一直是真的有透视器攻略一、牛将军互娱可以开...
最新研发外挂!嘻嘻娱乐外挂多功... 最新研发外挂!嘻嘻娱乐外挂多功能AI脚本,嘻嘻娱乐原来真的有外挂脚本1、金币登录送、破产送、升级送、...
一分钟教会你辅助器!鲨鱼众娱辅... 一分钟教会你辅助器!鲨鱼众娱辅助器多功能AI攻略,鲨鱼众娱真是有辅助器攻略1、超多福利:超高返利,海...
揭秘几款辅助器!九游互娱辅助器... 揭秘几款辅助器!九游互娱辅助器多功能AI攻略,九游互娱果然真的是有辅助器攻略1、九游互娱公共底牌简单...
每日必看推荐开挂!欢盈娱乐开挂... 每日必看推荐开挂!欢盈娱乐开挂多功能AI软件,欢盈娱乐真是是有开挂软件1、完成欢盈娱乐有辅助插件,帮...
一分钟揭秘透视挂!新久久透视挂... 一分钟揭秘透视挂!新久久透视挂多功能AI教程,新久久原来真的有透视挂教程一分钟揭秘透视挂!新久久透视...
解密关于开挂!大大娱乐开挂多功... 解密关于开挂!大大娱乐开挂多功能AI方法,大大娱乐一直是真的有开挂方法亲,关键说明,大大娱乐透视脚本...
一起来讨论辅助器!卡尔辅助器多... 一起来讨论辅助器!卡尔辅助器多功能AI技巧,卡尔都是有辅助器技巧1、下载好卡尔脚本下载之后点击打开,...
交流学习经验辅助器!闲玩娱乐鱼... 交流学习经验辅助器!闲玩娱乐鱼虾蟹辅助器多功能AI方法,闲玩娱乐鱼虾蟹切实真的有辅助器方法进入游戏-...
程序员教你开挂!传奇互娱开挂多... 程序员教你开挂!传奇互娱开挂多功能AI技巧,传奇互娱确实有开挂技巧1、下载好传奇互娱脚本下载之后点击...