文化传媒有限公司网站建设,网站目录权限设置 user,网站广告联盟怎么做的,北京官网建设哪家好论文题目#xff1a;A Real-Time Motion Planner with Trajectory Optimization for Autonomous Vehicles
Abstract
本文的实时规划器首先将空间离散化#xff0c;然后基于一组成本函数搜索出最佳轨迹。迭代优化所得到的轨迹的Path和Speed。post-optimization计算复杂度低A Real-Time Motion Planner with Trajectory Optimization for Autonomous Vehicles
Abstract
本文的实时规划器首先将空间离散化然后基于一组成本函数搜索出最佳轨迹。迭代优化所得到的轨迹的Path和Speed。post-optimization计算复杂度低能够在几次迭代内收敛到一个更高质量的解该框架可以减少52%的规划时间提高规划质量。 本文主要的创新点就在于post-optimization I INTRODUCTION
A Background
规划器需要满足严格的实时要求以便在紧急情况做出足够快的反应。
B Related work
Autonomous driving Systems对自动驾驶系统的发展做了一些调研。单纯的自适应巡航控制系统和车道辅助系统无法执行复杂的驾驶行为处理并车、绕开其他汽车、能够智能的对意外的动态障碍物作出反应这些系统仍需要人类监督执行。 Trajectory generation道路场景中自动驾驶的轨迹生成需要考虑三个约束运动学、动力学和道路形状。具体来说就是曲率和加速度的变化率在轨迹中应该是连续的 [3][4]提出了利用曲率多项式保证曲率变化率连续的逆路径生成方法。 1基于[3][4]的方法[5][6]提出的规划器首先沿道路采样端点然后使用曲率多项式连接它们便于所有的路径符合道路形状然后给每条路径指定不同的加速度曲线来生成一组轨迹。 2[6]中生成的路径可以被车辆很好地跟踪。但是由于加速度曲线不连续车辆很难准确、平稳地跟随加速度曲线。 3[7]使用另一种方法处理这个问题使用五次多项式生成横向d(t)和纵向轨迹s(t)确保了连续地加速度曲线。此外他们使用道路中心线为参考的Frenet坐标系结合横向和纵向运动。使得轨迹纵向与道路形状一致。然而每个轨迹上的每个点的曲率需要被计算和验证计算量大。另外虽然曲率是连续的但是曲率的一阶导和方向盘转角相关频繁改变导致方向盘移动不平稳。 Search algorithm轨迹生成之后通常应用搜索算法来找到最优结果。state lattice planners通常基于启发式A和ARA[8]或采样RRT[9]。 1基于启发式的搜索算法对成本的准确估计从任何一个顶点到目标都是必不可少的。但自动驾驶规划问题很复杂特别是当存在动态障碍物时很难找到适合所有场景的适当启发式函数。 2一些增量重规划算法D*Lite[10]广泛应用于机器人导航但它们仅适用于具有一个固定目标的典型规划问题但是在道路场景下目标会一直变化。 3基于采样的方法RRT[9]规划结果通常不够平滑无法让汽车执行。另外由于动态障碍物的存在需要在搜索状态空间中加入时间作为额外的维度。使得搜索空间呈指数增长导致基于搜索的算法效率低下。因此本文应用状态空间的离散化然后应用简单而快速的穷举搜索。 Optimization method for planning[11]提出了一种共轭梯度法来平滑路径。然而车辆的速度没有规划或优化。因此该算法在道路环境中不能很好地工作速度对于驾驶非常重要特别是处理动态障碍物。[12]提出了用于运动规划的梯度优化方法能够更好地避免静态障碍物。但是他们的方法也没有考虑时间维度或者速度。
C Contribution
在related work的基础上提出了一种实时的运动规划器。该Planner具有以下特点1由规划器生成的轨迹是平滑且连续的在运动学上可以被车辆执行2通过有效路径和速度离散化加速最优轨迹搜索3通过post-optimization补偿离散化牺牲的性能4通过在路径和速度空间中迭代优化来提高实时性能。
II Algorithm Framework 实时运动规划器如上图所示由轨迹规划和轨迹优化两部分组成第一步使用[3]中描述的方法生成路径边缘然后为每个路径边生成速度集将一组成本函数应用在每个轨迹上并选择最佳轨迹。然后将生成的最佳轨迹传递到优化模块在优化模块中使用随机-定向单纯形优化算法迭代优化路径和速度[13]。
A Trajectory generation
Path Set和Speed Set分别生成然后通过将Path Set和Speed Set相结合获得轨迹集。 1路径生成通过使用不同种类的曲率多项式连接采样端点来生成路径。规划器中的抽样方法与[5]中的相同。然而代替三次四次曲率多项式用于确保每个规划周期的起始点处的曲率变化率是连续的。 a端点采样执行了采样机制为了生成每条路径的顶点端点道路中心线的函数如下 使用类似Frenet的方式去定义一个空间的点 对于每一层对垂直于中心线的 N p a t h N_{path} Npath进行采样 b路径模型通过连接以下各项来生成路径 1成对的采样端点 2端点和当前车辆姿态 该运动规划器采用三次和四次曲率多项式构建路径模型。对于三次曲率多项式路径的曲率是弧长的三次多项式 因此问题变成找到满足端点约束的参数。函数中有4个参数 r 0 , r 1 , r 2 , r 3 r_0,r_1,r_2,r_3 r0,r1,r2,r3s不算论文这边感觉有错误其中有五个约束项对应xy的移动起点到终点的方向起点的曲率和终点的曲率。 在以前的工作[5]中只有三次曲率多项式用于常见场景。该方法适用于任何单一规划周期然而在两个规划周期的接合点处可能发生不连续性。运动规划器以非常高的频率重新规划结果实际规划结果远远达不到平滑的效果。下图显示了使用四次曲率多项式红色实线的典型结果比使用三次多项式蓝色虚线平滑地多。 因此需要对当前车辆姿态和端点之间的路径添加新的约束即当前车辆姿态点处曲率的一阶导数。为了满足这个额外的约束多项式需要是四次而不是三次。当我们频繁地重新规划这种改进可以让路径变得平滑。如下图所示红色路径表示四次曲率多项式而绿色路径是三次曲率多项式然而四次多项式需要更多的时间来生成因此为了限制计算时间四次多项式仅用于从当前车辆姿态开始的轨迹段 2速度生成在生成路径集之后为每个单独的路径构建候选速度曲线与[5][14]做的工作不同他们使用正向方法生成速度曲线。本文使用逆向方法。首先将速度空间离散化然后生成多项式满足顶点约束。本文的方法也不同于[15]和[7]中提出的逆方法后者使用时间的多项式函数来生成速度曲线。本文使用弧长的多项式函数与本文的路径方程更加一致。多项式方程如下 速度状态 Q ( s , v , a ) Q(s,v,a) Q(s,v,a)对于每条路径从路径的起点选择起始速度状态 Q i n i t ( s 0 , v 0 , a 0 ) Q_{init}(s_0,v_0,a_0) Qinit(s0,v0,a0)从路径的终点选择终止速度状态 Q g o a l ( s 1 , v 1 , a 1 ) Q_{goal}(s_1,v_1,a_1) Qgoal(s1,v1,a1)。在上式有四个未知参数对应的四个约束是 v 0 , a 0 , v 1 , a 1 v_0,a_0,v_1,a_1 v0,a0,v1,a1。对于所有顶点v0和v1来自相应的离散化顶点a0和a1设置为0。车辆当前状态 ( v 0 , a 0 ) (v_0,a_0) (v0,a0)的特殊之处他们是从真实的车辆传感器上获得的。将最大速度和最小速度分别表示为 v m a x v_{max} vmax和 v m i n v_{min} vmin并且将离散化速度的数量表示为 N s p e e d N_{speed} Nspeed离散化速度如下 通过设置 s 0 0 s_00 s00可以获得参数 速度和候选速度曲线的离散化如下图所示其中绿色点是采样速度红色曲线超出加速度限制灰色曲线是有效曲线。这种速度生成方法确保了持续的加速。
B Cost function set
对于每条轨迹定义了静态成本和动态成本用来评估安全性、舒适性、效率、能耗和行为。从每一条轨迹中提取n个点来表示成本。如下表所示静态和动态成本的计算公式。 静态成本 1路径长度-效率 2曲率-舒适性 3曲率一阶导-舒适性 4与最近中心线的横向偏移-行为 5到静态障碍物的转换距离 动态成本 1时间-效率 2速度-能量 3加速度-舒适性 4jerk-舒适性 5到动态障碍物的转换距离-安全性
静态成本 c o b s s c^s_{obs} cobss和动态成本 c o b s d c^d_{obs} cobsd用于对每个候选轨迹的碰撞检查。基于[16]提出的方法使用 M c i r M_{cir} Mcir圆来覆盖车辆的区域。如果圆到障碍物的距离小于阈值 d m i n A l l o w e d d_{minAllowed} dminAllowed则成本是无限的。否则用下式计算成本。 其中 λ o b s s λ^s_{obs} λobss和 λ o b s d λ^d_{obs} λobsd分别是静态和动态障碍物的指数成本函数的带宽 g j g_j gj是障碍物与覆盖汽车的第 j j j个圆之间的距离
一个轨迹的总成本是所有项的加权和
C Trajectory optimization
对于大多数Lattice planner适当的离散化是必要的用来确保实时性。然而适当的离散化影响了规划结果的最优性。post-optimize轨迹提高性能非常重要。
一个直接的方法就是同时优化轨迹路径和速度。然后对于实时性来说是十分耗时的。计算开销为 O ( o p t ( M N ) ) O(opt(MN)) O(opt(MN))其中M为路径参数个数N为速度参数个数 o p t ( ) opt() opt()为优化算法的计算复杂度通常为 O ( N 2 ) O(N^2) O(N2)。随着维数的增加优化器也更难找到全局最优解。 因此本文提出了一种迭代轨迹优化机制。计算复杂度是 O ( o p t ( M ) ) O ( o p t ( N ) ) O(opt(M)) O(opt(N)) O(opt(M))O(opt(N))。如果在规划阶段找到的轨迹接近真实的最优则使用该机制允许在几次迭代中收敛到真实的最优 1路径优化路径离散化限制了路径的最优性例如采样端点的横向偏移、航向和曲率是固定的并且与中心线有一定的关系。因此放松这些约束如下图并在新端点之间生成新路径可以提高轨迹质量。 因为成本与横向偏移和航向的梯度很难计算因此使用非导数优化算法单纯形算法[17]进行路径优化。如下图所示路径优化后的路径红线更加平滑 2速度优化速度离散化和端点处的加速度约束也限制了速度曲线的最优性。与路径优化类似优化速度剖面节点的参数。对于生成当前最低成本的速度曲线的节点优化速度和加速度的值。因此连接新节点能让速度曲线保持平滑。 在此优化中节点处的速度变化将影响轨迹上每个点的时间这改变了轨迹上动态障碍物的位置并阻止了梯度方法的使用。因此非导数单纯形算法也用于速度优化。速度优化结果如下图所示由于放松了对端点加速度的约束速度变化更加平滑端点处的速度幅值不再离散
D Optimization performance evaluation
实验表明提出的规划与迭代优化框架是非常有前途的。与替代规划机制或配置相比它能够在更短的时间内生成更高质量的轨迹。与非优化结果相比时间减少52%并且质量提高10%。
III System Implementation
A Interfacing with Autonomous Vehicle
配备了高保真定位系统。它还使用激光雷达和雷达来感知实时周围环境。飞行器的下层控制被设计成执行高精度轨迹跟踪。因此运动规划器仅需要生成具有路径和速度轮廓的可执行轨迹。 规划器和下游的控制器之间的接口被构建为使得在每个规划周期期间发送轨迹的第一部分其取决于车辆速度为8-50米。这给予下游的控制器足够的前瞻性来执行预测控制算法。增加了系统的可靠性因为较低级别的控制器总是有一个相对较长的轨迹来执行即使较高级别的计算机停止工作几个周期。
B Robust replan mechanism
为了对真实的世界中动态变化的环境做出反应运动规划器需要不断地重新规划。如果规划器从当前车辆状态开始规划那么当规划完成时通常在100毫秒左右车辆将处于不同的位置原来的规划不再有效。为了解决这个问题[18]提出了PMP部分运动规划方案。简而言之他们的做法是从未来状态开始规划。当规划器运行时车辆执行上一个规划周期的轨迹。 规划起点问题 基于[18]实现了弧长升序的队列以保留上一个计划周期的轨迹。对于每个周期首先在队列中找到最接近车辆位置的具有弧长 s c s_c sc的点 P c l o s e P_{close} Pclose。然后规划器在队列中寻找具有弧长 s f s_f sf的点 P f u t u r e P_{future} Pfuture该点与 P c l o s e P_{close} Pclose相比处于较晚的位置。计算 s f s_f sf的公式为 其中 V c u r r V_{curr} Vcurr是车辆的当前速度 a m a x a_{max} amax是车辆可以达到的最大加速度而 t s p a n t_{span} tspan是当前时间和下一次重新计划的开始时间之间的基本时间跨度其应该长于重新计划间隔。该等式确保在需要其结果之前完成规划。最后规划器从 P f u t u r e P_{future} Pfuture重传并使用最新规划的轨迹更新轨迹队列。 有一种特殊情况当车辆处于手动驾驶模式时不是从未来位置规划而是从其当前状态位置和速度重新规划。这确保了车辆在从手动模式切换到自动模式时始终具有可行的轨迹来执行即使车辆正在移动。
IV EXPERIMENTAL RESULTS
本文测试了三个不同的场景车道驾驶静态障碍物和动态障碍物。 ALane driving 车道驾驶测试在S形弯曲道路上进行。人类驾驶员通常能够选择更短更平滑的路线。结果如下图所示 自动驾驶汽车在道路的内部移动以获得更短的路径长度并且在进入时减速在退出曲线时加速。自动驾驶汽车能够跟踪规划器生成的轨迹平均交叉轨迹误差小于10厘米最大跟踪误差约为40厘米平均速度误差约为0.5米/秒。规划器生成的轨迹对小车执行是可行的。 BStatic obstacles 在道路环境中自动驾驶员需要处理多个静态障碍物包括路缘、停放的汽车和道路堵塞。在这个规划器中道路上的不可驾驶区域例如破碎的路面也被建模为静态障碍物。测试的规划器的性能处理弯曲的道路和多个静态障碍物在一起。结果如下图所示红点为静态障碍物。 为了避开静态障碍物自动驾驶汽车没有在弯道上走捷径而是选择了一条更长但仍然平滑的路径。 CDynamic obstacles 对于自动驾驶车辆动态障碍物通常是移动障碍物例如汽车、行人、骑自行车的人或骑摩托车的人。如下图所示在该测试中车辆在其首选上车道上遇到较慢的汽车。 由于前面速度较慢的车辆限制了自动驾驶汽车的前进规划者选择一条变道轨迹来绕过它。自动驾驶汽车在通过开始时加速然后在通过速度较慢的车辆时保持近似匀速并在通过后加速。由于横向距离成本的存在在超车慢车时它也倾向于保持在绕行车道的中心这是合理的。
V Conclusion
本文提出并实现了一种实用的具有轨迹优化的实时自主驾驶运动规划器。由规划器生成的轨迹是平滑和连续的使得自主车辆能够以非常小的路径和速度跟踪误差执行。对速度和路径空间进行了适当的离散化使得搜索最优轨迹的速度更快。为了进一步提高轨迹的质量设计并实现了速度和路径状态空间的迭代优化。实验结果表明采用迭代优化框架后生成轨迹的性能提高了10%规划时间减少了50%以上。该规划器已在模拟和真实的车辆在三种情况下进行了测试。它能够处理带有急转弯的弯曲道路避免多个道路上的静态障碍物并执行变道和规避较慢的汽车。 未来的工作需要做更多的道路上的实验以验证规划器的性能在处理复杂的真实的交通场景。规划器的性能也可以通过在速度和路径空间中应用更有效的修剪来提高。虽然成本函数确定最终轨迹的选择但是手动找到成本函数的适当形式和权重是困难和主观的。因此未来的研究也将集中在从人类驾驶员演示中学习成本函数。 文章转载自： http://www.morning.tjkth.cn.gov.cn.tjkth.cn http://www.morning.grnhb.cn.gov.cn.grnhb.cn http://www.morning.smrkf.cn.gov.cn.smrkf.cn http://www.morning.lfdrq.cn.gov.cn.lfdrq.cn http://www.morning.mjxgs.cn.gov.cn.mjxgs.cn http://www.morning.ymqfx.cn.gov.cn.ymqfx.cn http://www.morning.hmdn.cn.gov.cn.hmdn.cn http://www.morning.nqnqz.cn.gov.cn.nqnqz.cn http://www.morning.rrgm.cn.gov.cn.rrgm.cn http://www.morning.mrckk.cn.gov.cn.mrckk.cn http://www.morning.hryhq.cn.gov.cn.hryhq.cn http://www.morning.txfzt.cn.gov.cn.txfzt.cn http://www.morning.lhrxq.cn.gov.cn.lhrxq.cn http://www.morning.sbjbs.cn.gov.cn.sbjbs.cn http://www.morning.hcwjls.com.gov.cn.hcwjls.com http://www.morning.rlhh.cn.gov.cn.rlhh.cn http://www.morning.wnzgm.cn.gov.cn.wnzgm.cn http://www.morning.snjpj.cn.gov.cn.snjpj.cn http://www.morning.pkmcr.cn.gov.cn.pkmcr.cn http://www.morning.srgbr.cn.gov.cn.srgbr.cn http://www.morning.jtwck.cn.gov.cn.jtwck.cn http://www.morning.sxmbk.cn.gov.cn.sxmbk.cn http://www.morning.kstgt.cn.gov.cn.kstgt.cn http://www.morning.tfsyk.cn.gov.cn.tfsyk.cn http://www.morning.mxmzl.cn.gov.cn.mxmzl.cn http://www.morning.kcypc.cn.gov.cn.kcypc.cn http://www.morning.nfsrs.cn.gov.cn.nfsrs.cn http://www.morning.mkrqh.cn.gov.cn.mkrqh.cn http://www.morning.fkmyq.cn.gov.cn.fkmyq.cn http://www.morning.pnntx.cn.gov.cn.pnntx.cn http://www.morning.kjtdy.cn.gov.cn.kjtdy.cn http://www.morning.qieistand.com.gov.cn.qieistand.com http://www.morning.hhpkb.cn.gov.cn.hhpkb.cn http://www.morning.rkck.cn.gov.cn.rkck.cn http://www.morning.xlndf.cn.gov.cn.xlndf.cn http://www.morning.dtmjn.cn.gov.cn.dtmjn.cn http://www.morning.mingjiangds.com.gov.cn.mingjiangds.com http://www.morning.pbygt.cn.gov.cn.pbygt.cn http://www.morning.cpqwb.cn.gov.cn.cpqwb.cn http://www.morning.xwbwm.cn.gov.cn.xwbwm.cn http://www.morning.lkfsk.cn.gov.cn.lkfsk.cn http://www.morning.wbyqy.cn.gov.cn.wbyqy.cn http://www.morning.sgbss.cn.gov.cn.sgbss.cn http://www.morning.wtnwf.cn.gov.cn.wtnwf.cn http://www.morning.wkhfg.cn.gov.cn.wkhfg.cn http://www.morning.wngpq.cn.gov.cn.wngpq.cn http://www.morning.ejknty.cn.gov.cn.ejknty.cn http://www.morning.nyzmm.cn.gov.cn.nyzmm.cn http://www.morning.jwbfj.cn.gov.cn.jwbfj.cn http://www.morning.nynpf.cn.gov.cn.nynpf.cn http://www.morning.zfqr.cn.gov.cn.zfqr.cn http://www.morning.fy974.cn.gov.cn.fy974.cn http://www.morning.rdlrm.cn.gov.cn.rdlrm.cn http://www.morning.rfrnc.cn.gov.cn.rfrnc.cn http://www.morning.gjsjt.cn.gov.cn.gjsjt.cn http://www.morning.rtlrz.cn.gov.cn.rtlrz.cn http://www.morning.itvsee.com.gov.cn.itvsee.com http://www.morning.xllrf.cn.gov.cn.xllrf.cn http://www.morning.fwnyz.cn.gov.cn.fwnyz.cn http://www.morning.hryhq.cn.gov.cn.hryhq.cn http://www.morning.gfrtg.com.gov.cn.gfrtg.com http://www.morning.wkrkb.cn.gov.cn.wkrkb.cn http://www.morning.rscrj.cn.gov.cn.rscrj.cn http://www.morning.fengnue.com.gov.cn.fengnue.com http://www.morning.hfnbr.cn.gov.cn.hfnbr.cn http://www.morning.rxgnn.cn.gov.cn.rxgnn.cn http://www.morning.fplwz.cn.gov.cn.fplwz.cn http://www.morning.rpsjh.cn.gov.cn.rpsjh.cn http://www.morning.zhnpj.cn.gov.cn.zhnpj.cn http://www.morning.bsplf.cn.gov.cn.bsplf.cn http://www.morning.bwygy.cn.gov.cn.bwygy.cn http://www.morning.mxmzl.cn.gov.cn.mxmzl.cn http://www.morning.mwrxz.cn.gov.cn.mwrxz.cn http://www.morning.lfdmf.cn.gov.cn.lfdmf.cn http://www.morning.dwkfx.cn.gov.cn.dwkfx.cn http://www.morning.qytby.cn.gov.cn.qytby.cn http://www.morning.zzgtdz.cn.gov.cn.zzgtdz.cn http://www.morning.yrflh.cn.gov.cn.yrflh.cn http://www.morning.jkftn.cn.gov.cn.jkftn.cn http://www.morning.lgznc.cn.gov.cn.lgznc.cn
