辅助驾驶横向控制方法、系统、车辆及存储介质技术方案

技术编号:38829003 阅读:16 留言:0更新日期:2023-09-15 20:08
本发明专利技术涉及辅助驾驶技术领域,提供一种辅助驾驶横向控制方法、系统、车辆及存储介质,方法包括:获取车道线信息;基于车道线信息和预设的车辆运动坐标系,得到车辆在预设时间段内的参考轨迹,参考轨迹为车道居中行驶参考轨迹;基于参考轨迹,得到车辆的参考控制状态参数;基于参考控制状态参数和预设的离散控制状态方程,进行车辆控制状态预测,得到在至少一个预测周期内的车辆的预测控制状态参数;基于预测控制状态参数,进行辅助驾驶横向控制。无需采用定位传感器确定车辆在绝对坐标下的位置,即可实现对车辆的辅助驾驶横向控制,精确度较高,成本较低,可实施性较强。可实施性较强。可实施性较强。

【技术实现步骤摘要】
辅助驾驶横向控制方法、系统、车辆及存储介质


[0001]本专利技术涉及辅助驾驶
,尤其涉及一种辅助驾驶横向控制方法、系统、车辆及存储介质。

技术介绍

[0002]车道保持辅助系统是一种高级驾驶辅助系统。当驾驶员未意识到车辆偏离车道,且未采取纠正措施时,车道保持辅助系统将主动介入转向控制,将车辆纠正回到行驶车道中心,避免因车辆偏离车道引发的交通事故,对提升车辆行驶安全具有重要意义。车辆横向控制(车辆横向纠偏控制)是车道保持辅助系统进行驾驶控制的核心,它直接影响到车辆控制的稳定性和安全性。
[0003]目前,行业通常采用驾驶员单点预瞄模型或模型预测控制,实现车道保持功能。然而,驾驶员单点预瞄模型不能对车辆运动轨迹、姿态、转向等变量进行较优控制。模型预测控制则大多是基于车辆绝对坐标系下的模型预测跟踪控制,需要GNSS(Global Navigation Satellite System,全球导航卫星系统)及RTK(Real

time kinematic,实时动态定位)等高精度定位传感器确定车辆在绝对坐标下精确位置,以确定车辆当前姿态,从而进行车辆横向控制,成本较高。

技术实现思路

