【技术实现步骤摘要】
用于自动驾驶车辆的基于约束平滑样条的路径优化
本公开的实施方式大体涉及操作自动驾驶车辆。更具体地,本公开的实施方式涉及用于自动驾驶车辆(ADV)的基于约束平滑样条的路径优化。
技术介绍
以自动驾驶模式运行(例如,无人驾驶)的车辆可以将乘员、尤其是驾驶员从一些驾驶相关的职责中解放出来。当以自动驾驶模式运行时,车辆可以使用车载传感器导航到各个位置,从而允许车辆在最少人机交互的情况下或在没有任何乘客的一些情况下行驶。车辆可利用参考线路进行导航。参考线路是当周围没有障碍物时自动驾驶车辆应沿着其行驶的路径。平滑参考线路可带来更稳定的车辆控制。此外,路径规划轨迹的平滑度(也取决于参考线路的平滑度)和/或速度规划轨迹的平滑度(其包括由车辆感知的障碍物和/或交通信息)可带来更稳定的车辆控制。
技术实现思路
为实现上述技术背景中所提及的问题,本申请提供一种用于优化自动驾驶车辆(ADV)的路径轨迹的计算机实现的方法,非暂时性机器可读介质以及数据处理系统。根据本申请一方面,公开了用于优化自动驾驶车辆(ADV)的路径轨迹的计算机实现的方法,所述方法包括:将自所述自动驾驶车辆的起始位置所选择的第一路径轨迹分段成多个路径段,其中每个路径段由多项式函数表征;根据所述路径段的多项式函数,选择用于对所述路径段之间的连接进行平滑的目标函数;至少根据由所述自动驾驶车辆感知的道路边界以及障碍物,基于相邻路径段对所述路径段的多项式函数限定约束集合;根据所添加的约束对所述目标函数执行二次规划(QP)优化,使得在满足所述约束集合的情况下所述目标函数的输出达到最小值;以及基于所述二次规划优化,通过已优化的目 ...
【技术保护点】
1.用于优化自动驾驶车辆的路径轨迹的计算机实现的方法,所述方法包括:将自所述自动驾驶车辆的起始位置所选择的第一路径轨迹分段成多个路径段,其中每个路径段由多项式函数表征;根据所述路径段的多项式函数,选择用于对所述路径段之间的连接进行平滑的目标函数;至少根据由所述自动驾驶车辆感知的道路边界以及障碍物,基于相邻路径段对所述路径段的多项式函数限定约束集合;根据所添加的约束对所述目标函数执行二次规划优化,使得在满足所述约束集合的情况下所述目标函数的输出达到最小值;以及基于所述二次规划优化,通过已优化的目标函数生成表征路径轨迹的第二路径轨迹,以根据所述第二路径轨迹自动控制所述自动驾驶车辆。
【技术特征摘要】
2017.09.18 US 15/707,2531.用于优化自动驾驶车辆的路径轨迹的计算机实现的方法,所述方法包括:将自所述自动驾驶车辆的起始位置所选择的第一路径轨迹分段成多个路径段,其中每个路径段由多项式函数表征;根据所述路径段的多项式函数,选择用于对所述路径段之间的连接进行平滑的目标函数;至少根据由所述自动驾驶车辆感知的道路边界以及障碍物,基于相邻路径段对所述路径段的多项式函数限定约束集合;根据所添加的约束对所述目标函数执行二次规划优化,使得在满足所述约束集合的情况下所述目标函数的输出达到最小值;以及基于所述二次规划优化,通过已优化的目标函数生成表征路径轨迹的第二路径轨迹,以根据所述第二路径轨迹自动控制所述自动驾驶车辆。2.如权利要求1所述的方法,其中,对所述路径段的多项式函数限定约束集合包括:限定表征所述自动驾驶车辆的起始位置、方向和曲率的初始约束集合。3.如权利要求1所述的方法,其中,对所述路径段的多项式函数限定约束集合包括:限定表征道路边界的上边界约束和下边界约束。4.如权利要求1所述的方法,其中,所述路径段的多项式函数是五阶多项式函数。5.如权利要求1所述的方法,其中,所述多项式函数是在行驶距离-横向偏移坐标系中表示为行驶距离单元的函数的横向偏移单元。6.如权利要求1所述的方法,其中,所述目标函数包括平滑核。7.如权利要求1所述的方法,其中,所述目标函数包括所述自动驾驶车辆改变车道时的引导核。8.如权利要求1所述的方法,还包括:利用不处于所述第一路径轨迹中的多个点对所述第二路径轨迹进行内插。9.非暂时性机器可读介质,所述非暂时性机器可读介质中存储有指令,所述指令在被处理器执行时使所述处理器执行操作,所述操作包括:将自所述自动驾驶车辆的起始位置所选择的第一路径轨迹分段成多个路径段,其中每个路径段由多项式函数表征;根据所述路径段的多项式函数,选择用于对所述路径段之间的连结处进行平滑的目标函数;至少根据由所述自动驾驶车辆感知的道路边界以及障碍物,基于相邻路径段对所述路径段的多项式函数限定约束集合;根据所添加的约束对所述目标函数执行二次规划优化,使得在满足所述约束集合的情况下使所述目标函数的输出达到最小值;以及基于所述二次规划优化,通过已优化的目标函数生成表征路径轨迹的第二路径轨迹,以根据所述...
【专利技术属性】
技术研发人员:樊昊阳,张亮亮,张雅嘉,朱伟铖,蒋一飞,罗琦,胡江滔,孔旗,
申请(专利权)人:百度美国有限责任公司,
类型:发明
国别省市:美国,US
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。