A星(A*,AStar)寻路

概念

  • node:节点,格子
  • cost:代价
  • F:预计的总路径的代价
  • G:从起点到点前节点的代价
  • H:从当前节点到终点的估计代价
  • heuristic:估价函数,估算的到H
  • open list:待考察表
  • closed list:已考察表
  • parent node:父节点,node需要有父节点属性,表示从那个节点走到这个节点

寻路逻辑

1.添加起始节点到待考察表(open list)
2.主循环

a.如果openlist里有节点,找到open list 里拿出最小代价节点,设为当前节点。如果openlist里没有节点了,查找失败。
b.如果当前节点为终点,已经找到路径,跳到第4步
c.考察每个相邻节点(一般可以斜着走时有8个,不斜着走时4个,当然也可以自己定义):

(1)如果不能通过,或者已经在已考察表,跳过,继续下一节点
(2)计算它的代价。
(2.5)如果这个节点在openlist里。如果现在的g比较小,重置当前节点为它的父节点,更新这个节点的g,然后跳过下面。如果现在的g没有比较小,直接跳过下面,继续下个节点。
(3)把当前节点定义为这个节点的父节点添加到待考察表
(4)添加当前节点到已考察表

3.更新待考察表,重复第二步。
4.你已经到达终点,创建路径列表并添加终点节点
5.添加终点节点的父节点到路径列表
6.重复添加父节点直到起始节点。路径列表就由一组节点构成了最佳路径

常用估价函数

寻路性能优化

在节点上加一个状态变量,状态有normal,open,close 三种。
这样在判断节点是不是在openlist 或者closelist里时不用每次从列表中搜索,可以减少很多时间。

路径优化 佛洛依德路径平滑算法(floyd)

常见的a*算法的结果是一串用来表示所经过的路径点坐标。但是这样的路径通常是有“锯齿”的,并不符合现实中的智能表现。
因此,需要进一步的进行平滑处理,比如 佛洛依德算法~
  算法原理很简单,分为两步:
  1.去掉相邻的共线的点
  2.去掉多余的拐弯的点
  第一步实现起来很简单,只需要遍历一下,计算两个向量的方向是否相同。
  第二步的实现稍微麻烦一点,遍历所有的点,去掉两个可以直接通过的点之间的点。
  其实是很经典的画直线算法,找两个点作为端点画一条线,这条先经过的网格如果都是可同行的,那么我们就认为在路径中这两个点中间的那些点是多余的。
其实第二步就可以完成优化,但是计算量比较大。所以先通过第一步来减少一部分计算量。

©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 214,100评论 6 493
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 91,308评论 3 388
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 159,718评论 0 349
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 57,275评论 1 287
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 66,376评论 6 386
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 50,454评论 1 292
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 39,464评论 3 412
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 38,248评论 0 269
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 44,686评论 1 306
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 36,974评论 2 328
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 39,150评论 1 342
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 34,817评论 4 337
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 40,484评论 3 322
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 31,140评论 0 21
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 32,374评论 1 267
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 47,012评论 2 365
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 44,041评论 2 351

推荐阅读更多精彩内容