百度360必应搜狗淘宝本站头条
当前位置:网站首页 > 技术分析 > 正文

用Python写一个A*搜索算法含注释说明

liebian365 2025-03-04 12:59 9 浏览 0 评论

大家好我是幻化意识流

今天我们用Python写一个A*搜索算法的代码,我做了注释说明,欢迎大家一起学习:

import heapq

# 定义搜索节点类,包括当前状态、从初始状态到该状态的代价g、从该状态到目标状态的估计代价h、父节点、以及在搜索中是否被访问过的状态

class Node:

def __init__(self, state, g_cost, h_cost, parent=None):

self.state = state

self.g_cost = g_cost

self.h_cost = h_cost

self.parent = parent

self.visited = False

# 定义比较操作,用于堆排序时比较两个节点的f值

def __lt__(self, other):

return (self.g_cost + self.h_cost) < (other.g_cost + other.h_cost)

# 定义A*搜索函数,接收初始状态和目标状态作为输入

def astar_search(start_state, goal_state):

# 定义初始节点,初始g值为0,h值为从初始状态到目标状态的估计代价

start_node = Node(start_state, 0, heuristic(start_state, goal_state))

# 定义一个堆,用于存储待扩展的节点

open_heap = []

heapq.heappush(open_heap, start_node)

# 定义一个字典,用于存储已经访问过的节点

visited = {}

while open_heap:

# 取出f值最小的节点

current_node = heapq.heappop(open_heap)

# 如果该节点已经被访问过,则跳过

if visited.get(current_node.state):

continue

# 将该节点标记为已经访问过

current_node.visited = True

visited[current_node.state] = current_node

# 如果当前节点为目标状态,则返回搜索路径

if current_node.state == goal_state:

return get_path(current_node)

# 扩展当前节点

for next_state, cost in get_neighbors(current_node.state):

# 如果下一个状态已经被访问过,则跳过

if visited.get(next_state):

continue

# 计算从初始状态到下一个状态的代价g

g_cost = current_node.g_cost + cost

# 如果下一个状态还没有被访问过,则创建一个新节点

if not any(node.state == next_state for node in open_heap):

next_node = Node(next_state, g_cost, heuristic(next_state, goal_state), current_node)

heapq.heappush(open_heap, next_node)

else:

# 如果下一个状态已经在堆中,则找到对应的节点

next_node = next(node for node in open_heap if node.state == next_state)

# 如果新的g值更优,则更新该节点

if g_cost < next_node.g_cost:

next_node.g_cost = g_cost

next_node.parent = current_node

# 如果搜索完毕,但是没有找到目标状态,则返回空列表

return []

# 定义估价函数,这里使用曼哈顿距离作为估计代价

def heuristic(state, goal_state):

return sum(abs(a - b) for a, b in zip(state, goal_state))

定义获取邻居节点函数,这里使用一个简单的例子来说明

假设状态是一个二维坐标(x,y),邻居节点包括上下左右四个方向上的节点

def get_neighbors(state):

x, y = state

neighbors = []

if x > 0:

neighbors.append(((x-1, y), 1))

if x < 2:

neighbors.append(((x+1, y), 1))

if y > 0:

neighbors.append(((x, y-1), 1))

if y < 2:

neighbors.append(((x, y+1), 1))

return neighbors

定义获取搜索路径函数,从目标状态开始,依次沿着父节点返回到初始状态

def get_path(node):

path = []

while node:

path.append(node.state)

node = node.parent

return path[::-1]

测试代码,假设初始状态为(0,0),目标状态为(2,2)

start_state = (0, 0)

goal_state = (2, 2)

path = astar_search(start_state, goal_state)

print(path)

注释说明:

- 在定义搜索节点类Node时,包括了状态state、代价g_cost、估计代价h_cost、父节点parent以及是否被访问过的状态visited。

- 在定义比较操作`__lt__`时,采用的是节点的f值作为比较依据,即f = g + h。

- 在实现A*搜索函数astar_search时,采用了堆数据结构来存储待扩展的节点,这样可以快速找到f值最小的节点。

- 在搜索过程中,使用字典visited来存储已经访问过的节点,这样可以避免重复访问。

- 在扩展节点时,首先判断下一个状态是否已经被访问过,如果已经被访问过,则跳过;否则,计算从初始状态到下一个状态的代价g,如果下一个状态还没有在堆中,则创建一个新节点并加入堆中,否则,找到对应的节点并更新g值和父节点。

- 在估价函数heuristic中,采用的是曼哈顿距离,即两点在x和y方向上的距离之和。

- 在获取邻居节点函数get_neighbors中,假设状态是二维坐标(x,y),邻居节点包括上下左右四个方向上的节点,其中每个邻居节点的代价均为1。

- 在获取搜索路径函数get_path中,从目标状态开始,依次沿着父节点返回到初始状态,最终得到的是从初始状态到目标状态的一条最短路径。

