CN111158264B - 面向车载应用的模型预测控制快速求解方法 - Google Patents

面向车载应用的模型预测控制快速求解方法 Download PDF

Info

Publication number
CN111158264B
CN111158264B CN202010020411.2A CN202010020411A CN111158264B CN 111158264 B CN111158264 B CN 111158264B CN 202010020411 A CN202010020411 A CN 202010020411A CN 111158264 B CN111158264 B CN 111158264B
Authority
CN
China
Prior art keywords
vehicle
model
solving
yaw
optimization problem
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202010020411.2A
Other languages
English (en)
Other versions
CN111158264A (zh
Inventor
刘行行
王萍
张曦月
郭露露
陈虹
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Jilin University
Original Assignee
Jilin University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Jilin University filed Critical Jilin University
Priority to CN202010020411.2A priority Critical patent/CN111158264B/zh
Publication of CN111158264A publication Critical patent/CN111158264A/zh
Application granted granted Critical
Publication of CN111158264B publication Critical patent/CN111158264B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B17/00Systems involving the use of models or simulators of said systems
    • G05B17/02Systems involving the use of models or simulators of said systems electric

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)

Abstract

本发明公开了一种面向车载应用的模型预测控制快速求解方法,包括以下步骤:高保真车辆模型搭建;建立描述车辆横摆运动和侧向运动的车辆模型;建立参考模型,根据车辆当前的车速和前轮转角生成横摆角速度和质心侧偏角的参考值;根据所建立的车辆模型和控制需求,将模型预测控制问题描述为一个典型的非线性优化问题;针对该非线性优化问题,基于庞特里亚金最小值原理和Nelder‑Mead算法进行非线性优化问题的快速求解;根据模型预测控制器计算所得的最优控制输入,分别计算出四个轮胎的附加转矩,将附加转矩分配到四个轮毂电机上。本发明可以在保证求解精度的前提下,大幅提高求解速度,提高控制器的实时性。

Description

