一种基于改进人工势场的商用车车道保持路径规划方法与流程

本发明属于汽车智能转向控制技术领域，具体涉及一种基于改进人工势场的商用车车道保持路径规划方法。

背景技术：

随着我国道路交通的迅速发展，智能化需求进一步凸显，越来越多的商用车急需配备智能辅助驾驶相关技术，现有相关的智能驾驶辅助技术包括车道保持lka、车道偏离预警ldw、自适应巡航acc，其中ldw已经成为法规所要求的商用车必须配备的功能之一，而lka作为ldw的改进版，在横向主动控制方面有着重要意义与价值，在未来几年必将纳入法规要求的智能辅助驾驶技术之一。

在现有研究车道保持辅助驾驶的相关技术中，常见的控制方法有pid、自适应预瞄、滑模、神经网络等，除此之外人工势场法因计算量小、反应速度快、易于实现且算法与环境形成闭环控制，规划出的路径平滑等优点在车道保持路径规划方面具有独特的参考研究意义。在国内利用人工势场研究车道保持系统的多是构造不同的势场函数，传统的有基于车道中心线横向偏差与偏航角的道路势场，也有改进之后将横向车速引入的，但控制精度仍然不是很理想。对于商用车车道保持系统研究设计而言，往往存在侧向力大，汽车在控制过程中容易失稳的现象时有发生，车道保持对于商用车的控制难度也进一步增加，也就是说在利用人工势场法研究商用车车道保持过程中，如何能将车辆自身的一些时变的参数变量考虑进来并能够克服商用车失稳，是当前研究的重点问题。

技术实现要素：

本发明根据现有技术中存在的问题，提出了一种基于改进人工势场的商用车车道保持路径规划方法，本发明通过构造改进的人工势场函数，在传统道路势场函数的基础上，进一步将跨道时间tlc这一动态参量引入，并将商用车的稳定性这一因素考虑进去，并利用pso智能算法，以横向偏差的方差作为评价函数，得出最优控制的人工势场函数增益，最终得到控制效果最优的人工势场函数的表达形式和规划路径。

一种基于改进人工势场的商用车车道保持路径规划方法，包括以下过程：

本发明所采用的技术方案如下：

根据基于预瞄横向偏差的虚拟引力势场函数v预瞄、基于跨道时间tlc的虚拟斥力势场函数v跨道和横摆角速度ω虚拟斥力势场函数vω构建人工势场函数v＝v预瞄+v跨道+vω；

构造李亚普洛夫函数l＝t+v，t为整车动能，v为人工势场函数，通过控制稳定性分析确定势场函数增益c1、c2、c3的取值范围；

通过人工势场函数计算理想前轮偏转角δ，将δ输入到整车模型中，根据既定工况路径进行跟踪；计算路径横向偏差离差平方和e，再利用粒子群优化算法求最优势场函数增益，得到最优的理想前轮偏转角δ^*。

进一步，所述基于预瞄横向偏差的虚拟引力势场函数v预瞄表示为：其中，c1预瞄横向偏差虚拟引力势场函数增益，e为车辆质心距离车道中心线的横向距离，xcf为质心到势场力作用点的距离，xla为预瞄距离，即预瞄点到势场力作用点之间的距离；为车辆航向角；

进一步，所述基于跨道时间tlc的虚拟斥力势场函数表示为：其中，τ为跨道时间阈值，c2为跨道时间虚拟斥力势场函数增益，tlc为跨道时间；

进一步，所述跨道时间tlc包括直道跨道时间tlcz和弯道跨道时间tlcw，

其中，ω为横摆角速度，为车辆航向角，v为汽车行驶车速，dline为车道宽度，l为车辆轴距，db为车辆前轮距，d为车辆转弯中心点到车道中心线之间的距离，rv为转弯半径，rr为曲率半径，r2为路径曲率中心与车辆转弯中心之间的距离，d1为车辆左前轮到左侧车道线的距离。

进一步，所述横摆角速度ω的虚拟斥力势场函数表示为：其中，μ为路面附着系数，c3为横摆角速度虚拟斥力势场函数增益；v为汽车行驶车速，g为重力加速度。

进一步，所述s2中的稳定性判定条件ⅰ为：l＞0，即势场函数增益c1、c2、c3均大于0；稳定性判定条件ⅱ为：根据得到包含势场函数增益c1、c2、c3的不等式：f(c1,c2,c3)≤0；得到势场函数增益的取值范围为：

进一步，利用粒子群优化算法求最优势场函数增益的方法为：

以势场函数增益c1、c2、c3为寻优对象，并设置搜寻空间维度d；

初始化粒子群的随机位置、速度以及迭代次数n，获取位置初始值范围和速度初始值范围；

将所得势场函数增益取值范围作为约束条件，以路径横向偏差离差平方和作为优化目标函数，计算每次不同c1、c2、c3取值下的ei，0＜i＜n；t0为跟踪时间,为路径横向偏差平均值；

将每次计算的ei进行比较，得到ei最小时对应的最优势场函数增益c1best、c2best、c3best；

进一步，得到最优的理想前轮偏转角δ^*的方法为：根据pso优化得到的c1best、c2best、c3bes，得到最优理想前轮偏转角δ^*，δ^*表示为：

本发明的有益效果：

本发明利用人工势场法解决商用车车道保持的路径规划问题，在传统的道路势场的基础上，进一步引入跨道时间tlc和横摆角速度这ω两个动态参量，将其作为斥力场源，充分考虑了车速v以及横摆角速度ω等车辆自身的状态参量对车道保持路径规划的影响，将车辆转向防侧翻控制在上层控制中体现，降低车辆在行驶过程中发生侧翻的风险，提高行驶稳定性；

