在动力学约束下基于车辆运动学模型转向控制方法技术

技术编号:19016878 阅读:675 留言:0更新日期:2018-09-26 17:28
本发明专利技术公开了一种在动力学约束下基于车辆运动学模型转向控制方法,首先,对车辆模型进行运动学建模,然后对车辆运动学微分方程进行线性离散化,这是因为模型预测控制算法一般为采样控制算法,且计算机在优化求解时也是离散的;最后设计目标函数及约束,将目标函数转化为标准二次型进行求解。本发明专利技术将动力学约束参数转为使用运动学模型所推导的控制量表达式,与现有的使用运动学模型作为预测模型相比较,本发明专利技术提出的考虑动力学约束的控制器设计方法,避免了车辆在高速情况下的容易发生侧滑、侧翻的问题,使得运动学模型在高速情况下也能保证跟踪精度以及稳定性。

【技术实现步骤摘要】
在动力学约束下基于车辆运动学模型转向控制方法
本专利技术属于汽车安全
,尤其涉及一种在动力学约束下基于车辆运动学模型转向控制方法。
技术介绍
描述车辆运行状态的模型按照具体功能可以分为:运动学模型和动力学模型,相关研究表明,在低速时,车辆运动学特性较为突出;在高速时,车辆的动力学特性较为突出。在实际应用中,模型复杂度的增加,通常并不能带来准确性的提高,相反会导致算法实时性的降低,建立合理的车辆系统模型不仅是设计模型预测控制器的前提,也是实现车辆道路跟踪功能的基础。如何在使用运动学模型这一简单模型的基础上考虑动力学约束,使得运动学模型在较高速时仍能保证跟踪精度,是非常有意义的。
技术实现思路
本专利技术所要解决的技术问题是,提供一种在动力学约束下基于车辆运动学模型转向控制方法,通过合理建立车辆运动学模型,并以运动学模型作为预测模型,基于模型预测控制算法设计控制器,通过线性离散化、设计目标函数、在对控制量和控制增量进行约束的基础上考虑动力学约束,最后通过求解目标函数,使得车辆在高速下仍然能够实现精确的轨迹跟踪。本专利技术解决其技术问题所采用的技术方案是:提供一种在动力学约束下基于车辆运动学模型转向控制方法,包括以下步骤,步骤一,获取车辆结构参数信息以及车辆运行状态信息,进行车辆运动学建模,其中:(x,y)为车辆后轴中心的坐标,θ为车辆的航向角,ω为横摆角速度,v为车辆后轴中心的纵向速度,使用上述车辆运动学模型作为预测模型,选取状态量选取控制量则上述车辆运动学微分方程表示为:步骤二,对于规划层规划好的参考轨迹,其上的每一个点都需满足上述车辆运动学微分方程,用下标r表示参考轨迹上的点,则参考轨迹可以表示为:其中:对车辆运动学微分方程在任意参考轨迹点处采用泰勒级数公式展开至一阶导数项(忽略高阶项)后,可得到线性离散化方程:其中:T为采样时间,vr为参考轨迹点处的纵向速度;θr参考轨迹点处的纵向速度航向角,t表示当前时刻;k表示当前时刻后的第k步;步骤三,设计目标函数:为了保证无人驾驶车辆准确、平稳地跟踪期望轨迹,需要对系统状态量、控制量及控制量增量进行优化,选取如下目标函数,其中:N表示控制时域(即预测时域);Q表示状态量和控制量集合的权重;R表示控制增量的权重;ρ表示权重系数;ε表示松弛因子;i表示当前时刻后的第i步;步骤四,得到车辆的前轮侧偏角表达式,用控制量表示轮胎侧偏角,因为目标函数的未知数是控制增量,因此将前轮侧偏角用控制增量进行表示,然后直接用于目标函数。包括设计约束:MPC控制器的优势之一在于能够处理各种约束,因此考虑控制过程中的控制量极限值约束和控制增量极限值约束的基础上考虑动力学约束,特别是轮胎侧偏角约束。关于轮胎侧偏角的约束最重要的是将这一参数表示成控制量形式或者直接表示成控制增量形式。验证控制器:通过上述步骤,以及控制算法的推导,需要对所设计的转向控制器进行仿真验证,在此通过搭建Carsim/Simulink联合仿真平台进行验证,其中Carsim是一款专门进行车辆模型建模以及搭建工况的仿真软件,Simulink是MATLAB的一个子模块专门进行仿真。通过使用上述仿真平台,对车辆输出参数进行分析验证所设计的控制器。按上述技术方案,所述步骤四中,前轮侧偏角表达式,具体为:式中,α表示前轮侧偏角;δ表示前轮转角;vy表示横向速度;vx表示纵向速度;ω表示横摆角速度;a表示前轴距离质心的距离。按上述技术方案,所述步骤四中,用控制量表示轮胎侧偏角,具体为:式中,αmax表示前轮侧偏角的上限;αmin表示前轮侧偏角的下限。按上述技术方案,所述步骤四中,再将控制量转化为控制增量,计算前轮侧偏角约束,具体为:Umin≤AΔUt+Ut-1≤Umax式中,Umin,Umax表示控制量的集合,Ut-1表示上一时刻控制量组成的集合。按上述技术方案,将目标函数化简为标准二次型,使用算法进行求解,得出控制域内的系统输出:式中,表示在控制域内计算的最优系统输出的集合,表示控制域内第一步的最优输出。按上述技术方案,所述步骤一中,车辆结构参数信息包括车辆轴距,车辆运行状态信息包括车速、航向角、经纬度。在对控制量和控制增量进行约束的基础上考虑动力学约束应满足以下3方面的需求:(1)自动驾驶的最终目标是使车辆能够安全跟踪驾驶员的期望轨迹,这就要求车辆在较高速度下仍能保证精确的轨迹跟踪。(2)模型预测控制算法的优势就是能自由设计约束,但是对哪些参数进行约束,需要考虑其能否转化为控制增量形式。(3)约束的极限值要合理设计,需要保证约束值在车辆的运行极限值以内。综上,本专利技术通过对无人驾驶车辆的控制器进行设计,提出在使用简单的运动学模型时,考虑车辆动力学约束,使得无人车能在较高的速度下仍能保证跟踪效果,设计了针对快速路的无人车控制系统。本专利技术产生的有益效果是:本专利技术基于模型预测控制算法,针对车辆在使用运动学模型下不能在较高速度下保证跟踪精度这一问题,设计了一种在动力学约束下基于车辆运动学模型转向控制方法。本专利技术综合考虑了汽车运动学特性和动力学特性,利用车辆动力学理论对车辆的前轮侧偏角进行分析。与现有的纯运动学模型轨迹跟踪计算方法进行比较,本专利技术具有运算速度快,可靠性高的优点。附图说明下面将结合附图及实施例对本专利技术作进一步说明,附图中:图1是本专利技术实施例在动力学约束下基于车辆运动学模型转向控制方法的原理图。具体实施方式为了使本专利技术的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本专利技术进行进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本专利技术,并不用于限定本专利技术。本专利技术实施例中,如图1所示,提供一种在动力学约束下基于车辆运动学模型转向控制方法,包括以下步骤,步骤一,获取车辆结构参数信息以及车辆运行状态信息,进行车辆运动学建模,其中:(x,y)为车辆后轴中心的坐标,θ为车辆的航向角,ω为横摆角速度,v为车辆后轴中心的纵向速度,使用上述车辆运动学模型作为预测模型,选取状态量选取控制量则上述车辆运动学微分方程表示为:步骤二,对于规划层规划好的参考轨迹,其上的每一个点都需满足上述车辆运动学微分方程,用下标r表示参考轨迹上的点,则参考轨迹可以表示为:其中:对车辆运动学微分方程在任意参考轨迹点处采用泰勒级数公式展开至一阶导数项(忽略高阶项)后,可得到线性离散化方程:其中:T为采样时间,vr为参考轨迹点处的纵向速度;θr参考轨迹点处的纵向速度航向角,t表示当前时刻;k表示当前时刻后的第k步;步骤三,设计目标函数:为了保证无人驾驶车辆准确、平稳地跟踪期望轨迹,需要对系统状态量、控制量及控制量增量进行优化,选取如下目标函数,其中:N表示控制时域(即预测时域);Q表示状态量和控制量集合的权重;R表示控制增量的权重;ρ表示权重系数;ε表示松弛因子;i表示当前时刻后的第i步;步骤四,得到车辆的前轮侧偏角表达式,用控制量表示轮胎侧偏角,因为目标函数的未知数是控制增量,因此将前轮侧偏角用控制增量进行表示,然后直接用于目标函数。包括设计约束:MPC控制器的优势之一在于能够处理各种约束,因此考虑控制过程中的控制量极限值约束和控制增量极限值约束的基础上考虑动力学约束,特别是轮胎侧偏角约束。关于轮胎侧偏角的约束最重要的是将这一参数表示成控制量形式或本文档来自技高网...