面向车载应用的模型预测控制快速求解方法
技术领域
本发明涉及一种面向车载应用的模型预测控制中非线性优化问题的快速求解方法,具体涉及一种利用车辆动力学特性、庞特里亚金最小值原理(PMP)和Nelder-Mead算法等快速求解非线性优化问题的方法,简称为NM-PMP。
背景技术
模型预测控制是一种基于被控对象的模型的一种在线计算滚动优化的控制方法。模型预测控制基于当前的反馈信息和***对象的模型对***进行优化控制,由于考虑了***的模型,因此在模型预测控制中可以考虑***的相应的约束,同时还可以实现针对***的多目标优化等。由于模型预测控制具有上述的特点和优势,基于模型预测控制框架体系的技术可以很好地解决车辆控制领域中的问题,如车辆稳定性控制、车辆自动驾驶控制以及预测巡航控制等。随着技术的不断发展,车辆对控制器的性能要求也越来越高,但车载控制器的计算能力却相当有限。车辆是一个典型的快变***,尤其在某些典型应用中,如车辆的稳定性控制,必须提高控制器的计算速度,从而获得更好的性能。因此,当前的面向车辆的模型预测控制存在着以下问题:
1.由于车辆本身就是一个复杂的非线性***,随着对控制器性能要求的不断提高,传统的在工作点附近进行线性化近似的方法已经不能满足精度要求,因此需要采用精度更高的非线性模型,而非线性模型的引入会导致优化问题的复杂程度大大增加。
2.由于非线性优化问题复杂程度大大增加,相应的求解所需要时间也会大大增加,同时车辆还是一个快变***。因而应用现有的车载控制器和传统的求解算法(例如已被广泛应用的序列二次规划-SQP),很有可能无法满足车辆对控制器实时性的要求。
3.针对复杂的非线性优化问题,虽然可以通过安装性能更好的车载控制器来解决,但此举势必会造成成本的大幅增加以及整车能耗的增加。因此若能改进求解算法,提高求解速度,便可以在现有的车载控制器的基础上提高控制器性能,同时大幅节约硬件成本同时还不增加整车的能耗。
发明内容
本发明主要针对在面向车载应用的模型预测控制中,由于车辆***为非线性***,当***预测时域较长时,所描述的非线性优化问题较为复杂,因此会造成求解时间增加,车载控制器可能无法满足车辆实时性的要求;而出于成本控制和降低功耗等方面的考虑,车载控制器的计算能力有限。因此,当所描述的非线性优化问题较为复杂时,车载控制器所需要的计算时间可能无法满足车辆***的实时性要求的问题。针对上述问题,本发明提供一种面向车载应用的模型预测控制中非线性优化问题的快速求解方法,具体为基于庞特里亚金最小值原理和Nelder-Mead算法的最优控制非线性优化问题快速求解方法。该方法可以在保证求解精度的前提下,大幅提高求解速度,提高控制器的实时性。
为解决上述技术问题,本发明是采用如下技术方案实现的:
一种面向车载应用的模型预测控制快速求解方法,包括以下步骤:
步骤一、高保真车辆模型搭建:在CarSim软件中选择车辆模型,并将车辆的运动状态参数读取到Simulink中,基于所选的车辆模型构建低附着路面下行驶的仿真工况,模拟实际车辆的横摆运动和侧向运动特征;
步骤二、基于快速求解算法的模型预测控制器设计:
1)建立描述车辆横摆运动和侧向运动的车辆模型;
2)建立参考模型,根据车辆当前的车速和前轮转角生成横摆角速度和质心侧偏角的参考值;
3)根据所建立的车辆模型和控制需求,将模型预测控制问题描述为一个典型的非线性优化问题;
4)针对该非线性优化问题,基于庞特里亚金最小值原理和Nelder-Mead算法进行非线性优化问题的快速求解;
步骤三、根据模型预测控制器计算所得的最优控制输入,分别计算出四个轮胎的附加转矩,将附加转矩分配到四个轮毂电机上。
与现有技术相比本发明的有益效果是:
1.本发明根据庞特里亚金最小值原理结合车辆动力学给出了面向车载应用的车辆稳定性模型预测控制中的非线性优化问题的间接求解方式,并基于该原理提出了一种最优控制问题的快速求解算法。与传统优化算法相比,本发明所提出的算法可以有效降低求解时间,提高算法实时性。
2.本发明根据庞特里亚金最小值原理将原非线性优化问题进行转化,并使用Nelder-Mead算法进行搜索求解,该方法不需要计算导数,因此具有更加广泛的适用性,即可以采用多种车辆动力学模型。
附图说明
下面结合附图对本发明的具体实施方式作进一步的说明,本发明的这些和/或其他方面将更清晰明白。其中:
图1是仿真实验中控制器框图;
图2是车辆的二自由度模型;
图3是最优控制输入解析解迭代关系示意图;
图4是仿真过程中基于传统SQP求解方法的计算时间;
图5是仿真过程中基于本发明所述的NM-PMP求解方法的计算时间;
图6是仿真过程中两种不同求解方法在不同预测时域下的平均计算时间;
图7是在仿真过程中基于本发明所述的求解算法所设计的控制器开启和关闭时车辆的横摆角速度曲线以及相应的参考值;
图8是在仿真过程中基于本发明所述的求解算法所设计的控制器开启和关闭时车辆的质心侧偏角曲线以及相应的参考值;
图9是在仿真过程中基于传统SQP方法和本发明所述NM-PMP方法求解时以及在不同预测时域下的目标函数值曲线;
图10是在仿真过程中基于传统SQP方法和本发明所述NM-PMP方法时的横摆角速度曲线及其相应的参考值;
图11是在仿真过程中基于传统SQP方法和本发明所述NM-PMP方法时的质心侧偏角曲线。
具体实施方式
为详细说明本发明的技术内容、构造特点、实现目的等下面结合附图对本发明进行全面解释。
基于本发明所述的快速求解算法所设计的控制器框图如图1所示,其中驾驶员为CarSim中自带的驾驶员模型,在仿真中用于保持特定车速,并跟随所给定的期望路径。参考模型的作用是根据当前的车速和驾驶员所给出的前轮转角生成横摆角速度和质心侧偏角的参考值,并将生成的参考值送给控制器。控制器的作用是根据参考模型给出的参考值以及当前车辆的状态信息计算控制量使得车辆能够跟踪上横摆角速度和质心侧偏角的参考值。转矩分配的作用是根据驾驶员的期望转矩和控制器计算所得到的附加横摆力矩,将所需要的转矩分配到四个轮毂电机上。在仿真实验中,车辆模型和仿真工况均是在CarSim中构建的,控制器则是在Simulink中构建的。
本发明所述的快速求解算法及其相应的控制器均是通过软件***的联合仿真实现并进行验证的。
1、软件选择
本发明快速求解算法及其相应的控制器和由控制器控制的被控对象的仿真模型分别通过软件Matlab/Simulink和高保真车辆动力学仿真软件CarSim进行搭建,软件版本分别为Matlab R2019b和CarSim2016.1,求解器选择为ODE1。仿真步长为0.001s。其中CarSim软件是一个商用的高保真车辆动力学仿真平台,它在本发明中的主要作用是提供高保真的车辆动力学模型以及相应的仿真工况,在仿真实验中这一模型代替了真实的车辆作为所设计的快速求解算法的实施对象;MATLAB/Simulink软件则是用于控制器的仿真模型搭建,即通过Simulink编程来完成该方法中控制器的运算。
2、联合仿真设置
要实现两者的联合仿真,首先需要在Matlab的路径设置中添加CarSim的路径;其次在CarSim界面中添加输出接口模块;然后将CarSim中的模型信息经过***编译之后以CarSimS-function的形式保留在Simulink中,最后再进行Simulink中CarSim模块的参数设置。在运行Simulink仿真模型时,CarSim模型也在同时进行计算和求解。仿真过程中两者之间不断进行数据的交换。如果对CarSim中的模型结构或者参数设置进行了修改,则需要重新编译,之后将新的包含最新设定信息的CarSim模块重新发送至Simulink中。
3、本发明所述的一种面向车载应用的模型预测控制快速求解方法,首先推导能够正确描述车辆横摆运动和侧向运动的数学模型;其次,在高保真车辆动力学仿真软件CarSim中选择合适的车辆模型并获取相应参数;之后基于所选的车辆模型构建低附着路面下的仿真工况;然后基于本发明所述的快速求解算法推导用于车辆稳定性控制的控制器。最后,在联合仿真实验中对本发明所述的方法进行验证,同时与传统的SQP求解算法进行对比,以说明本发明的有益效果。
本发明提供的一种面向车载应用的模型预测控制快速求解方法,具体包括以下步骤:
步骤一、高保真车辆模型搭建:在CarSim软件中选择车辆模型,并将车辆的运动状态参数读取到Simulink中,基于所选的车辆模型构建低附着路面下行驶的仿真工况,模拟实际车辆的横摆运动和侧向运动特征。
高保真车辆模型模拟真实的被控对象,主要作用是能够精确的模拟实际车辆的横摆运动和侧向运动特征。在本发明中,由于使用了联合仿真,因此在CarSim中,主要用到的是车辆模型选择以及仿真工况的构建。
首先选择典型的乘用车模型,之后对模型的相关参数进行修改并获取,将车辆模型参数添加到Simulink仿真模型中。车辆的主要模型参数有车辆质量、前后轴距轮胎侧偏刚度等。在选择相应的车辆模型和参数之后,需要构建相应的仿真工况,仿真工况中可以选择车辆的行驶路线,行驶环境以及驾驶员模型等。由于在本发明中只是对通过附加横摆力矩来对车辆的稳定性进行控制,因此选用CarSim中自带的驾驶员模型,并将车辆的运动状态参数读取到Simulink中,基于所选的车辆模型构建低附着路面下的仿真工况。
步骤二、基于快速求解算法的控制器设计:基于模型预测控制原理对所需要的控制问题进行描述,描述为一个非线性优化问题,并基于本发明所述的快速求解算法进行控制器的设计。
本发明的被控对象是行驶在低附着路面上的车辆,因此控制目标就是根据当前车辆的状态信息以及当前的参考值计算出所需要的附加横摆力矩,提高车辆的稳定性。主要设计过程描述如下。
1)建立描述车辆横摆运动和侧向运动的数学模型。
1.1)车辆二自由度模型建立
本发明采用了车辆的二自由度模型,在该模型中只考虑了车辆的侧向运动和横摆运动。如图2所示,前轴轮胎和后轴轮胎(图2中的灰色轮胎)分别被压缩至一个轮胎中(图2中的黑色轮胎)。驾驶员只能够转动前轮,且两个前轮的转角是相等的。此时车辆模型便可以简化为车辆二自由度模型。同时根据车辆动力学的理论,简化后的车辆二自由度模型可由如下方程描述:
Figure BDA0002360543820000051
其中,
Figure BDA0002360543820000056
Figure BDA0002360543820000055
分别表示车辆的质心侧偏角的导数和车辆的横摆角速度的导数,V表示车辆的纵向速度,Fyf和Fyr则分别表示前后轮胎的轮胎侧向力,Lf和Lr分别表示前后轴到车辆质心的距离,m是车辆的质量,Iz是车辆绕质心旋转的转动惯量,ΔMz为附加的横摆力矩。
1.2)非线性轮胎模型建立
在本发明中,为了提高模型精度,轮胎的侧向力是由一个非线性模型来描述的,采用了Fiala轮胎模型进行描述。在该模型中,使用了轮胎侧偏角作为内部变量。当轮胎侧偏角α很小时,有tan(α)≈α,之后该轮胎模型可近似为:
Figure BDA0002360543820000054
其中,Fy为轮胎侧向力,μ为路面附着系数,Fz为垂直载荷,轮胎侧偏刚度Cα可分为前轮侧偏刚度Cf和后轮侧偏刚度Cr;α为轮胎侧偏角,可分为前轮侧偏角αf和后轮侧偏角αr,他们可由下式进行计算:
Figure BDA0002360543820000061
其中,δf为车辆的前轮转角。
2)车辆参考模型建立
在本发明中,车辆的横摆角速度参考值由当前的前轮转角决定,在一般情况下,首先假设
Figure BDA0002360543820000062
以及β=0,之后便可得到一阶线性参考模型。但事实上,当车辆转向时,车辆的质心侧偏角β并不等于零。当附加横摆力矩ΔMz作用于车辆时,上述假设并不合理,因为附加横摆力矩会引起车辆质心侧偏角的改变。然而,当车辆工作在线性区域时,车辆必须是稳定的,之后参考的质心侧偏角便可以基于车辆的稳定区域进行计算。首先忽略掉轮胎侧向力的非线性项和附加的横摆力矩,此时便可以得到一个关于横摆角速度和质心侧偏角的二自由度线性模型:
Figure BDA0002360543820000063
在式(4)的基础上,车辆关于前轮转角的响应便可以得到,之后便可以得到从前轮转角δf到车辆的参考横摆角速度γref以及参考质心侧偏角βref的传递函数为:
Figure BDA0002360543820000064
此时,我们定义车辆的稳定因子为
Figure BDA0002360543820000065
其中L=Lf+Lr为车辆的前后轴距。***的振荡频率为
Figure BDA0002360543820000066
***的阻尼系数为
Figure BDA0002360543820000067
横摆角速度稳态增益为
Figure BDA0002360543820000068
质心侧偏角稳态增益为
Figure BDA0002360543820000071
其中的微分系数分别定义为
Figure BDA0002360543820000072
Figure BDA0002360543820000073
同时还需注意的是,当路面的附着系数较低时,轮胎所能产生的轮胎力的最大值不足以支撑所需要的较大的横摆角速度。此时我们需要对横摆角速度的参考值进行适当的限制,来适应路面的摩擦系数。为了达到满意的性能,首先定义横摆角速度的上限值为
Figure BDA0002360543820000074
横摆角速度的参考值γref应被约束在|γref|≤γup。类似地,我们定义质心侧偏角的上限值为
Figure BDA0002360543820000075
横摆角速度的参考值βref应被约束在|βref|≤βup
3)非线性控制器设计
为了提高车辆的稳定性,主要的控制需求便是在控制器的作用下,使车辆跟踪横摆角速度的参考值。控制器的框图如图1所示。由控制器计算得到的附加横摆力矩通过四个轮毂电机的附加转矩来实现。
首先定义***的状态向量为x=[x1,x2]T=[β/βup,γ/γup]T。控制量定义为u=ΔMz/ΔMmax。通过离散化式(1)在每个采样时刻kTs可以得到离散后的状态空间方程为:
Figure BDA0002360543820000076
其中的侧向力Fyf和Fyr由式(2)中的非线性轮胎模型计算得到,βup和γup分别为质心侧偏角和横摆角速度的上限值,ΔMmax为附加横摆力矩的最大值,Ts为采样时间,ΔMz为附加的横摆力矩。
由于控制器的主要目标是跟踪横摆角速度的参考值,同时还要考虑质心侧偏角的参考值,因此在每个时刻k+1≤ki≤k+N+1定义代价函数为:
Figure BDA0002360543820000077
其中L1(ki)、L'2(ki)和L3(ki)分别用于跟踪横摆角速度参考值、跟踪质心侧偏角参考值和抑制作动能量。状态约束为|x1(ki)|≤1,控制量限幅为|u(ki-1)|≤1。此时便可以得到非线性模型预测控制的目标函数为:
Figure BDA0002360543820000081
满足的约束为|u(ki-1)|≤1以及|x1(ki)|≤1,其中Γβ和Γu分别为质心侧偏角和控制量的权重系数,N为预测时域。
4)快速求解算法
由庞特里亚金最小值原理可知,对于给定的积分型性能指标、控制受约束的最优控制问题:
Figure BDA0002360543820000082
若u*(t)和
Figure BDA0002360543820000083
时使性能指标最小的最优解,且在最优解的作用下x*(t)所形成的的最优轨迹,则可导出如下必要条件:
①x(t)和λ(t)满足正则方程:
Figure BDA0002360543820000084
其中H(x,λ,u)=L(x,u)+λT(t)f(x,u)为哈密顿函数。
②x(t)和λ(t)满足边界条件:
Figure BDA0002360543820000085
③哈密顿函数在最优控制解的作用下取到绝对极小值:
Figure BDA0002360543820000086
④同时哈密顿函数在轨迹线的末端满足:
H[x*(t),λ(t),u*(t)]=H[x*(tf),λ(tf),u*(tf)]=constant (13)
由上述必要条件可以看出,***的状态约束是无法考虑在内的,因此需要根据车辆动力学方程对上述车辆二自由度模型的状态约束|x1(ki)|≤1进行一定的处理。在此本发明引入松弛函数对状态约束进行转化处理:
Figure BDA0002360543820000091
其中,κ代表了函数的松弛程度,而ν则为一个较大的数,用来保证最优的状态轨迹是在约束范围之内的。引入松弛函数后,若求解得到的状态接近约束值,则函数的惩罚项会迅速增大,而当状态在约束范围之内时,函数的惩罚项会约等于零。最终代价函数L2(ki)可表示为:
L2(ki)=L′2(ki)+ζ(ki) (15)
此时式(8)所示的优化问题被重新定义为:
Figure BDA0002360543820000092
同时满足***的状态约束|x1(ki)|≤1。
根据庞特里亚金最小值原理,将最优必要性条件进行离散化处理。再根据离散化后的车辆二自由度模型,现定义在时刻k+1≤ki≤k+N+1的哈密顿函数为:
Figure BDA0002360543820000093
其中F1(x(ki))和F2(x(ki))分别定义为:
Figure BDA0002360543820000094
在上述方程中,λ1(k)和λ2(k)分别表示拉格朗日乘子,根据庞特里亚金最小值原理可得到最优必要性条件为:
Figure BDA0002360543820000101
终端条件为:
Figure BDA0002360543820000102
在各个时刻都有最优控制律u*(ki)使得哈密顿函数最小化:
Figure BDA0002360543820000103
基于必要性条件,我们便可以给出从初始状态到终端状态的映射关系,如图3所示。
在某一时刻ki,在已知的状态λ(ki)和x(ki)条件下,便基于庞特里亚金最小值原理给出优化问题的解析解。为了简便起见,本发明将哈密顿函数重新写为关于控制量u(ki)的二次函数的形式:
H(x(ki),u(ki))=p1u(ki)2+p2(ki)u(ki)+g(x(ki)) (22)
其中p1=Γu,p2(ki)=λ2(ki)ΔMmax/(γupIz)且有:
Figure BDA0002360543820000104
之后便可给出使哈密顿函数最小的最优控制律:
Figure BDA0002360543820000105
此时原优化问题便转换为了寻找最优的初始状态λ*(k)使得终端状态满足终端条件。换句话说,原优化问题被转换为了两点边值问题:
Figure BDA0002360543820000111
该两点边值问题在本发明中通过Nelder-Mead算法进行求解,最终可得到最优控制律为:
Figure BDA0002360543820000112
得到最优控制律u*(k)之后,便可根据计算所得的控制律分别计算四个轮胎的附加转矩:
Figure BDA0002360543820000113
其中ΔTcfl(k),ΔTcrl(k),ΔTcfr(k),ΔTcrr(k)分别表示左前轮、左后轮、右前轮以及右后轮的附加转矩,Re表示轮胎的滚动半径,d表示车辆车身的宽度。
4、仿真实验验证与对比:
为了验证本发明所提出的的模型预测控制优化问题的快速求解算法的有效性,同时也为了与传统的求解算法进行对比,需要设计仿真实验来进行验证对比。车辆的稳定性控制是一个典型的车辆控制问题,同时该控制问题还对控制器的实时性要求较高,因此本发明所设计的仿真实验为低附着路面上的车辆稳定性控制问题。在对比中,传统的求解算法选用的是应用较为广泛的序列二次规划(SQP)。
本发明设计了基于所述算法的控制器,对行驶在低附着路面上的车辆进行稳定性控制。同时还对比了与采用传统求解算法的求解速度与效果。通过仿真实验来进行上述验证与对比。在仿真中所使用的车辆模型的参数为质量m=1430kg,车辆前半轴距Lf=1.05m,车辆后半轴距Lr=1.61m,车辆绕质心的转动惯量Iz=2059.2kg·m2,前轮等效侧偏刚度Cf=90700N/rad,后轮等效侧偏刚度Cr=109000N/rad,车轮半径Re=0.325m,车辆车体宽度d=1.55m,路面附着系数μ=0.35。状态约束分别为γup=0.2058rad/s和βup=0.0376rad,车辆纵向速度V=60km/h,采样时间Ts0.012s,预测时域N=20,最大附加横摆力矩ΔMmax=800Nm。目标函数中的权重系数分别为Γβ=0.2和Γu=0.125。
(1)实施例:双移线工况实验
在仿真实验中,所选择的是双移线工况,车辆速度为60km/h且在整个工况中保持不变,驾驶员模型为预瞄驾驶员模型。为了验证本发明所提出的的快速求解算法的有效性,并和传统SQP算法进行对比,分别使用这两种算法求解模型预测控制中的优化问题,之后对比求解精度和求解速度。
图4和图5分别给出了基于SQP求解算法和基于本发明所述的NM-PMP求解算法的求解时间。从图中可以看出,不论是基于SQP还是基于NM-PMP的求解算法,他们的计算时间都会随着预测时域的增加而增加。但在同样的预测时域下,NM-PMP算法的求解时间要大大小于SQP算法的求解时间。当优化问题较为复杂时,例如在第4秒到第11秒期间,NM-PMP算法的求解时间可比SQP算法的求解时间快约十倍。图6给出了在不同预测时域下的两种求解算法的平均计算时间,可以看到随着预测时域的增加,NM-PMP算法的平均计算时间和预测时域基本呈线性关系,增长较为缓慢,而SQP算法的平均计算时间和预测时域呈指数关系,增长较快,且平均计算时间也大于NM-PMP算法的计算时间。以上两点充分体现出了本发明所述的快速求解算法的有益性。
图7和图8给出了车辆在基于本发明所述的NM-PMP算法所设计的控制器作用下的控制效果,从图7可以看到在控制器的作用下,车辆可以较好地跟踪横摆角速度的参考值,有效改善了车辆的操纵性。从图8可以看到,在控制器作用下,车辆的质心侧偏角可以抑制在一个较小的范围内,相比于无控制器作用时,车辆的稳定性大大提高。以上说明了本发明所述的NM-PMP算法不仅求解速度较快,同时还可以实现较好的控制效果。
仿真实验还对比了两种求解算法的控制效果。图9给出了在不同预测时域下两种求解算法的目标函数值的收敛情况,从图9中可以看到,当两种算法都可以求解出优化问题时,在同样的预测时域下,本发明所述的NM-PMP算法计算出的目标函数值仅略小于SQP算法计算出的目标函数值。说明了本发明所述的NM-PMP算法在大幅加快计算速度的情况下,还可以保持较高的求解精度。儿另一方面,当优化问题较为复杂且SQP算法无法求解时,他的目标函数值便会迅速发散增大,而本发明所述的NM-PMP算法可以找到一个次优解,使目标函数保持在一个较小的范围内。
图10和图11给出了在两种算法的控制器作用下的控制效果,从图10可以看到,在NM-PMP算法控制器的作用下,车辆可以更好地跟踪横摆角速度的参考值,具有更好的操纵性。从图11可以看到,在NM-PMP算法控制器的作用下,质心侧偏角可以被抑制在一个更小的范围内,从而使车辆具有更好的稳定性。
通过仿真示例可以看出,本发明所述的NM-PMP算法能够在大幅提高计算速度的情况下还能保证较高的求解精度。此外,当传统SQP算法无法求解时,本发明所述的NM-PMP算法可以求解出一个次优解,从而实现更好的总体性能。