本发明在选取势场函数增益时利用智能算法pso，将各项势场函数增益作为优化粒子，以横向偏差的方差作为评价函数，并通过构造李亚普洛夫函数对势场函数进行稳定性分析，约束增益范围，得出最优控制的人工势场函数增益，最终得到控制效果最优的人工势场函数的表达形式和规划路径。

附图说明

图1为一种基于改进人工势场的商用车车道保持路径规划方法流程图；

图2为预瞄偏差人工势场示意图。

具体实施方式

为了使本发明的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅用于解释本发明，并不用于限定本发明。

以上实施例仅用于说明本发明的设计思想和特点，其目的在于使本领域内的技术人员能够了解本发明的内容并据以实施，本发明的保护范围不限于上述实施例。所以，凡依据本发明所揭示的原理、设计思路所作的等同变化或修饰，均在本发明的保护范围之内。

如图1所示为一种基于改进人工势场的商用车车道保持路径规划方法，包括以下步骤：

1.通过车载传感器组采集车辆状态信息和道路信息；所采集的车辆状态信息主要包括有汽车行驶车速v，以及横摆角速度ω，上述状态信息通过车速传感器和陀螺仪可以得到；所采集的道路信息主要包括前方道路的曲率k、车辆质心到左侧车道线的距离y以及车辆的横向偏差e与航向角上述道路信息可以通过惯导系统和摄像头获取；

2.根据前方道路曲率k，判断前方道路是直道还是弯道；当k为0时，代表前方道路为直道，当k大于0时，代表前方道路为弯道；

3.根据步骤2中的道路判定结果计算跨道时间tlc，跨道时间tlc包括直道跨道时间tlcz和弯道跨道时间tlcw；直道跨道时间tlcz计算公式如下：

其中，ω为横摆角速度，δ为前轮偏转角，为车辆航向角，v为汽车行驶车速，dline为车道宽度，l为车辆轴距，db为车辆前轮距，d1为车辆左前轮到左侧车道线的距离，a为前轴距；

弯道跨道时间tlcw计算公式如下：

其中，rv为转弯半径，rr为曲率半径，r2为路径曲率中心与车辆转弯中心之间的距离，d为车辆转弯中心点到车道中心线之间的距离；

4.分别建立基于预瞄横向偏差ela的虚拟引力势场函数v预瞄、基于跨道时间tlc的虚拟斥力势场函数v跨道、横摆角速度ωr的虚拟斥力势场函数vω，并构建人工势场函数v；具体过程如下：

如图2，基于预瞄横向偏差的虚拟引力势场函数表示为，

其中，c1预瞄横向偏差虚拟引力势场函数增益，e为车辆质心距离车道中心线的横向距离，xcf为质心到势场力作用点的距离，xla为预瞄距离，即预瞄点到势场力作用点之间的距离；为车辆航向角；

基于跨道时间tlc的虚拟斥力势场函数表示为：

其中，τ为跨道时间阈值，c2为跨道时间虚拟斥力势场函数增益；

横摆角速度ω的虚拟斥力势场函数表示为：

其中，μ为路面附着系数，c3为横摆角速度虚拟斥力势场函数增益；v为汽车行驶车速，g为重力加速度；

由式(7)、(8)、(9)构造人工势场函数：

5.通过控制稳定性分析确定势场函数增益c1、c2、c3的取值范围；具体步骤如下：

5.1.构造李亚普洛夫函数；函数形式如下：

l＝t+v(11)

其中，t为整车动能，具体公式为v为人工势场函数；

5.2.利用稳定性判定条件ⅰ对系统进行判定，判断条件ⅰ为：l＞0；其中对第一个条件当c1、c2、c3均大于0时，满足条件，显然满足；

5.3.利用稳定性判定条件ⅱ对系统进行判定，判定条件ⅱ为

通过得到包含c1、c2、c3的不等式：f(c1,c2,c3)≤0；式中，为l的一阶导数，为v的一阶导数，为ωr的一阶导数，iz为车辆转动惯量，为ω的一阶导数，为v的一阶导数，vy为侧向车速，和分别是v、v预瞄、v跨道、vω的一阶求导，

5.4.最终得到势场函数增益的取值范围如下：

6.通过粒子群优化算法(pso)对势场函数增益进行优化，得到最优的理想前轮偏转角δ^*；具体步骤如下：

6.1通过式(10)的人工势场函数得到理想前轮偏转角δ表达式；

6.2将计算得到的理想前轮偏转角δ输入到整车模型中，根据既定工况路径进行跟踪，得到路径偏差δy(t)；

6.3以势场函数增益c1、c2、c3为寻优对象，并设置搜寻空间维度d；

6.4初始化粒子群的随机位置、速度以及迭代次数n，获取位置初始值范围和速度初始值范围；

6.5以步骤5.4所得势场函数增益取值范围作为约束条件，以路径横向偏差离差平方和作为优化目标函数，计算每次不同c1、c2、c3取值下的ei，0＜i＜n；t0为跟踪时间,为路径横向偏差平均值；

6.6将每次计算的ei进行比较，得到ei最小时对应的最优势场函数增益c1best、c2best、c3best；

6.7根据pso优化得到的c1best、c2best、c3best，得到最优理想前轮偏转角δ^*；δ^*具体表达式如下：