自动路径规划方法

姓名:杨晶晶  学号:21011210420  学院:通信工程学院

转载自:https://blog.csdn.net/gophae/article/details/104170454

【嵌牛导读】

1.采用了sampling based的路径规划方法,一开始使用的是点的连接,先生成粗糙曲线然后再做平滑处理。

2.代价函数的调参问题。

【嵌牛鼻子】sampling based的路径规划方法简单介绍以及cost function的调参采用串联评价方法。

【嵌牛提问】cost function有什么优点?

【嵌牛正文】

第一个点:空间图生成的粗糙曲线。

图一


这个方法在之前的文章解析里面也有提及,意思就是一开始我们不使用直接曲线规划,比如给定限制条件后进行五阶曲线规划,因为这样虽然一步到位,但是很费计算资源,我们这里依然使用cost function 的方法,去找到一系列的点,连接起来生成连续但不可导的粗糙曲线,然后在对这些曲线做平滑处理,显然损耗的计算资源要少很多。这个cost function写成:

图二


(1)表示与中心线的横向偏差, 我们期望永远能沿着中心线走,偏差尽量小。delta_h是点的前后两条线段之间的heading的差值。下面的图表示的很清楚,在上一个论文解析里面(论文解析3)中也说到了这个公式,我们在曲线中,就是希望尽量的把曲线拉直,表示成heading就是希望前后两个线段的heading的变化能尽量小。

图三


第二个值得一提的问题就是对cost function 的调参。因为cost function 中可能涉及很多参数,这些参数有的可能很难表示什么具体的物理意义,比如说曲率的二次变化率,我们很难用量化的方式去评判它的好坏,不像我们评判加速度的好坏,有具体的量化指标。第二个,一旦这些参量高达十几个的时候,他们的权重weight的调参就会变得越加困难。所以本文提出了一个创新的方法,也不去计算累加和了,而是用了cascaded ranking method. 中文译名串联评价方法。

举个例子,我们现在就只有6个参量:

图四


人为的给予不同的重要程度,以上碰撞肯定是最高优先级的,偏离预定轨迹和预定速度作为最低优先级。我们现在有N条曲线要评判哪条是最优曲线,就从这些曲线的这些不用重要性的参量出发来评价曲线的好坏。对于每个参量对应描述的状态,我们就给他三种评价,好,中,坏,比如第一个,是否和静态障碍物碰撞,我们对每条曲线的这个部分,进行评价,然后继续对第二个优先级所描述的状态进行评价,再打分,最后把这些东西统一在一个bucketing box里面,统一的原因是我们要避免这个方法是对每个参量的单独打分,不然就没意思了。应该放在一起打分。最后我们去总分最高的作为最优曲线。

这个方法的创意在于,我们是对每个状态进行横向的评价,而不是对单位不统一的参量进行纵向评价。比如,我们对所有曲线是否与静态障碍物发生碰撞这个状态打分,就是横向打分,而我们把每条曲线所有的参量通过量化的方式累加起来,就是纵向对比,因为与静态障碍的距离(L/m)与曲线曲率(kappa/1/m)两者连单位都没有统一,我们把他们加起来的意义是什么呢?

下图举了一个简单的例子解释了bucketing box的方法:

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

推荐阅读更多精彩内容