Claims (5)

1.一种面向车载应用的模型预测控制快速求解方法,其特征在于,包括以下步骤:
步骤一、高保真车辆模型搭建:在CarSim软件中选择车辆模型,并将车辆的运动状态参数读取到Simulink中,基于所选的车辆模型构建低附着路面下行驶的仿真工况,模拟实际车辆的横摆运动和侧向运动特征;
步骤二、基于快速求解算法的模型预测控制器设计:
1)建立描述车辆横摆运动和侧向运动的车辆模型,包括二自由度模型和非线性轮胎模型;
2)建立参考模型,根据车辆当前的车速和前轮转角生成横摆角速度和质心侧偏角的参考值;
3)根据所建立的车辆模型和控制需求,将模型预测控制问题描述为一个典型的非线性优化问题;
4)针对该非线性优化问题,基于庞特里亚金最小值原理和Nelder-Mead算法进行非线性优化问题的快速求解,包括以下过程:
将哈密顿函数重新写为关于控制量u(ki)的二次函数的形式:
H(x(ki),u(ki))=p1u(ki)2+p2(ki)u(ki)+g(x(ki))
其中,p1=Γu,p2(ki)=λ2(ki)ΔMmax/(γupIz),且有:
Figure FDA0002990600810000011
给出使哈密顿函数最小的最优控制律:
Figure FDA0002990600810000012
原优化问题被转换为两点边值问题:
Figure FDA0002990600810000013
上述两点边值问题通过Nelder-Mead算法进行求解,最终可得到最优控制律为:
Figure FDA0002990600810000021
步骤三、根据模型预测控制器计算所得的最优控制律,分别计算出四个轮胎的附加转矩,将附加转矩分配到四个轮毂电机上。
2.如权利要求1所述的一种面向车载应用的模型预测控制快速求解方法,其特征在于,所述步骤二中,步骤1)建立的车辆模型包括:
车辆二自由度模型:
Figure FDA0002990600810000022
Figure FDA0002990600810000023
其中,
Figure FDA0002990600810000024
Figure FDA0002990600810000025
分别表示车辆的质心侧偏角的导数和车辆的横摆角速度的导数,V表示车辆的纵向速度,Fyf和Fyr则分别表示前后轮胎的轮胎侧向力,Lf和Lr分别表示前后轴到车辆质心的距离,m是车辆的质量,Iz是车辆绕质心旋转的转动惯量,ΔMz为附加的横摆力矩;
轮胎模型可近似为:
Figure FDA0002990600810000026
其中,Fy为轮胎侧向力,μ为路面附着系数,Fz为垂直载荷,轮胎侧偏刚度Cα可分为前轮侧偏刚度Cf和后轮侧偏刚度Cr;α为轮胎侧偏角。
3.如权利要求2所述的一种面向车载应用的模型预测控制快速求解方法,其特征在于,所述步骤二中,步骤2)建立的参考模型包括:
关于质心侧偏角和横摆角速度的二自由度线性模型:
Figure FDA0002990600810000031
Figure FDA0002990600810000032
式中,
Figure FDA0002990600810000033
Figure FDA0002990600810000034
分别表示车辆的质心侧偏角的导数和车辆的横摆角速度的导数;Cf为前轮侧偏刚度;Cr为后轮侧偏刚度;V表示车辆的纵向速度;Lf和Lr分别表示前后轴到车辆质心的距离;m是车辆的质量;Iz是车辆绕质心旋转的转动惯量。
4.如权利要求1所述的一种面向车载应用的模型预测控制快速求解方法,其特征在于,所述步骤二中,步骤3)将模型预测控制问题描述为一个典型的非线性优化问题,非线性模型预测控制的目标函数为:
Figure FDA0002990600810000035
满足的约束为|u(ki-1)|≤1以及|x1(ki)|≤1,其中Γβ和Γu分别为质心侧偏角和控制量的权重系数,N为预测时域。
5.如权利要求1所述的一种面向车载应用的模型预测控制快速求解方法,其特征在于,所述步骤三中,四个轮胎的附加转矩计算过程为:
通过所述步骤二得到最优控制律u*(k)之后,分别计算四个轮胎的附加转矩:
Figure FDA0002990600810000036
Figure FDA0002990600810000037
其中,ΔTcfl(k),ΔTcrl(k),ΔTcfr(k),ΔTcrr(k)分别表示左前轮、左后轮、右前轮以及右后轮的附加转矩,Re表示轮胎的滚动半径,d表示车辆车身的宽度。
CN202010020411.2A 2020-01-09 2020-01-09 面向车载应用的模型预测控制快速求解方法 Active CN111158264B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010020411.2A CN111158264B (zh) 2020-01-09 2020-01-09 面向车载应用的模型预测控制快速求解方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010020411.2A CN111158264B (zh) 2020-01-09 2020-01-09 面向车载应用的模型预测控制快速求解方法