[0004]本专利技术提供一种辅助驾驶横向控制方法、系统、车辆及存储介质,用以解决现有技术中的车辆横向控制需要采用高精度定位传感器,确定车辆在绝对坐标下精确位置,以确定车辆当前姿态,从而进行车辆横向控制,导致横向控制成本较高的问题。
[0005]本专利技术提供一种辅助驾驶横向控制方法,包括
[0006]获取车道线信息;
[0007]基于所述车道线信息和预设的车辆运动坐标系,得到车辆在预设时间段内的参考轨迹,所述参考轨迹为车道居中行驶参考轨迹;
[0008]基于所述参考轨迹,得到车辆的参考控制状态参数;
[0009]基于所述参考控制状态参数和预设的离散控制状态方程,进行车辆控制状态预测,得到在至少一个预测周期内的车辆的预测控制状态参数;
[0010]基于所述预测控制状态参数,进行辅助驾驶横向控制。
[0011]可选地,所述基于所述车道线信息和预设的车辆运动坐标系,得到车辆在预设时间段内的参考轨迹的步骤包括:
[0012]以车辆前轴中心为原点,以车辆纵向为横轴,并以车辆横向为纵轴,建立车辆运动坐标系;
[0013]对所述车道线信息进行坐标变换,得到在所述车辆运动坐标系下的车道线坐标信息;
[0014]基于所述车道线坐标信息,进行曲线拟合,得到车道中心线方程;
[0015]基于所述车道中心线方程,得到车辆在预设时间段内的所述参考轨迹。
[0016]可选地,所述基于所述参考轨迹,得到车辆的参考控制状态参数的步骤包括:
[0017]基于所述参考轨迹和所述车道中心线方程,得到车辆运动坐标系下多个行驶长度所对应的所述参考控制状态参数。
[0018]可选地,所述离散控制状态方程的获取步骤包括:
[0019]基于预设的静止坐标系,建立车辆的运动学模型;
[0020]基于所述车辆的运动学模型,得到车辆运动状态方程;
[0021]通过对所述车辆运动状态方程进行线性化处理,得到线性状态方程,所述线性化处理包括:泰勒级数展开、去除高次项、以及求雅可比矩阵;
[0022]通过对所述线性状态方程进行离散控制处理,得到所述离散控制状态方程,所述离散控制处理包括前向欧拉离散化处理;所述离散控制状态方程中下一预测周期的预测控制状态参数由当前预测周期的预测控制状态参数得到,所述预测控制状态参数为当前控制状态参数与对应的所述参考控制状态参数之间的差值,所述预测控制参数包括:预测坐标信息、预测横摆角和预测转向角度。
[0023]可选地,所述基于所述参考控制状态参数和预设的离散控制状态方程,进行车辆控制状态预测,得到在至少一个预测周期内的车辆的预测控制状态参数的步骤包括:
[0024]基于所述参考控制状态参数中初始时刻的初始参考控制参数,得到初始控制状态参数,所述初始控制状态参数作为所述离散控制状态方程的输入量;所述初始控制状态参数包括:初始坐标信息、初始横摆角和初始转向角度;所述初始坐标信息的确定方式为将0与初始参考控制参数中的参考坐标之间的差值,确定为所述初始坐标信息;所述初始横摆角的确定方式为将0与初始参考控制参数中的参考横摆角之间的差值,确定为所述初始横摆角;所述初始转向角度的确定方式为将上一预测周期的预测转向角度与初始参考控制参数中的参考转向角度之间的差值,确定所述初始转向角度;
[0025]将所述初始控制状态参数和所述参考控制状态参数输入所述离散控制状态方程,进行车辆控制状态预测,得到在至少一个预测周期内的车辆的所述预测控制状态参数。
[0026]可选地,基于所述预测控制状态参数,进行辅助驾驶横向控制的步骤包括:
[0027]基于所述预测控制状态参数、预设的代价函数和约束条件,得到车辆辅助驾驶横向控制的转向角度最优解;所述代价函数基于所述预测控制状态参数得到,所述代价函数包括用于调整所述预测控制状态参数的权重矩阵;
[0028]基于所述转向角度最优解,进行辅助驾驶横向控制。
[0029]可选地,所述约束条件包括:
[0030]当所述预测控制状态参数中的预测转向角度在预设的转向角度阈值范围内,且所述预测转向角度的变化值在预设的转向变化阈值范围内时,将所述预测转向角度确定为所述转向角度最优解;所述转向角度阈值范围基于预设的横向加速度限值确定,所述转向变化阈值范围基于预设的横向加速度变化率限值确定。
[0031]本专利技术还提供一种辅助驾驶横向控制系统,包括:
[0032]车道线获取模块,用于获取车道线信息;
[0033]参考轨迹获取模块,用于基于所述车道线信息和预设的车辆运动坐标系,得到车辆在预设时间段内的参考轨迹,所述参考轨迹为车道居中行驶参考轨迹;
[0034]参考控制状态参数获取模块,用于基于所述参考轨迹,得到车辆的参考控制状态参数;
[0035]预测模块,用于基于所述参考控制状态参数和预设的离散控制状态方程,进行车辆控制状态预测,得到在至少一个预测周期内的车辆的预测控制状态参数;
[0036]横向控制模块,用于基于所述预测控制状态参数,进行辅助驾驶横向控制。
[0037]本专利技术还提供一种车辆,包括:前视摄像头和辅助驾驶横向控制系统,所述前视摄像头用于获取车道线图像或视频;
[0038]所述辅助驾驶横向控制系统包括:
[0039]车道线获取模块,用于基于所述车道线图像或视频,以获取车道线信息;
[0040]参考轨迹获取模块,用于基于所述车道线信息和预设的车辆运动坐标系,得到车辆在预设时间段内的参考轨迹,所述参考轨迹为车道居中行驶参考轨迹;
[0041]参考控制状态参数获取模块,用于基于所述参考轨迹,得到车辆的参考控制状态参数;
[0042]预测模块,用于基于所述参考控制状态本文档来自技高网
...

