一种无人驾驶汽车轨迹规划方法

1.本发明涉及无人驾驶技术领域，特别涉及一种无人驾驶汽车轨迹规划方法。


背景技术：

2.在过去的数十年中，交通事故造成的伤亡人数每年都在增加。自动驾驶汽车由于操作快速且感知准确，可以大大减少驾驶员分心和疲劳引起的事故。除了提高安全性外，自动驾驶汽车还可以大大提高驾驶舒适性、交通效率和能源经济性。
3.目前，轨迹规划的四种主要方法为基于图搜索的方法、增量搜索法、曲线插值法和数值优化法。其中，图搜索通过遍历所有环境网格找到最短路径。但是，所得路径并不连续，因此不适用于自动驾驶汽车。增量搜索方法允许节点在连续空间中随机地向目标延伸。但是，生成的轨迹是生涩的，通常不是最佳轨迹。曲线插值法可以生成平滑的路径，但是轨迹规划的结果取决于全局航路点，并且该方法在多变的环境中非常耗时。现有技术中，通常使用数值优化法来考虑道路和主车辆的约束。轨迹则是由约束和目标函数生成的。但是，优化过程需要在每个时间同步执行，耗时且需要较高级别的硬件。
4.因此，在现有无人驾驶轨迹规划技术的基础上，如何在保证模型精确性的前提下，提高轨迹规划效率，并减少计算时间，成为本领域技术人员亟需解决的问题。


技术实现要素：