Publications (2)

Publication Number Publication Date
CN111158264A CN111158264A (zh) 2020-05-15
CN111158264B true CN111158264B (zh) 2021-06-29

Family

ID=70562093

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010020411.2A Active CN111158264B (zh) 2020-01-09 2020-01-09 面向车载应用的模型预测控制快速求解方法

Country Status (1)

Country Link
CN (1) CN111158264B (zh)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112000005B (zh) * 2020-06-29 2021-12-21 吉林大学 一种坡路经济巡航切换控制参数打靶求解方法
CN112346337A (zh) * 2020-09-15 2021-02-09 吉林大学 极限工况下基于后轮主动转向的车辆稳定性控制方法
CN112298193B (zh) * 2020-10-18 2021-08-24 吉林大学 快速实时的后轮主动转向预测控制方法
CN113805485B (zh) * 2021-10-13 2023-04-14 吉林大学 一种暖启动c/gmres方法、***、设备及介质
CN116279408A (zh) * 2023-02-03 2023-06-23 同济大学 一种基于快速求解算法的车辆纵侧向运动协同控制方法

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103912966B (zh) * 2014-03-31 2016-07-06 武汉科技大学 一种地源热泵制冷***优化控制方法
US20170139423A1 (en) * 2015-11-12 2017-05-18 King Fahd University Of Petroleum And Minerals Control system and method for multi-vehicle systems
CN107117170B (zh) * 2017-04-28 2019-04-09 吉林大学 一种基于经济性驾驶的实时预测巡航控制***
US11227234B2 (en) * 2018-06-11 2022-01-18 Traxen Inc. Normalized performance comparison techniques
CN108482363B (zh) * 2018-04-09 2020-03-17 吉林大学 车辆横摆稳定性预测模型控制方法
CN109795502B (zh) * 2018-09-27 2021-05-04 吉林大学 智能电动汽车路径跟踪模型预测控制方法
RU2697433C1 (ru) * 2018-10-26 2019-08-14 Федеральное Государственное Бюджетное Учреждение "Институт Прикладной Геофизики Имени Академика Е.К. Федорова" (Фгбу "Ипг") Способ автоматического определения параметров ионосферных слоев по ионограммам
CN110228462B (zh) * 2019-05-17 2021-03-26 吉林大学 四轮轮毂电机驱动电动汽车横摆稳定性控制方法

