[发明专利]一种基于程序方位角的车辆沿车道线自动驾驶的方法

说明书

本发明涉及一种基于程序方位角的车辆沿车道线自动驾驶的方法，该方法仅需要采用位置传感器安装于车辆的前后保险杠测量车辆离道路中心线的偏差，然后设置程序运动的目标于道路中心线上，最后根据程序目标与车辆之间的位置关系计算程序方位角，最后根据该方位角，采用非线性比例积分组合方式得到车辆沿车道线行使的自动驾驶方法。本发明的优点在于需要测量的信息最少，仅仅测量车辆的位置偏差，因此实施简单，成本低；其次采用程序目标计算程序方位角的方式，得到的自动驾驶规律符合人的思维习惯，基本是巧妙地模拟了非自动驾驶中驾驶员的判断决策过程，因此产生的自动驾驶规律具有较明确的物理意义，参数调整容易，得到的自动驾驶效果也较好。

技术领域

本发明属于自动驾与智能交通领域，尤其是涉及一种基于程序方位角的车辆沿车道线自动驾驶的方法。

背景技术

随着无人驾驶货车、无人驾驶公交车、无人驾驶汽车以及无人港口等技术的发展，车辆自动驾驶技术成为各国广泛研究的热点。其中探测车辆与车道线之间的位置偏差并采用自动控制技术消除该偏差的车道线保持技术成为了自动驾驶技术中的核心技术。目前已有的车辆自动驾驶技术都是基于车辆精确模型而采用滑模控制、反演控制等技术手段来实施的，该方法和实际生活中人的驾驶习惯是不同的。首先实际生活中驾驶员的驾驶并不关心车辆的重量、长度、轮胎磨擦系数等参数的精确值，其次大脑在转弯判断时仅关心误差角度，而并不采用太复杂的滑模或反演控制算法。

因此本发明提出一种设置程序目标位于车辆期望车道线的中心位置并以一定运动速度运动，从而得到驾驶员相对理想目标的期望方位角，并将该方位角折算成车辆转弯所需的前轮转向角的方法。

发明内容

本发明的目的是提供一种基于程序方位角的车辆沿车道线自动驾驶的方法，解决了现有技术中存在的基于车辆精确模型而采用滑模控制、反演控制等复杂运算控制且不符合人类驾驶习惯的问题。该方法具有测量简单、计算简单而且具有清晰的物理意义，也符合人类的驾驶习惯，最终也取得了较好的自动驾驶效果。

本发明的基于程序方位角的车辆沿车道线自动驾驶的方法是通过以下技术方案实现的：

一种基于程序方位角的车辆沿车道线自动驾驶的方法，其特殊之处在于：该方法采用位置传感器测量车辆离道路中心线的偏差，然后设置程序运动目标于道路中心线上，最后根据程序运动目标与车辆之间的位置关系计算程序方位角，该方位角类似于驾驶员实际驾驶中大脑计算产生的瞄准偏差角，最后根据该方位角，采用非线性比例积分组合方式得到车辆沿车道线行使的自动驾驶方法。

上述方法具体包括以下步骤：

步骤一：测量车辆偏离道路中心线的位置偏差

采用位置传感器测量车辆横向位置相对道路中心线的位置偏差，把该偏差记作y_s，定义如下：

y_s：表示车辆横向位置相对道路中心线的误差测量值；

步骤二：设置程序目标及车辆信息

设置程序目标位于车道中心线上，其侧线位移记为z_m，由于其位于车道中心线上，故记作z_m＝0；而程序目标纵向位移记为x_m，其程序运动方式可采用下式描述：x_m＝x_c+l，其中x_c为车辆的位移，l表示程序目标位于车辆的前方距离；

再设置车辆的位置，把车辆的侧线位移为记为z_c，车辆的纵向位移记为x_c；其中z_c采用第一步中的测量真实值，即z_c＝y_s；

x_c采用程序值，即采用车辆匀速运动估计方法设置，估计车辆运行速度大约为v_cm/s，则