5.鉴于上述问题，本发明提出了一种至少解决上述部分技术问题的无人驾驶汽车轨迹规划方法，该方法可有效提高轨迹规划效率，并减少计算时间。
6.本发明实施例提供一种无人驾驶汽车轨迹规划方法，包括如下步骤：
7.s1、获取待轨迹规划的无人驾驶汽车的环境及车辆状态信息；所述环境及车辆状态信息包括：本车状态、本车位置、环境信息、交通信息和道路信息；
8.s2、将所述环境及车辆状态信息输入局部轨迹规划器，基于运动学模型，遵循相应的评价指标，规划局部最优轨迹；
9.s3、将规划得到的局部最优轨迹作为期望轨迹输入轨迹跟踪控制器，以囊括优化参数的目标函数为评价依据，在相应的预设约束条件下，计算所述待轨迹规划的无人驾驶汽车的车辆前转向轮的最优动作序列；所述优化参数包括：横向跟踪误差和控制量变化率；
10.s4、根据所述最优动作序列，通过操纵所述待轨迹规划的无人驾驶汽车的执行机构，保证所述待轨迹规划的无人驾驶汽车按照规划的轨迹安全行驶。
11.进一步地，所述步骤s3还包括：将规划得到的局部最优轨迹进行重采样，将较大的离散时间步长转变成较小的离散时间步长；将重采样后的局部最优轨迹作为期望轨迹输入轨迹跟踪控制器。
12.进一步地，所述步骤s2中，所述局部轨迹规划器将规划所述局部最优轨迹表示为方程的最优控制问题，在预设预测范围中生成控制变量的最优控制序列：
[0013][0014]
上式中，l(x(t),u(t),t)为预设预测范围[t，t+t]的成本函数；u(t)为预设预测范围[t，t+t]内的最优控制序列；f(x(t),u(t))为状态空间表达式；x(t)为状态变量。
[0015]
进一步地，所述成本函数包括环境成本和轨迹成本；所述环境成本包括：车道保持成本函数、道路边界成本函数和避障成本函数；所述轨迹成本包括：轨迹速度指标成本函数、轨迹控制量变化量成本函数和轨迹一致性成本函数。
[0016]
进一步地，所述避障成本函数的表达式为：
[0017][0018]
上式中，a
obs
代表避障成本函数的权重系数；v(t)代表本车速度；x(t)为t时刻本车横坐标位置；y(t)为t时刻本车纵坐标位置；x
obs
代表障碍物的横坐标位置；y
obs
代表障碍物的纵坐标位置；ζ为调整系数。
[0019]
进一步地，所述步骤s2中，在预设预测范围中生成控制变量的最优控制序列之后，还包括：将所述最优控制序列根据预设条件进行约束；所述预设条件包括：分别将本车加速度和前轮转角控制在第一预设范围和第二预设范围内，以及约束本车的位置。
[0020]
进一步地，通过如下公式约束本车的位置：
[0021][0022]
上式中，x(t)为t时刻本车横坐标位置；x(t)
obs
为t时刻环境车辆横坐标位置；r
x
为不发生碰撞情况下横坐标所留预设安全距离；y(t)为t时刻本车纵坐标位置；y(t)
obs
为t时刻环境车辆纵坐标位置；ry为不发生碰撞情况下纵坐标所留预设安全距离。
[0023]
进一步地，所述局部轨迹规划器具有较大的离散时间步长。
[0024]
进一步地，所述轨迹跟踪控制器具有较小的离散时间步长。
[0025]
进一步地，所述轨迹跟踪控制器的目标函数包括两部分性能指标，分别为：对所述局部最优轨迹的跟踪能力和控制量的平稳程度。
[0026]
本发明实施例提供的上述技术方案的有益效果至少包括：
[0027]
本发明实施例提供的一种无人驾驶汽车轨迹规划方法，包括：获取待轨迹规划的无人驾驶汽车的环境及车辆状态信息；将环境及车辆状态信息输入局部轨迹规划器，基于运动学模型，遵循相应的评价指标，规划局部最优轨迹；将规划得到的局部最优轨迹作为期望轨迹输入轨迹跟踪控制器，以囊括优化参数的目标函数为评价依据，在相应的预设约束条件下，计算待轨迹规划的无人驾驶汽车的车辆前转向轮的最优动作序列；根据最优动作序列，通过操纵待轨迹规划的无人驾驶汽车的执行机构，保证待轨迹规划的无人驾驶汽车按照规划的轨迹安全行驶。该方法在保证模型精确性的前提下，提高了轨迹规划效率，降低了模型复杂度，并减少了计算时间。
[0028]
本发明的其它特征和优点将在随后的说明书中阐述，并且，部分地从说明书中变得显而易见，或者通过实施本发明而了解。本发明的目的和其他优点可通过在所写的说明
书、权利要求书、以及附图中所特别指出的结构来实现和获得。
[0029]
下面通过附图和实施例，对本发明的技术方案做进一步的详细描述。
附图说明
[0030]
附图用来提供对本发明的进一步理解，并且构成说明书的一部分，与本发明的实施例一起用于解释本发明，并不构成对本发明的限制。在附图中：
[0031]
图1为本发明实施例提供的无人驾驶汽车轨迹规划方法流程图；
[0032]
图2为本发明实施例提供的结构框图；
[0033]
图3为本发明实施例提供的规划层与控制层衔接过程示意图。
具体实施方式
[0034]
下面将参照附图更详细地描述本公开的示例性实施例。虽然附图中显示了本公开的示例性实施例，然而应当理解，可以以各种形式实现本公开而不应被这里阐述的实施例所限制。相反，提供这些实施例是为了能够更透彻地理解本公开，并且能够将本公开的范围完整的传达给本领域的技术人员。
[0035]
本发明实施例提供一种无人驾驶汽车轨迹规划方法，参照图1所示，包括如下步骤：
[0036]
s1、获取待轨迹规划的无人驾驶汽车的环境及车辆状态信息；环境及车辆状态信息包括：本车状态、本车位置、环境信息、交通信息和道路信息；
[0037]
s2、将环境及车辆状态信息输入局部轨迹规划器，基于运动学模型，遵循相应的评价指标，规划局部最优轨迹；
[0038]
s3、将规划得到的局部最优轨迹作为期望轨迹输入轨迹跟踪控制器，以囊括优化参数的目标函数为评价依据，在相应的预设约束条件下(指控制量与控制量增量约束)，计算待轨迹规划的无人驾驶汽车的车辆前转向轮的最优动作序列；优化参数包括：横向跟踪误差和控制量变化率；
[0039]
s4、根据最优动作序列，通过操纵待轨迹规划的无人驾驶汽车的执行机构，保证待轨迹规划的无人驾驶汽车按照规划的轨迹安全行驶。
[0040]
本实施例提供的无人驾驶汽车轨迹规划方法，在保证模型精确性的前提下，提高了轨迹规划效率，降低了模型复杂度，并减少了计算时间。
[0041]
具体地，该方法包含多个子模块，其结构框图如图2所示，主要包括：感知系统、规划系统和控制系统。基于已知环境信息，在主导车辆局部运动的无人驾驶领域，无人车的局部轨迹规划(通过规划层实现)与跟踪控制(通过控制层实现)是实现无人驾驶技术的关键和基础。在全局路径参考下，局部轨迹规划控制器(mpc规划器)收到感知模块或其他传感器感知的环境及车辆的状态信息(包括：本车状态、本车位置、环境信息、交通信息和道路信息)，基于适当精度的运动学模型，遵循相应的评价指标，在车道线、道路边界、周围车辆及环境障碍物等复杂环境中，规划出一条符合约束且安全可行的较优局部轨迹；上层规划的轨迹作为下层轨迹跟踪层的期望轨迹，轨迹跟踪控制器(mpc控制器)基于非线性车辆模型，以囊括横纵向跟踪误差、控制量变化率等优化参数的目标函数为评价依据，在具体的约束条件下，计算车辆前转向轮的最优动作序列，保证车辆的实际轨迹不仅能及时贴合上游规
划的期望值，而且能保证车辆的安全性、舒适性及高效性。
[0042]
其中，感知系统，用于获得当前车辆以及环境车辆行驶状态信息，并进行信号处理，包括：借助车载智能感知模块中雷达环境感知元件、车载摄像头得到的周围车辆的车道、速度和加速度，本车的车道、速度以及以本车车道为基准的相对距离，并通过环境车辆与其车道中心线的偏移或转向灯信息得到环境车的驾驶意图，收集数据用于后续规划控制系统使用。
[0043]
规划系统，收集感知系统传来的环境信息。该环境信息包括：周围车辆的车道、速度和加速度；本车的车道、速度以及以本车车道为基准的相对距离；并通过环境车辆与其车道中心线的偏移或转向灯信息得到环境车的驾驶意图。通过感知系统得知的周边环境信息，确定当前智能车辆自身的位置，以及周边障碍车辆信息、道路信息。确定是否执行换道决策，并对未来一段时间内车辆的状态进行规划。
[0044]
控制系统，主要负责将规划系统规划出的结果准确地执行，在合适的时刻给智能车上的执行机构发出信号，通过对油门、刹车和转向盘等执行机构的操纵来保证智能车能够按照规划的结果安全行驶。
[0045]
具体规划系统包括以下步骤：
[0046]
步骤一，规划器模型的建立：
[0047]
规划层采用基于运动学模型的mpc规划器(局部轨迹规划器)。建立车辆运动学模型(规划器预测模型)。包括：
[0048]
车辆运动学模型的建立：
[0049]
运动学模型基于纵向和横向动力学，自动驾驶中的车辆模型可以简化为二维平面上运动的刚体结构、任意时刻车辆的状态、车辆坐标的原点位于后轴的中心位置，坐标轴与车身平行。以单车模型为基础建立车辆的运动学模型，(x，y)为后轴中心坐标；ψ为航向角；v为车速；δf为前轮转角；δr为后轮转角，恒为0
°
；w为横摆角速度；β为滑移角，极小，假设为0；1为车辆前后轴轴距。当状态量为[x，y，ψ]
t
，被控量为u＝[v，δf]
t
时，有如下公式(2.1)：
[0050][0051]
但在无人驾驶车辆控制过程中，一般控制量u＝[a，w]
t
，a为车辆纵向加速度，则公式(2.1)可写为公式(2.2)：
[0052][0053]
步骤二，规划器优化问题的建立：
[0054]
mpc规划器的运动学模型规划方法，根据周围环境参数，调整优化的目标并得到约束条件；并在不基于固定轨迹形式的情况下，通过对优化问题在线求解并滚动优化进行轨迹规划。
[0055]
遵循相应的评价指标，基于各个约束条件求解，具体求解过程如下：
[0056]
首先，将主车辆状况、交通信息和路径规划信息，作为mpc规划器的轨迹规划模块的输入；轨迹规划模块基于传递的信息，规划最佳轨迹，并生成(x(t)，y(t)，δ(t)，a(t))的序列，其中，x(t)为时刻t的车辆横坐标(本车的横向位置)，y(t)为时刻t的车辆纵坐标(本车的纵向位置)，δ(t)为时刻t的前轮转角，a(t)为时刻t的车辆纵向加速度；后续将该序列转换到轨迹跟踪控制器，使得自动驾驶汽车遵循生成的最佳轨迹。
[0057]
其次，通过mpc规划器的轨迹规划算法负责规划轨迹，使得车辆执行车道变换或车道保持动作；将轨迹规划实施表示为方程中的最优控制问题，以在预测范围[t，t+t]中找到控制变量u(t)＝[δ(t)，a(t)]
t
的最优控制序列，从而得到式(6a)和(6b)：
[0058][0059][0060]
上式中，l(x(t)，u(t)，t)为预测范围[t，t+t]的成本函数；u(t)为预测范围[t，t+t]内的最优控制序列；f(x(t)，u(t))为状态空间表达式；x(t)为状态变量。
[0061]
其中，成本函数可以如下表示：
[0062]
l(x(t)，u(t)，t)
[0063]
＝l
road
(x(t)，u(t)，t)+l
lane
(x(t)，u(t)，t)+l
obs
(x(t)，u(t)，t)+l
keep
(x(t)，u(t)，t)+lv(x(t)，u(t)，t)+l
con
(x(t)，u(t)，t)
ꢀꢀꢀꢀꢀ
(3)
[0064]
成本函数主要包括环境成本与轨迹成本。考虑环境成本的成本函数主要包括l
road
(x(t)，u(t)，t)，l
keep
(x(t)，u(t)，t)，l
obs
(x(t)，u(t)，t)三项。
[0065]
其中，为使车辆在无需换道时，执行车道保持动作，采用的车道保持成本函数如下：
[0066][0067]
上式中，a
keep
代表此成本函数的权重系数，y(t)代表车辆的纵向位置，σ
keep
是一个与车道宽度相关的调整系数，l
keep1
与l
keep2
分别代表车道中心线1与车道中心线2的位置。
[0068]
为使车辆不越过道路边界，采用的道路边界成本函数如下：
[0069][0070]
上式中，a
road
代表此成本函数的权重系数，y(t)代表车辆的纵向位置，l
road1
与l
road2
分别代表车道边界线1与车道边界线2的位置。
[0071]
为使车辆尽量远离障碍物，采用的避障成本函数如下：
[0072][0073]
上式中，a
obs
代表此成本函数的权重系数，v(t)代表本车速度，x(t)代表本车的横向位置，y(t)代表本车的纵向位置，x
obs
与y
obs
分别代表障碍车(物)横纵坐标，ζ为一个防止l
obs
(x(t)，u(t)，t)过大的调整系数。
[0074]
考虑轨迹成本(生成轨迹性能)的成本函数主要包括lu(x(t)，u(t)，t)，lv(x(t)，u
(t)，t)，l
con
(x(t)，u(t)，t)三项。
[0075]
考虑规划轨迹速度指标的成本函数如下：
[0076]
lv(x(t)，u(t)，t)＝av|v
max-v(t)|
ꢀꢀꢀꢀꢀ
(7)
[0077]
上式中，av代表此成本函数的权重系数，v(t)代表本车速度，v
max
代表最高容许车速。
[0078]
考虑规划轨迹控制量变化量的成本函数如下：
[0079][0080]
上式中，au代表此成本函数的权重系数，m代表预测时域步长，δu代表控制量变化量。
[0081]
为了减少不必要的规划轨迹的改变，考虑规划轨迹一致性函数的成本函数如下：
[0082][0083]
上式中，a
con
代表此成本函数的权重系数，和代表进行比较的t时刻的候选轨迹上第i个点的自然坐标系坐标值。和代表进行比较的t-δt时刻的候选轨迹上第i个点的自然坐标系的横坐标值和纵坐标值。k用来表示滚动时域向后滚动一次，走过k倍的模型离散步长。nb代表候选轨迹从t＝0到t＝t之间进行离散点的总数；轨迹离散后，会变成一个个轨迹点，这里指轨迹点的总数。
[0084]
步骤三，快速求解：
[0085]
通过优化直接获得轨迹，在优化过程中，通过简化规划器预测模型减少计算时间，通过延长控制时间步长(控制时域不变，增加控制步长)减少要解决的变量数量。为保证控制层控制精度，在规划轨迹传递给轨迹跟踪层(轨迹跟踪控制器)前，需要对轨迹进行重采样，完成规划层轨迹与跟踪控制层轨迹的衔接，将较大的离散时间步长转变成较小的离散时间步长。
[0086]
对规划出的轨迹进行重采样时，令代表t时刻重采样前的候选轨迹上第i个点的速度，则重采样方法可表达为式(10)。
[0087][0088]
上式中，代表轨迹向量，代表重采样前候选轨迹第i个点的轨迹向量，代表重采样后，原候选轨迹第i个点依次往后j个轨迹点的轨迹向量。
[0089]
步骤四，非线性模型预测控制问题的建立与求解：
[0090]
采用基于非线性车辆模型的mpc控制器(轨迹跟踪控制器)。为保证控制精度，控制器模型选取车辆非线性动力学模型(非线性车辆模型)，对步骤三求解出的轨迹进行跟踪，轨迹跟踪控制器具有较小的离散时间步长(控制时域不变，缩小控制步长)。
[0091]
对重采样后的轨迹进行跟踪时，控制器成本函数j(k)(目标函数)采用跟踪型指标，如式(11)所示。
[0092][0093]
为了综合两部分性能指标在控制器中的影响效果，特设定权重矩阵q和r，权重矩阵q反映系统对参考轨迹的跟踪能力，权重矩阵r反映控制量的平稳程度。ρ是权重系数，ε是松弛因子，ε用来保证最优解一定存在。n
p
代表预测时域步长，nc代表控制时域步长。
[0094]
准确性成本函数j1(k)为：
[0095]
预测时域内预测输出与期望输出二者差的平方和的形式，将平稳性目标函数j2(k)设定为控制时域内控制量增量δuf(k+i)的平方和的形式。
[0096]
本实施例提供的无人驾驶汽车轨迹规划方法能够达到以下有益效果：
[0097]
本实施例的无人驾驶汽车轨迹规划方法，具有如下优势，(1)其使用的mpc规划器同时包括了换道决策与轨迹规划，相比传统的基于采样的机器人轨迹规划方法，该规划器能得出局部最优轨迹；(2)其使用比传统自行车模型更精确的，同时考虑了纵向和横向动力学的非线性模型。使用转向和制动系统来实现对紧急避障的控制；(3)规划层通过使用化简后的模型与较大的离散时间步长，成功减少所用的求解过程的时间；(4)控制层通过更精确的模型与较小的离散时间步长使得车辆即使在高速情况下也能获得良好的运动控制性能。
[0098]
显然，本领域的技术人员可以对本发明进行各种改动和变型而不脱离本发明的精神和范围。这样，倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内，则本发明也意图包含这些改动和变型在内。