- 在测试代码中,假设初始状态为(0,0),目标状态为(2,2),调用A*搜索函数astar_search得到最短路径,并输出路径上的所有状态。

以上就是一个简单的A*搜索代码,当然在实际应用中可能需要根据具体问题进行相应的调整。

如果喜欢我的文章,麻烦您动动您的神手帮我点个赞哦!本人在此深深的感谢!

相关推荐

精品博文嵌入式6410中蓝牙的使用

BluetoothUSB适配器拥有一个BluetoothCSR芯片组,并使用USB传输器来传输HCI数据分组。因此,LinuxUSB层、BlueZUSB传输器驱动程序以及B...

win10跟这台计算机连接的前一个usb设备工作不正常怎么办?

前几天小编闲来无事就跑到网站底下查看粉丝朋友给小编我留言询问的问题,还真的就给小编看到一个问题,那就是win10跟这台计算机连接的一个usb设备运行不正常怎么办,其实这个问题的解决方法时十分简单的,接...

制作成本上千元的键盘,厉害在哪?

这是稚晖君亲自写的开源资料!下方超长超详细教程预警!!全文导航:项目简介、项目原理说明、硬件说明、软件说明项目简介瀚文智能键盘是一把我为自己设计的——多功能、模块化机械键盘。键盘使用模块化设计。左侧的...

E-Marker芯片,USB数据线的“性能中枢”?

根据线缆行业的研究数据,在2019年搭载Type-C接口的设备出货量已达到20亿台,其中80%的笔记本电脑和台式电脑采用Type-C接口,50%的智能手机和平板电脑也使用Type-C接口。我们都知道,...

ZQWL-USBCANFD二次开发通讯协议V1.04

修订历史:1.功能介绍1.1型号说明本文档适用以下型号:  ZQWL-CAN(FD)系列产品,USB通讯采用CDC类实现,可以在PC机上虚拟出一个串口,串口参数N,8,1格式,波特率可以根据需要设置(...

win10系统无法识别usb设备怎么办(win10不能识别usb)

从驱动入手,那么win10系统无法识别usb设备怎么办呢?今天就为大家分享win10系统无法识别usb设备的解决方法。1、右键选择设备管理器,如图:  2、点击更新驱动程序,如图:  3、选择浏览...

微软七月Win8.1可选补丁有内涵,含大量修复

IT之家(www.ithome.com):微软七月Win8.1可选补丁有内涵,含大量修复昨日,微软如期为Win7、Win8.1发布7月份安全更新,累计为6枚安全补丁,分别修复总计29枚安全漏洞,其中2...

如何从零开始做一个 USB 键盘?(怎么制作usb)

分两种情况:1、做一个真正的USB键盘,这种设计基本上不涉及大量的软件编码。2、做一个模拟的USB键盘,实际上可以没有按键功能,这种的需要考虑大量的软件编码,实际上是一个单片机。第一种设计:买现成的U...

电脑识别U盘失败?5个实用小技巧,让你轻松搞定USB识别难题

电脑识别U盘失败?5个实用小技巧,让你轻松搞定USB识别难题注意:有些方法会清除USB设备里的数据,请谨慎操作,如果不想丢失数据,可以先连接到其他电脑,看能否将数据复制出来,或者用一些数据恢复软件去扫...

未知usb设备设备描述符请求失败怎么解决

出现未知daousb设备设备描述符请求失du败解决办zhi法如下:1、按下Windows+R打开【运行】;2、在版本运行的权限输入框中输入:services.msc按下回车键打开【服务】;2、在服务...

读《飘》47章20(飘每章概括)

AndAhwouldn'tleaveMissEllen'sgrandchildrenfornotrashystep-patobringup,never.Here,Ah...

英翻中 消失的过去 37(消失的英文怎么说?)

翻译(三十七):消失的过去/茱迪o皮考特VanishingActs/JodiPicoult”我能做什么?“直到听到了狄利亚轻柔的声音,我才意识到她已经在厨房里站了好一会儿了。当她说话的时候,...

RabbitMQ 延迟消息实战(rabbitmq如何保证消息不被重复消费)

现实生活中有一些场景需要延迟或在特定时间发送消息,例如智能热水器需要30分钟后打开,未支付的订单或发送短信、电子邮件和推送通知下午2:00开始的促销活动。RabbitMQ本身没有直接支持延迟...

Java对象拷贝原理剖析及最佳实践(java对象拷贝方法)

作者:宁海翔1前言对象拷贝,是我们在开发过程中,绕不开的过程,既存在于Po、Dto、Do、Vo各个表现层数据的转换,也存在于系统交互如序列化、反序列化。Java对象拷贝分为深拷贝和浅拷贝,目前常用的...

如何将 Qt 3D 渲染与 Qt Quick 2D 元素结合创建太阳系行星元素?

Qt组件推荐:QtitanRibbon:遵循MicrosoftRibbonUIParadigmforQt技术的RibbonUI组件,致力于为Windows、Linux和MacOSX提...

取消回复欢迎 发表评论: