轨迹规划论文阅读20220109-A Real-Time Motion Planner with Trajectory Optimization for Autonomous Vehicles

本文主要是介绍轨迹规划论文阅读20220109-A Real-Time Motion Planner with Trajectory Optimization for Autonomous Vehicles,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

0、摘要
提出了一种基于轨迹优化的高效实时自动驾驶运动规划方法。将轨迹空间离散化->利用cost functions 来找到最佳轨迹。
引[CSDN1]: 规划器首先把规划空间离散化 ,并根据一组代价函数搜索最优轨迹,然后对轨迹的path和speed进行迭代优化。文中提出了一种“post-optimization”的方法,可以弥补离散化难以求出最优解的问题(离散越密,越接近最优解),并可以减少52%的规划时间。
1、介绍
A. 背景
自动驾驶复杂的情况与搜索方法的局限性,启发式搜索难以全部满足。时间维度、运动学约束、Jerk并没有好的方法同时处理。
B. 相关工作
论文1-12
C. 贡献
实现了一种平滑、连续、可行的运动规划器。通过高效的路线和速度离散化。通过后后处理补偿离散的问题。
2、算法框架
使用[3]曲率多项式来找到路径。使用[13]的方法实现一个随即方向的单一优化算法。
A、轨迹生成
A-1 路径生成
使用与[5]类似的方法,但是使用的是四次的曲率多项式->曲率变化率的连续性。
a) 端点采样
路中央的轨迹:横纵坐标,当前方向和曲率。    
使用类似Frenet的方式去定义一个空间的点:
相当于将该处中线切圆的半径扩大了些。
b) 路径模型
将成对的采样点于采样端点以及当前车辆姿态连接起来。
三次拟合:     。其中有五个约束项对应x,y的移动,起点到终点的方向,起点的曲率和终点的曲率。梯度下降算法可以解决这个问题(衍生于[3])。
从[5]中,三次曲率多项式适用于处理通常的曲率变化连续的场景。但是在双循环轨迹生成中,往往会出现轨迹的曲率并不是一直连续的[问题1]。加入了四次曲率多项式。仅用于从当前车辆位置启示的那一段路。
c) 速度生成
将速度空间离散化,设置一个三次多项式将他们连接起来。
速度多项式定义为: ,使用了s-弧长来定义。四个未知变量(假设弧长是已知的),分别对应四个约束:初速度,初加速度,终速度,终加速度。其中,初始速度和初始加速度由实际传感器测得。定义了最大最小速度以及离散速度个数N_speed,将速度离散为: .
d) Cost 函数
包含的变量:静态变量和动态变量
静态希望更短、曲率变化更小、更靠近车道中心且远离障碍物
动态上期望更快、耗能更小、加速度更小、加加速度更小、向心加速度更小并且距离障碍物更远。
距离使用有关距离的计算:
其中,lambda 是带宽 g是距离
C、最优轨迹生成
将以上代价全部加起来,得到的代价函数。将路径和速度分开优化。应该是先选路程,再选速度。然后进入优化模块。
1) 路径优化
取消采样点的中朝向、横向偏移、以及曲率要求的约束[问题2],增加了起始位置朝向偏移以及起始位置的曲率偏移两个变量。重新构建轨迹并且使用Simplex优化。(单纯形算法)
还剩沿道路的的横向距离...
2) 速度优化
这个过程中会改变到达任一节点的动态障碍物的位置,使得梯度算法难以使用。所以使用非衍生的 Simplx算法[问题3]。
D、性能评估
初始轨迹的以及速度的选取占用的时间最长,迭代几次其实消耗的时间并没有那么多。
3、系统实现
找到车辆最近的一个路点,确定一个算法结束的时候最近一个车辆肯定达不到的地方,从那儿开始进行规划。
针对于人工驾驶,总是以当前位置作为初始点开始。
995、阅读总结
该算法先通过离散的点选取了一条参考轨迹,然后使用单纯形方法进行迭代优化。从而在保证了轨迹质量的同时,降低了运算时间。
这个优化过程中似乎没有用到距离障碍物的距离,使得优化过程的安全性降低。
亮点:合理的分配轨迹预生成以及轨迹后优化。
缺点:优化时的单纯形算法对碰撞的影响。
997、阅读时存在的问题
1、但是在双循环轨迹生成中,往往会出现轨迹的曲率并不是一直连续的。
相邻周期的path计算时经过了一次速度优化,丢失了继承性?
[CSDN1] :  可以理解为相邻周期计算出的path没有继承性,转向会有突变。为了解决这个问题可以再引入一个新的约束:即当前车辆姿态点处曲率的一阶导数。那么此时就应当是4次多项式了。
998、 Linked Papers
A. Related Works
[1][2] 一系列测试平台的搭建
[3][4] 曲率多项式来确保速度和加速度->确保曲率变化得当
[5][6] 在[3][4]的基础上实现了将轨迹与道路形状贴合
[7] 时间五次多项式
[8] A Star ARA Star [9] RPT [10] D Star Lite
[11] 使用共轭梯度方法,速度不是最优的
[12] 梯度最优方法,很好的避开了静态障碍物,但是却没有联系时间维度
B、算法框架
[13] 一种随机方向的单一优化方法生成路径和速度
[5] [14] 一种前向的速度生成算法。
[7] [15] 一种反向的速度生成-使用了基于时间的多项式
[16] 一种车辆所在区域的表示方法
[17] Simplex 算法
[18] PMP-partial montion planning
999、词语积累
iterative   v. 迭代的,重复的,反复的
resultant  adj. 由此引起的
computational complexity n. 计算复杂度
commuter n. 通勤者
commercial adj. 商业的
cruise n. 巡航
constraint n.约束
convature n.曲率
comform  v.符合
inverse     adj. 相反的
profile      n. 轮廓、总则
coincide with v. 吻合
derivative n. 派生物
feasible    adj. 可行的
oriented  adj. 以...为方向的
simplex   adj.单一的
perpendicular adj. 正交的
vertex     n. 顶点
discretized adj. 离散的
respectively adv. 分别地
lattice n. 晶格
granulatity n. 间隔尺寸、粒度
scheme  n. 计划
参考文章:
CSDN 1: 自动驾驶之轨迹规划7—A Real-Time Motion Planner with Trajectory Optimization for Autonomous Vehicles文献阅读_IHTY_NUI的博客

