Voronoi图路径规划 (许松清, 2005)

本文中的方法来自文章:
许松清,吴海彬,林宜,高洪张,陈天炎. 基于Voronoi图法的移动机器人路径规划[J]. 中国工程机械学报,2005,(03):336-340.

Voronoi路径规划代码下载本文代码。

维诺图

用X表示一个距离函数为d的空间。令K为一个指示集合,(P_k ),k∈K为空间X的一个非空子集的有序元组。对应于P_k 的R_k,称为沃洛诺伊元胞,或沃洛诺伊区域,是空间X中所有到P_k 的距离不大于其到其他位置P_j (j≠k)的点集。如果定义d(x,A)=inf⁡{d(x,a)|a∈A}为点x和子集A的距离,则

R_k={x∈X|d(x,P_k )≤d(x,P_j ) for all j≠k}

算法流程

确定Voronoi图和Voronoi子图,根据地图确定Voronoi图和地图边界内的Voronoi子图,确定起点/目标点到Voronoi子图的最近点。寻找起点到目标点的路径,实际上是在Voronoi子图内寻找两最近点之间的路径。

利用维诺图进行路径规划一般不能得到两点最短路径,仅能得到两点间“较安全”路径。

本算法中的运动体为圆形。首先的到每个障碍物的外接圆,并对外接圆进行径向扩张,扩展尺寸为运动体的半径,即可将运动体作为单点处理,只要该单点的路径不经过扩张后的圆,运动体即可无碰撞的沿路径运动。如果两个或多个扩张后的圆相交,表明运动体无法从这些障碍物之间通过,则将其相应的障碍物作为一个障碍物处理。

此时,即可将处理后的圆的圆心并以此作为Voronoi图的生成元。

生成Voronoi图后,对其进行处理,得到Voronoi图的子图,即地图边界内的部分Voronoi图。按照某种策略确定起点/目标点到Voronoi子图的最近点。

最后,使用Dijkstra算法在Voronoi子图中寻找两最近点之间的路径。

=========

首先,初始化地图数据,其中红色色块为障碍物,绿色圆圈表示圆形运动体,它在起点的位置上,红色*表示目标点。

地图

之后,得到障碍物的外接圆,并“增长”外接圆,此时与运动体可作为单点处理。

障碍物外接圆

可以看到,右下角两个障碍物“增长”后的外接圆有重叠部分,将其视为一个障碍物。

合并障碍物外接圆

绘制维诺图,可以看到此算法的一个问题,虽然通过增长障碍物外接圆半径使运动体“可以被”视为一个质点,并且在此基础上合并了运动体无法通过的障碍物,但是voronoi图是通过外接圆圆心生成的,与外接圆半径无关,因此voronoi图的边仍可能与障碍物圆相交,仍有碰撞的可能。如下图所示。

Voronoi图

得到维诺子图:

子维诺图

确定起点/目标点到维诺子图的最近点,并将其连接,通过Dijkstra算法寻找路径:

路径

此时,可以看到此算法的另一个问题,无论起点/目标点到voronoi子图的最近点如何选择,此文中都没有起点/目标点到最近点的路径做碰撞检测,起点/目标点到voronoi图子图的路径很可能与障碍物产生碰撞,如下图所示。

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

推荐阅读更多精彩内容