Real-Time Trajectory Planning for Autonomous Urban Driving: Framework, Algorithms, and Verifications

最新推荐文章于 2023-04-09 00:42:46 发布

小朱智能驾驶

最新推荐文章于 2023-04-09 00:42:46 发布

阅读量813

点赞数

分类专栏：文献阅读

本文链接：https://blog.csdn.net/weixin_37532614/article/details/107098354

版权

文献阅读专栏收录该内容

1 篇文章 0 订阅

订阅专栏

Real-Time Trajectory Planning for Autonomous Urban Driving: Framework, Algorithms, and Verifications

Abstract

这篇文章针对的是真实城市道路环境下自动驾驶车辆的实时轨迹规划问题。使用了一个分层的运动规划框架。首先，根据高层的行为决策器和高精度地图，生成一个粗略的参考路径，然后使用共轭梯度非线性优化算法和三次B样条来平滑和插值参考路径；为了能够在跟踪路径的过程中，同时处理动态静态障碍物，轨迹规划在frenet坐标系下被分成了横向和纵向两个单独的部分。

1. INTRODUCTION AND STATE OF THE ART

2. SYSTEM FRAMEWORK

3. SYSTEM ALGORITHMS

这篇文章的话，针对的是有车道线的结构化场景的导航问题。

3.1 Reference Path Smoothing and Interpolation

对于一组给定的的初始参考路径点，通过下列的目标函数进行优化来进行平滑。
$\argmin \left\lbrace \omega_{1} \sum^{N-1}_{i=1} \left( \Delta x_{i+1}-\Delta x_i \right)^{2} + \omega_{2} \sum^{N-1}_{i=1} \left( \frac{\Delta\theta_{i}}{\lvert \Delta x_{i} \rvert} \right)^{2} + f\left( x_{i} \right) \right\rbrace$

$\Delta x_{i}=x_{i}-x_{i-1}$ 是在 $x_i=\left( x_i, y_i\right)$ 点处的位移向量；
$\Delta \theta = \arccos\left( \frac{\Delta x_{i+1}\Delta x_{i}}{\lvert\Delta x_{i+1}\rvert \lvert\Delta x_{i}\rvert} \right)$ 是在 $x_i=\left( x_i, y_i\right)$ 点处的向量方向变化量；
$f\left( x_{i} \right)$ 为一个可导非线性函数，当点 $x_{i}$ 靠近边界时，它的值会变得无穷大，在边界以内的时候，它的值接近0。

完成路径的平滑以后，因为路径点太稀疏，下一步进行路径点之间的插值运算，插值使用三次B样条进行：

离散控制点为 $P_{i}\left( i=0,1,....n \right)$ ，分段三次B样条可以写为
$C\left(u\right)=\sum^n_{i=0}P_iG_{i,3}\left(u\right)=\frac{1}{6}\begin{bmatrix}u^3 & u^2 & u & 1 \\ \end{bmatrix}\begin{bmatrix} -1 & 3 & -3 & 1 \\ 3 & -6 & 3 & 0 \\ -3 & 0 & 3 & 0 \\ 1 & 4 & 1 & 0 \end{bmatrix}\begin{bmatrix} P_i \\ P_{i+1} \\ P_{i+2} \\ P_{i+3} \end{bmatrix} u \in \left[0,1\right]$

其中， $G_{i,3}$ 是B样条的基函数。

3.2 Spatial Path Generation Based on the Curvilinear Coordinate Framework

Frenet 坐标系的优势：可以将车辆的横向和纵向的行为分解开。
经过平滑与插值算法处理后，得到的路径作为基本参考轨迹。

根据微分平坦理论，多项式曲线可以表示从当前状态点到采样终点状态点之间的平滑过度曲线：
$l\left( s \right) = c_0 + c_1 s + c_2 s^2 + c_3s^3$
为了确定上式中的系数，根据初始边界条件，有：
$l\left( s_0 \right) =l_0,l\left( s_f \right) =l_f$

$\theta\left( s \right)=\arctan\left( \frac{dl}{ds} \right)$ 为车辆本体与基础参考轨迹之间的航向偏差。

为了保证生成的路径能够与基础轨迹尽量重合，在预瞄点处航向设置为与基础参考轨迹的切向相同。但是在起点处，车辆的起始航向与基础参考路径的航向可以不同，因此可以得到下列的边界条件：
$\theta\left( s_0 \right) =\theta_0,\theta\left( s_f \right) =0$
基于上述的4个边界条件，可以求解得到曲线的多项式系数。