Also Published As

Publication number Publication date
CN111158264A (zh) 2020-05-15

Similar Documents

Publication Publication Date Title
CN111158264B (zh) 面向车载应用的模型预测控制快速求解方法
CN111890951B (zh) 智能电动汽车轨迹跟踪与运动控制方法
CN111332277B (zh) 极限工况下基于稳定区域的车辆侧向稳定性控制方法
Zhang et al. Evaluating model predictive path following and yaw stability controllers for over-actuated autonomous electric vehicles
CN111391822B (zh) 一种极限工况下汽车横纵向稳定性协同控制方法
CN111055921B (zh) 一种基于数据驱动的四轮转向模型预测控制方法
CN107561942A (zh) 基于模型补偿的智能车辆轨迹跟踪模型预测控制方法
Tian et al. Adaptive coordinated path tracking control strategy for autonomous vehicles with direct yaw moment control
CN108107731A (zh) 一种基于轮胎非线性特性的汽车稳定性控制方法
Liu et al. A real-time NMPC strategy for electric vehicle stability improvement combining torque vectoring with rear-wheel steering
CN112829766B (zh) 一种基于分布式驱动电动车辆的自适应路径跟踪方法
Tang et al. Coordinated control for path following of two‐wheel independently actuated autonomous ground vehicle
EL HAJJAMI et al. Neural network based sliding mode lateral control for autonomous vehicle
CN112578672A (zh) 基于底盘非线性的无人驾驶汽车轨迹控制***及其轨迹控制方法
CN116184835A (zh) 考虑输入时延与速度时变的无人驾驶车辆跟踪控制方法
Zhang et al. Coordinated longitudinal and lateral stability improvement for electric vehicles based on a real-time NMPC strategy
Raji et al. A tricycle model to accurately control an autonomous racecar with locked differential
CN116552547A (zh) 用于分布式驱动电动汽车的附加横摆力矩实时控制方法
CN112346337A (zh) 极限工况下基于后轮主动转向的车辆稳定性控制方法
CN112298193B (zh) 快速实时的后轮主动转向预测控制方法
CN116279409A (zh) 一种四轮独立驱动与转向电动汽车的协同控制方法
Li et al. Path tracking control based on the prediction of tire state stiffness using the optimized steering sequence
Sill et al. Cascaded predictive control of tire force saturation levels for vehicle stability
Zichen et al. Extension Integrated Control of Electric Vehicles AFS/DYC Based on LQR
Sun et al. Trajectory Tracking Control Design for 4WS Vehicle Based on Particle Swarm Optimization and Phase Plane Analysis

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant