[发明专利]车道线跟踪控制系统及其控制方法

说明书

技术领域

本发明涉及车道线跟踪控制系统及其控制方法，具体是利用从摄像头传感器及车辆传感器获得的信息，计算反映可变目标距离的车辆目标轨迹，以控制车辆转向跟踪根据算出的目标轨迹算出的目标横摆角速度的车道线跟踪控制系统及其控制方法。

背景技术

车道线跟踪控制系统是利用从摄像头传感器获得的图像信息检测车道线，根据车道线检测结果防止车辆偏离车道线的车辆控制系统。

车道线跟踪控制系统是使转向控制装置发生辅助转向力矩而控制转向，从而控制车辆在行驶中不偏离车道线。

所述车道线跟踪控制系统还开发有一种控制车辆转向使车辆跟踪道路中心行驶，以实施车道线跟踪控制的道路中心跟踪控制系统。

但所述传统的车道线跟踪控制系统是根据驾驶员的驾驶倾向设定车辆需要跟踪的基准跟踪位置，因此道路或者驾驶员的状态对其产生较大影响，或者车辆偏离基准跟踪位置时，为跟踪基准跟踪位置突然实施控制而容易给驾驶员造成不适感。或者利用已设定的目标距离计算横向误差对车辆实施控制而对车辆的状态反应迟钝，或者只会补偿已算出的目标轨迹横向误差，误判断发生偏离车道线的危险时因突然实施控制而有可能造成反应过大的问题。

发明内容

为解决上述问题，本发明提供一种车道线跟踪控制系统及其控制方法，该跟踪控制系统是在控制车辆车道线跟踪时，在各种行驶状况下仍然保持一贯的控制性能，设定可变目标距离，从而最大限度地减少因控制而产生的不适感。

同时本发明提供一种在实施车辆的车道线跟踪控制时在各种行驶状况下仍然保持一贯的控制性能，并设定可变目标距离，以最大限度地减少不适感的车道线跟踪控制方法。

为达到所述目的，本发明所采用的技术方案是提供一种车道跟踪控制系统，包括：目标距离计算部，随车速的输入计算目标距离；目标轨迹生成部，随车辆信息和摄像头图像信息的输入生成相离距离达所述目标距离的目标地点坐标，以原轨迹形态生成到达所述目标地点的目标轨迹。

所述车道线跟踪控制系统还包括：目标横摆角速度计算部，根据所述车辆和所述目标轨迹算出目标横摆角速度。

所述车道线跟踪控制系统还包括：目标转向角计算部，根据所述车辆和所述目标横摆角速度算出目标转向角。

所述车道线跟踪控制系统还包括：目标转向力矩控制部，基于车辆转向角和所述目标转向角算出目标转向力矩。

所述目标距离是随速度增加而加大，最小值被设定为恒定值。

所述目标距离计算部是，使目标距离、车速以及车道线曲率变化的同时模拟车辆行驶，判断车辆达到正常状态所需的时间、车道线中心和车辆之间横向偏移角误差以及超调量程度，随之设定不同速度下的目标距离。

所述目标轨迹生成部是，按照以下计算公式计算所述目标地点的坐标：

在这里y是到目标地点的横向距离，x是离目标地点的纵向距离，ρ_road是车道线中心曲率，L是目标距离，ε是离车道线中心的偏移值。

所述目标轨迹生成部是，计算旨在跟踪所述目标地点的所述目标轨迹的曲率。

旨在跟踪所述目标地点的所述目标轨迹的曲率是按照以下计算公式计算：

在这里，ρ_des是目标轨迹的曲率，R_des是目标轨迹的曲率半径，L是目标距离，φ是根据车道线中心的车辆方位角，x和y分别表示离目标地点的纵向距离和横向距离。

所述目标横摆角速度计算部是，根据以下计算公式计算所述目标轨迹的曲率，以及根据所述车速计算所述目标横摆角速度：

YR_des＝ρ_desV_x

在这里，YR_des是目标横摆角速度，ρ_des是目标轨迹的曲率，V_x是车速。

所述目标横摆角速度计算部是，基于所述目标轨迹曲率上反映的车辆转弯时侧滑所致误差的修正目标曲率，算出所述目标横摆角速度。

所述目标转向角计算部是，利用所述目标横摆角速度和车辆横摆角速度通过前馈（Feedforward）和反馈（Feedback）控制算出所述目标转向角。

所述目标转向角是基于利用对所述目标横摆角速度和正常状态下的横摆角速度的误差乘以积分增益加以补偿的方法算出的修正目标横摆角速度，算出所述目标转向角。

所述目标转向力矩控制部是，利用所述目标转向角和车辆转向角通过前馈（Feedforward）和反馈（Feedback）控制算出所述目标转向力矩。