这篇关于轨迹规划论文阅读20220109-A Real-Time Motion Planner with Trajectory Optimization for Autonomous Vehicles的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



http://www.chinasem.cn/article/1071970

相关文章

JAVA智听未来一站式有声阅读平台听书系统小程序源码

智听未来,一站式有声阅读平台听书系统 🌟 开篇:遇见未来,从“智听”开始 在这个快节奏的时代,你是否渴望在忙碌的间隙,找到一片属于自己的宁静角落?是否梦想着能随时随地,沉浸在知识的海洋,或是故事的奇幻世界里?今天,就让我带你一起探索“智听未来”——这一站式有声阅读平台听书系统,它正悄悄改变着我们的阅读方式,让未来触手可及! 📚 第一站:海量资源,应有尽有 走进“智听

动态规划---打家劫舍

题目: 你是一个专业的小偷,计划偷窃沿街的房屋。每间房内都藏有一定的现金,影响你偷窃的唯一制约因素就是相邻的房屋装有相互连通的防盗系统,如果两间相邻的房屋在同一晚上被小偷闯入,系统会自动报警。 给定一个代表每个房屋存放金额的非负整数数组,计算你 不触动警报装置的情况下 ,一夜之内能够偷窃到的最高金额。 思路: 动态规划五部曲: 1.确定dp数组及含义 dp数组是一维数组,dp[i]代表

AI hospital 论文Idea

一、Benchmarking Large Language Models on Communicative Medical Coaching: A Dataset and a Novel System论文地址含代码 大多数现有模型和工具主要迎合以患者为中心的服务。这项工作深入探讨了LLMs在提高医疗专业人员的沟通能力。目标是构建一个模拟实践环境,人类医生(即医学学习者)可以在其中与患者代理进行医学

软考系统规划与管理师考试证书含金量高吗?

2024年软考系统规划与管理师考试报名时间节点: 报名时间:2024年上半年软考将于3月中旬陆续开始报名 考试时间:上半年5月25日到28日,下半年11月9日到12日 分数线:所有科目成绩均须达到45分以上(包括45分)方可通过考试 成绩查询:可在“中国计算机技术职业资格网”上查询软考成绩 出成绩时间:预计在11月左右 证书领取时间:一般在考试成绩公布后3~4个月,各地领取时间有所不同

poj 2976 分数规划二分贪心(部分对总体的贡献度) poj 3111

poj 2976: 题意: 在n场考试中,每场考试共有b题,答对的题目有a题。 允许去掉k场考试,求能达到的最高正确率是多少。 解析: 假设已知准确率为x,则每场考试对于准确率的贡献值为: a - b * x,将贡献值大的排序排在前面舍弃掉后k个。 然后二分x就行了。 代码: #include <iostream>#include <cstdio>#incl

代码随想录冲冲冲 Day39 动态规划Part7

198. 打家劫舍 dp数组的意义是在第i位的时候偷的最大钱数是多少 如果nums的size为0 总价值当然就是0 如果nums的size为1 总价值是nums[0] 遍历顺序就是从小到大遍历 之后是递推公式 对于dp[i]的最大价值来说有两种可能 1.偷第i个 那么最大价值就是dp[i-2]+nums[i] 2.不偷第i个 那么价值就是dp[i-1] 之后取这两个的最大值就是d

论文翻译:arxiv-2024 Benchmark Data Contamination of Large Language Models: A Survey

Benchmark Data Contamination of Large Language Models: A Survey https://arxiv.org/abs/2406.04244 大规模语言模型的基准数据污染:一项综述 文章目录 大规模语言模型的基准数据污染:一项综述摘要1 引言 摘要 大规模语言模型(LLMs),如GPT-4、Claude-3和Gemini的快

论文阅读笔记: Segment Anything

文章目录 Segment Anything摘要引言任务模型数据引擎数据集负责任的人工智能 Segment Anything Model图像编码器提示编码器mask解码器解决歧义损失和训练 Segment Anything 论文地址: https://arxiv.org/abs/2304.02643 代码地址:https://github.com/facebookresear

数学建模笔记—— 非线性规划

数学建模笔记—— 非线性规划 非线性规划1. 模型原理1.1 非线性规划的标准型1.2 非线性规划求解的Matlab函数 2. 典型例题3. matlab代码求解3.1 例1 一个简单示例3.2 例2 选址问题1. 第一问 线性规划2. 第二问 非线性规划 非线性规划 非线性规划是一种求解目标函数或约束条件中有一个或几个非线性函数的最优化问题的方法。运筹学的一个重要分支。2

轨迹规划-B样条

B样条究竟是干啥的?白话就是给出一堆点,用样条的方式,给这些点连接起来,并保证丝滑的。 同时B样条分为准均匀和非均匀,以下为准均匀为例。 参考链接1:https://zhuanlan.zhihu.com/p/50626506https://zhuanlan.zhihu.com/p/50626506 参考链接2: https://zhuanlan.zhihu.com/p/536470972h