【技术保护点】

【技术特征摘要】
1.一种辅助驾驶横向控制方法,其特征在于,包括:获取车道线信息;基于所述车道线信息和预设的车辆运动坐标系,得到车辆在预设时间段内的参考轨迹,所述参考轨迹为车道居中行驶参考轨迹;基于所述参考轨迹,得到车辆的参考控制状态参数;基于所述参考控制状态参数和预设的离散控制状态方程,进行车辆控制状态预测,得到在至少一个预测周期内的车辆的预测控制状态参数;基于所述预测控制状态参数,进行辅助驾驶横向控制。2.根据权利要求1所述的辅助驾驶横向控制方法,其特征在于,所述基于所述车道线信息和预设的车辆运动坐标系,得到车辆在预设时间段内的参考轨迹的步骤包括:以车辆前轴中心为原点,以车辆纵向为横轴,并以车辆横向为纵轴,建立车辆运动坐标系;对所述车道线信息进行坐标变换,得到在所述车辆运动坐标系下的车道线坐标信息;基于所述车道线坐标信息,进行曲线拟合,得到车道中心线方程;基于所述车道中心线方程,得到车辆在预设时间段内的所述参考轨迹。3.根据权利要求2所述的辅助驾驶横向控制方法,其特征在于,所述基于所述参考轨迹,得到车辆的参考控制状态参数的步骤包括:基于所述参考轨迹和所述车道中心线方程,得到车辆运动坐标系下多个行驶长度所对应的所述参考控制状态参数。4.根据权利要求1所述的辅助驾驶横向控制方法,其特征在于,所述离散控制状态方程的获取步骤包括:基于预设的静止坐标系,建立车辆的运动学模型;基于所述车辆的运动学模型,得到车辆运动状态方程;通过对所述车辆运动状态方程进行线性化处理,得到线性状态方程,所述线性化处理包括:泰勒级数展开、去除高次项、以及求雅可比矩阵;通过对所述线性状态方程进行离散控制处理,得到所述离散控制状态方程,所述离散控制处理包括前向欧拉离散化处理;所述离散控制状态方程中下一预测周期的预测控制状态参数由当前预测周期的预测控制状态参数得到,所述预测控制状态参数为当前控制状态参数与对应的所述参考控制状态参数之间的差值,所述预测控制参数包括:预测坐标信息、预测横摆角和预测转向角度。5.根据权利要求1所述的辅助驾驶横向控制方法,其特征在于,所述基于所述参考控制状态参数和预设的离散控制状态方程,进行车辆控制状态预测,得到在至少一个预测周期内的车辆的预测控制状态参数的步骤包括:基于所述参考控制状态参数中初始时刻的初始参考控制参数,得到初始控制状态参数,所述初始控制状态参数作为所述离散控制状态方程的输入量;所述初始控制状态参数包括:初始坐标信息、初始横摆角和初始转向角度;所述初始坐标信息的确定方式为将0与初始参考控制参数中的参考坐标之间的差值,确定为所述初始坐标信息;所述初始横摆角的确定方式为将0与初始参考控制参数中的参考横摆角之间的差值,确定为所述初始横摆角;...

【专利技术属性】
技术研发人员:王满江李政李理莫劲威
申请(专利权)人:三一汽车制造有限公司
类型:发明
国别省市:

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1