【技术保护点】
1.一种在动力学约束下基于车辆运动学模型转向控制方法,其特征在于,包括以下步骤,步骤一,获取车辆结构参数信息以及车辆运行状态信息,进行车辆运动学建模,

【技术特征摘要】
1.一种在动力学约束下基于车辆运动学模型转向控制方法,其特征在于,包括以下步骤,步骤一,获取车辆结构参数信息以及车辆运行状态信息,进行车辆运动学建模,其中:(x,y)为车辆后轴中心的坐标,θ为车辆的航向角,ω为横摆角速度,v为车辆后轴中心的纵向速度,使用上述车辆运动学模型作为预测模型,选取状态量选取控制量则上述车辆运动学微分方程表示为:步骤二,对于规划层规划好的参考轨迹,其上的每一个点都需满足上述车辆运动学微分方程,用下标r表示参考轨迹上的点,则参考轨迹可以表示为:其中:对车辆运动学微分方程在任意参考轨迹点处采用泰勒级数公式展开至一阶导数项后,可得到线性离散化方程:其中:T为采样时间,vr为参考轨迹点处的纵向速度;θr参考轨迹点处的纵向速度航向角,t表示当前时刻;k表示当前时刻后的第k步;步骤三,设计目标函数:选取如下目标函数,其中:N表示控制时域;Q表示状态量和控制量集合的权重;R表示控制增量的权重;ρ表示权重系数;ε表示松弛因子;i表示当前时刻后的第i步;步骤四,得到车辆的前轮侧偏角表达式,用控制量表示轮胎侧偏角,将前轮侧偏角用控制增量进行表示,然后直接用于目标函数。2.根据权利要求1所述的在动力学约束下基于车辆运动学模型转...

【专利技术属性】
技术研发人员:褚端峰刘世东高策吴超仲
申请(专利权)人:武汉理工大学
类型:发明
国别省市:湖北,42

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

1