CN114162110B - 一种无人驾驶车辆的横向稳定性控制方法 - Google Patents

一种无人驾驶车辆的横向稳定性控制方法 Download PDF

Info

Publication number
CN114162110B
CN114162110B CN202111424922.1A CN202111424922A CN114162110B CN 114162110 B CN114162110 B CN 114162110B CN 202111424922 A CN202111424922 A CN 202111424922A CN 114162110 B CN114162110 B CN 114162110B
Authority
CN
China
Prior art keywords
representing
unmanned vehicle
vehicle
front wheel
indicating
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
CN202111424922.1A
Other languages
English (en)
Other versions
CN114162110A (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.)
South China University of Technology SCUT
Original Assignee
South China University of Technology SCUT
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 South China University of Technology SCUT filed Critical South China University of Technology SCUT
Priority to CN202111424922.1A priority Critical patent/CN114162110B/zh
Publication of CN114162110A publication Critical patent/CN114162110A/zh
Application granted granted Critical
Publication of CN114162110B publication Critical patent/CN114162110B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/02Control of vehicle driving stability
    • B60W30/045Improving turning performance
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W2050/0001Details of the control system
    • B60W2050/0019Control system elements or transfer functions
    • B60W2050/0028Mathematical models, e.g. for simulation
    • B60W2050/0037Mathematical models of vehicle sub-units
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/10Internal combustion engine [ICE] based vehicles
    • Y02T10/40Engine management systems

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开一种无人驾驶车辆的横向稳定性控制方法,包括:建立无人驾驶车辆的二自由度动力学模型,基于线性变参数技术建立线性时变车辆动力学模型,所述的线性时变车辆动力学模型的目标是描述无人驾驶车辆的非线性;采集车辆当前的状态信,计算理想的期望横摆角速度和质心侧偏角,进行控制器的设计;根据带约束的目标函数优化问题,通过量子粒子群算法进行优化求解获得附加的前轮转向角;基于附加的前轮转向角实现无人驾驶车辆的横向稳定性和安全行驶。本发明中建立的车辆二自由模型考虑了无人驾驶车辆系统中轮胎的非线性,可以更有效的描述车辆系统的实际状态;将量子粒子群算法用于对目标函数的求解可以提高无人驾驶车辆横向稳定性的控制精度。

Description

一种无人驾驶车辆的横向稳定性控制方法
技术领域
本发明涉及无人驾驶车辆横向控制技术领域,特别涉及一种无人驾驶车辆的横向稳定性控制方法。
背景技术
近年来,无人驾驶车辆因其在提高车辆安全性、性能和交通效率方面的巨大潜力而受到越来越多的关注。由于无人驾驶车辆的传感系统可以获得更多的信息,例如车辆动力学信息、交通信息和道路信息,提高主动底盘操纵稳定性和主动安全性在一定程度上已经成为可能,从而有效减少车辆事故。以提高汽车主动安全性为目的稳定性控制系统成为研究热点。
车辆在行驶过程中,由于工况的变化会导致轮胎的刚度产生非线性变化。这对基于模型的车辆横向稳定性控制器会产生较大的影响,严重时甚至会导致控制器奔溃。因此,发明一种考虑轮胎非线性变化的控制方法是十分有必要的。此外,模型预测控制方法在线计算量过大,在实际工程中难以应用也是急需解决的问题。
现有技术中,耿国庆等在中国专利文献“一种基于ATSM的分布式驱动电动汽车横向稳定性控制方法”提出了一种车辆横向稳定性的控制方法,所用的方法为螺旋滑模控制算法,但是,没有考虑到车辆轮胎的非线性变化,因此所设计的控制器在汽车工况发生较大变化导致轮胎侧向力饱和时并不能保证稳定性。
发明内容
本发明提供一种无人驾驶车辆的横向稳定性控制方法,解决了无人驾驶车辆的横向稳定性受到轮胎非线性的影响和因为模型预测控制方法的在线计算量过大难以在实际工程中应用的问题。
为了前述发明目的,本发明提供的一种无人驾驶车辆的横向稳定性控制方法,通过以下步骤实现:
建立无人驾驶车辆的二自由度动力学模型,针对无人驾驶车辆系统的非线性,基于线性变参数技术建立线性时变车辆动力学模型,所述的线性时变车辆动力学模型的目标是描述无人驾驶车辆的非线性;
采集车辆当前的状态信息[β,r],并根据当前的无人驾驶车辆的状态计算理想的期望横摆角速度rr和质心侧偏角βr,β表示无人驾驶车辆当前的质心侧偏角,r表示无人驾驶车辆的横摆角速度:
针对所建立的线性时变车辆动力学模型进行控制器的设计:包括将无人驾驶车辆的二自由度动力学模型转化为预测模型,通过预测模型预测得到未来的状态信息;考虑无人驾驶车辆系统的转向约束,得到带约束的优化目标函数;
根据所所述的带约束的目标函数优化问题,通过量子粒子群算法进行优化求解获得附加的前轮转向角;
基于所述附加的前轮转向角实现无人驾驶车辆的横向稳定性和安全行驶。
考虑模型预测控制算法的在线计算量较大,而量子粒子群算法具有设计思路简单,需要调整的参数较少,求解效率较高等优点,可以用于对带约束的目标函数进行求解,从而得到附加的前轮转向角。
进一步地,获得所述线性时变车辆动力学模型的具体步骤如下:忽略车辆的纵向力行为,在小转角假设下建立车辆二自由度动力学模型
Figure BDA0003377833710000021
其中:FYf=-Cfαf,FYr=-Crαr
Figure BDA0003377833710000022
式中,m指无人驾驶车辆的质量;
Figure BDA0003377833710000023
表示无人驾驶车辆质心侧偏角的变化率,r表示无人驾驶车辆的横摆角速度,FYf表示前轮的侧向力;FYr表示后轮的侧向力;Iz表示无人驾驶车辆的横摆转动惯量;/>
Figure BDA0003377833710000024
表示无人驾驶车辆的横摆角速度变化率;lf和lr分别表示无人驾驶车辆的质心到前轴和后轴的距离;Cf表示前轮侧偏刚度;αf表示前轮侧偏角;Cr表示后轮侧偏刚度;αr表示后轮侧偏角;vx指主动前轮转向角;δ表示无人驾驶车辆的前轮转向角;β表示无人驾驶车辆的质心侧偏角。
进一步地,基于所述车辆二自由度动力学模型,轮胎的侧偏刚度可以通过轮胎侧偏角表示为:
Cf=M1f)Cfmin+M2f)Cfmax
Cr=N1r)Crmin+N2r)Crmax
其中,
Figure BDA0003377833710000025
Figure BDA0003377833710000026
式中,αfmax和αfmin表示前轮侧偏角的最大值和最小值,αrmax和αrmin分别为后轮侧偏角的最大值和最小值,M1和M2为前轮侧偏角的加权系数,N1和N2分别是后轮侧偏角的加权系数;
通过线性变参数技术可以得到无人驾驶车辆的线性时变模型如下:
Figure BDA0003377833710000031
其中:θ1=M1N1,θ2=M2N1,θ3=M1N2,θ4=M2N2
其中:
Figure BDA0003377833710000032
/>
Figure BDA0003377833710000033
Figure BDA0003377833710000034
Figure BDA0003377833710000035
Figure BDA0003377833710000036
Figure BDA0003377833710000037
其中:Cfmax表示前轮最大侧偏刚度,Crmax表示后轮最大侧偏刚度,Cfmin表示前轮最小侧偏刚度,Crmin表示后轮最小侧偏刚度,θn代表系数,x为状态量,u表示控制量,
Figure BDA0003377833710000038
表示状态量的导数,[]表示矩阵运算。
进一步地,所述的期望横摆角速度βr和期望质心侧偏角rr采用如下公式计算:
Figure BDA0003377833710000041
Figure BDA0003377833710000042
式中,lf和lr分别表示无人驾驶车辆的质心到前轴和后轴的距离,Cf表示前轮侧偏刚度,Cr表示后轮侧偏刚度,m指无人驾驶车辆的质量,vx指主动前轮转向角,δ表示无人驾驶车辆的前轮转向角,μ表示路面附着系数,g表示重力加速度。
进一步地,所述预测模型为
Figure BDA0003377833710000043
其中,k代表某一时刻,u(k)表示在时间k时的输入量,A代表状态矩阵,B代表输入矩阵,x(k)是状态,y(k)是输出量,C表示输出矩阵。
将预测模型写为增量形式:
Figure BDA0003377833710000044
其中:
Δx(k)=x(k)-x(k-1)
Δu(k)=u(k)-u(k-1)
进一步地,所述通过预测模型预测得到未来的状态信息,其中所述未来的状态信息表示为:
Yp(k+1)=ΦΔx(k)+Ψy(k)+ΓΔU(k)
其中,Yp(k+1)、Φ、Ψ、ΔU(k)分别代表不同的矩阵,Np表示预测的长度,取值类型为正整数;
Figure BDA0003377833710000045
Figure BDA0003377833710000051
Figure BDA0003377833710000052
Figure BDA0003377833710000053
/>
Figure BDA0003377833710000054
其中:I为单位矩阵,其阶数为系统输出量的个数,A代表状态矩阵,B代表输入矩阵,C表示输出矩阵,Nc表示控制时域的长度,k代表某一时刻。
进一步地,所述带约束的目标函数为:
Figure BDA0003377833710000055
约束条件为:
umin(k)≤u(k)≤umax(k)
Δumin(k)≤Δu(k)≤Δumax(k)
其中,umin(k)和umax(k)表示前轮转向角最大输入量和最小输入量,Δumin(k)和Δumax(k)表示在采样时间内前轮转向角的最大输入量和最小输入量,Np表示预测的长度,取值类型为正整数,k代表某一时刻,yr代表参考的值,yr=[βr,rr],Q表示实际值和参考值之间误差的权重系数,R表示输入量的权重系数。
进一步地,所述通过量子粒子群算法进行优化求解获得附加的前轮转向角中,将带约束的目标函数转化为带惩罚项的目标函数,所述带惩罚项的目标函数为量子粒子群算法的适应度函数。
进一步地,所述带惩罚项的目标函数为:
Figure BDA0003377833710000061
其中,hj(ΔU(k))表示惩罚项,λ为惩罚系数,当ΔU(k)中的解都满足前轮转向角的约束条件时,
Figure BDA0003377833710000062
的值为零,否则/>
Figure BDA0003377833710000063
的值为hj(ΔU(k)),Q表示实际值和参考值之间误差的权重系数,R表示输入量的权重系数,k代表某一时刻,yr代表参考的值,yr=[βr,rr]。
进一步地,所述的带约束的目标函数可以转化为量子粒子群的适应度函数,其中的约束可以转化为惩罚项,量子粒子群的粒子进化规则如下所示:
Figure BDA0003377833710000064
其中,sa,b(t)=φa,b(t)Pa,b(t)+[1-φa,b(t)]Gb(t);
Figure BDA0003377833710000065
t表示第t次迭代;αa表示收缩-扩张系数,令其首次迭代时为1并线性衰减至迭代结束时为0.2,Cb为平均最佳粒子的第b维;Xa,b为第a粒子第b维;ua,b(t),φa,b(t)为第t次迭代第a粒子第b维的概率函数,两个是互不相关的概率函数,在每轮迭代过程中随机生成各自的数值,且ua,b(t),φa,b(t)~U(0,1),U为Uniformity,均匀性,表示随机变量服从(0,1)上均匀分布;Pa,b为第a粒子的个体最佳粒子的第b维;Gb为群最佳粒子的第b维;M为粒子群粒子个数。
与现有技术相比,本发明能够实现的有益效果至少如下:
本发明在无人驾驶车辆的横向稳定性控制中考虑了轮胎的非线性变化,从而保证了无人驾驶车辆的横向稳定性具有很好的控制效果;此外,将量子粒子群算法用于对目标函数的求解,提高了模型预测控制方法在实际应用中的可行性。
附图说明
图1为本发实施例提供的一种无人驾驶车辆的横向稳定性控制方法的流程图。
图2为本发明实施涉及的线性二自由度车辆动力学模型
图3为本发明实施涉及的轮胎的特性曲线图。
图4为本发明实施涉及的驾驶员输入方向盘转角。
图5为本发明实施涉及双移线工况下的横摆角速度对比图。
图6为本发明实施涉及双移线工况下的质心侧偏角对比图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整的描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都是本发明保护的范围。
请参阅图1,本发明提供的一种无人驾驶车辆的横向稳定性控制方法,包括以下步骤:
步骤1、针对无人驾驶车辆系统的非线性,基于线性变参数技术建立无人驾驶的线性时变车辆动力学模型,所述的线性时变车辆动力学模型的目标是描述无人驾驶车辆的非线性,使其能够更准确的描述无人驾驶车辆系统的变化状态。
在本发明的一些实施例中,本步骤具体包括:
1)建立如图2所示X-Y为固定于地面的平面坐标系,其中X表示直路面的方向,Y表示与X轴垂直的方向;x-y为固定于车辆的坐标系,其中x表示车辆的纵向,y表示车辆的侧向,其坐标系原点位于车辆质心。本发明重点关注车辆的侧向动力学及稳定性,忽略车辆的纵向力行为,在小转角假设下建立车辆二自由度动力学模型
Figure BDA0003377833710000071
其中:FYf=-Cfαf,FYr=-Crαr
Figure BDA0003377833710000072
式中,m指无人驾驶车辆的质量;
Figure BDA0003377833710000073
表示无人驾驶车辆质心侧偏角的变化率;r表示无人驾驶车辆的横摆角速度;FYf表示前轮的侧向力;FYr表示后轮的侧向力;Iz表示无人驾驶车辆的横摆转动惯量;/>
Figure BDA0003377833710000074
表示无人驾驶车辆的横摆角速度变化率;lf和lr分别表示无人驾驶车辆的质心到前轴和后轴的距离;Cf表示前轮侧偏刚度;αf表示前轮侧偏角;Cr表示后轮侧偏刚度;αr表示后轮侧偏角;vx指主动前轮转向角;δ表示无人驾驶车辆的前轮转向角;β表示无人驾驶车辆的质心侧偏角。
整理后可得:
Figure BDA0003377833710000081
2)如图3所示,通过线性变参数技术,轮胎的侧偏刚度可以通过轮胎侧偏角表示为:
Cf=M1f)Cfmin+M2f)Cfmax
Cr=N1r)Crmin+N2r)Crmax
其中:
Figure BDA0003377833710000082
Figure BDA0003377833710000083
式中,αfmax和αfmin表示前轮侧偏角的最大值和最小值,αrmax和αrmin分别为后轮侧偏角的最大值和最小值;M1和M2为前轮侧偏角的加权系数,N1和N2分别是后轮侧偏角的加权系数。
则,无人驾驶车辆的线性时变车辆动力学模型可以表示为:
Figure BDA0003377833710000084
其中θ1=M1N1,θ2=M2N1,θ3=M1N2,θ4=M2N2
式中,An表示A1、A2、A3、A4;θn代表系数;n代表1、2、3、4;Bn代表B1、B2、B3、B4;x为状态量,u表示控制量,
Figure BDA0003377833710000085
表示状态量的导数。
Figure BDA0003377833710000086
Figure BDA0003377833710000087
/>
Figure BDA0003377833710000088
Figure BDA0003377833710000091
Figure BDA0003377833710000092
Figure BDA0003377833710000093
其中,Cfmax表示前轮最大侧偏刚度,Crmax表示后轮最大侧偏刚度,Cfmin表示前轮最小侧偏刚度,Crmin表示后轮最小侧偏刚度,[]表示矩阵运算。
步骤2、采集车辆当前的状态信息[β,r],并根据当前的无人驾驶车辆的状态计算理想的期望横摆角速度βr和质心侧偏角rr
在本发明的其中一些实施例中,期望横摆角速度βr和质心侧偏角rr的计算方式分别如下:
Figure BDA0003377833710000094
Figure BDA0003377833710000095
其中:μ表示路面附着系数,g表示重力加速度。
步骤3、进行无人驾驶车辆横向稳定性的控制器设计:包括将无人驾驶车辆的二自由度动力学模型转化为预测模型,通过预测模型预测得到未来的状态信息;考虑无人驾驶车辆系统的转向约束,得到带约束的优化目标函数。
在本发明的其中一些实施例中,本步骤具体包括:
1)将步骤1中建立的无人驾驶车辆的车辆二自由度动力学模型使用前项欧拉法,通过引入采样时间T,得到离散化后的预测模型为:
Figure BDA0003377833710000096
其中,k代表某一时刻,u(k)表示在时间k时的输入量,A代表状态矩阵,B代表输入矩阵,x(k)是状态,y(k)是输出量,C表示输出矩阵;
将预测模型写为增量形式:
Figure BDA0003377833710000101
其中:
Δx(k)=x(k)-x(k-1)
Δu(k)=u(k)-u(k-1)
Δx(k)表示状态量x(k)的变化量,Δu(k)表示输入量u(k)的变化量;
2)预测的输出量可以写为:
y(k+1)=CΔx(k+1)+y(k)=CAΔx(k)+CBΔu(k)+y(k)
y(k+2)=CΔx(k+2)+y(k+1)
=(CA2+CA)Δx(k)+(CAB+CB)Δu(k)+CBΔu(k+1)+y(k)
Figure BDA0003377833710000102
Figure BDA0003377833710000103
式中,Nc表示控制时域的长度,N表示长度,下标c表示控制;
Figure BDA0003377833710000104
是求和公式的写法,Am表示A的m次方。
则,系统未来Np步预测的输出可以表示为:Yp(k+1)=ΦΔx(k)+Ψy(k)+ΓΔU(k),Yp(k+1)、Φ、Ψ、ΔU(k)分别代表不同的矩阵,Np表示预测的长度,取值类型为正整数;
其中:
Figure BDA0003377833710000105
/>
Figure BDA0003377833710000111
Figure BDA0003377833710000112
Figure BDA0003377833710000113
Figure BDA0003377833710000114
其中:I为单位矩阵,其阶数为系统输出量的个数。Npx1表示矩阵有Np行,1列。
考虑无人驾驶车辆的前轮转向角和前轮转向角速度的限制,
umin(k)≤u(k)≤umax(k)
Δumin(k)≤Δu(k)≤Δumax(k)
其中umin(k)和umax(k)表示前轮转向角的最大输入量和最小输入量,Δumin(k)和Δumax(k)表示在采样时间内的前轮转向角的最大变化量和最小变化量。
3)得到带约束的目标函数如下:
Figure BDA0003377833710000115
约束条件为:
umin(k)≤u(k)≤umax(k)
Δumin(k)≤Δu(k)≤Δumax(k)
式中,yr代表参考的值,yr=[βr,rr];Q表示实际值和参考值之间误差的权重系数,R表示输入量的权重系数,j代表未来的第j步,j≤Np
步骤三、控制器目标函数的求解。
1)将带约束的目标函数转化为带惩罚项的目标函数为:
Figure BDA0003377833710000121
其中,hj(ΔU(k))表示一个较大的值,指惩罚项,λ为惩罚系数,当ΔU(k)中的解都满足前轮转向角的约束条件时,
Figure BDA0003377833710000122
的值为零,否则/>
Figure BDA0003377833710000123
的值为hj(ΔU(k))。
2)将1)中的目标函数作为量子粒子群算法的适应度函数,每个粒子代表一个解,其中粒子的进化规则如下所示:
Figure BDA0003377833710000124
其中,sa,b(t)=φa,b(t)Pa,b(t)+[1-φa,b(t)]Gb(t);
Figure BDA0003377833710000125
t表示第t次迭代;αa表示收缩-扩张系数,令其首次迭代时为1并线性衰减至迭代结束时为0.2,Cb为平均最佳粒子的第b维;Xa,b为第a粒子第b维;ua,b(t),φa,b(t)为第t次迭代第a粒子第b维的概率函数,两个是互不相关的概率函数,在每轮迭代过程中随机生成各自的数值,且ua,b(t),φa,b(t)~U(0,1),U为Uniformity,均匀性,表示随机变量服从(0,1)上均匀分布;Pa,b为第a粒子的个体最佳粒子的第b维;Gb为群最佳粒子的第b维;M为粒子群粒子个数,Xa,b(t)代表此时粒子所处的位置,Xa,b(t+1)代表更新后的下一时刻粒子所处的位置;sa,b代表在时间t时粒子个体最优位置与粒子群体最优位置之间的一个随机位置。
通过量子粒子群算法的求解可以得到最优的附加前轮转向角。
本实施实例在无人驾驶车辆的横向稳定性控制中考虑到了车辆系统的非线性变化,该非线性变化主要体现在轮胎的侧偏刚度上,使得模型能够更有效的描述无人驾驶车辆系统的变化状态。此外,将量子粒子群算法用于对控制器的优化求解提高了模型预测控制器的控制精度,提高控制效果。
本实施实例在无人驾驶车辆中使用的主要性能指标和设备参数为:m=1395kg,Iz=1536kg m2,Cf=47900N/rad,Cr=45700N/rad,lf=1.04m,lr=1.62m,vx=100km/h。
本方法给出的转角是附加的前轮转向角,是对驾驶员操作方向盘时造成车辆不稳定的补偿,图4给出了某一实施例中驾驶员输入的方向盘转角。
图5给出了在双移线工况下的无人驾驶车辆横摆角速度的对比图,图中显示本发明所述方法可以有效跟踪期望的横摆角速度。
图6给出了在双移线工况下的无人驾驶车辆的质心侧偏角的对比图,从图中可以看出,本发明所述方法可以有效地降低无人驾驶车辆的质心侧偏角,同时很好地提高了车辆的横向稳定性。
对所公开的实施例的上述说明,使本领域专业技术人员能够实现或使用本发明。对这些实施例的多种修改对本领域的专业技术人员来说将是显而易见的,本文中所定义的一般原理可以在不脱离本发明的精神或范围的情况下,在其他实施例中实现。因此,本发明将不会被限制于本文所示的这些实施例,而是要符合与本文所公开的原理和新颖特点相一致的最宽的范围。

Claims (8)

1.一种无人驾驶车辆的横向稳定性控制方法,其特征在于,包括以下步骤:
建立无人驾驶车辆的二自由度动力学模型,针对无人驾驶车辆系统的非线性,基于线性变参数技术建立线性时变车辆动力学模型,所述的线性时变车辆动力学模型的目标是描述无人驾驶车辆的非线性;
采集车辆当前的状态信息
Figure QLYQS_1
,并根据当前的无人驾驶车辆的状态计算理想的期望横摆角速度/>
Figure QLYQS_2
和质心侧偏角/>
Figure QLYQS_3
,/>
Figure QLYQS_4
表示无人驾驶车辆当前的质心侧偏角,/>
Figure QLYQS_5
表示无人驾驶车辆的横摆角速度:
针对所建立的线性时变车辆动力学模型进行控制器的设计:包括将无人驾驶车辆的二自由度动力学模型转化为预测模型,通过预测模型预测得到未来的状态信息;考虑无人驾驶车辆系统的转向约束,得到带约束的优化目标函数;
根据所述的带约束的目标函数优化问题,通过量子粒子群算法进行优化求解获得附加的前轮转向角;
基于所述附加的前轮转向角实现无人驾驶车辆的横向稳定性和安全行驶;
获得所述线性时变车辆动力学模型的具体步骤如下:忽略车辆的纵向力行为,在小转角假设下建立车辆二自由度动力学模型
Figure QLYQS_6
其中:
Figure QLYQS_7
, />
Figure QLYQS_8
, />
Figure QLYQS_9
, />
Figure QLYQS_10
式中,
Figure QLYQS_21
指无人驾驶车辆的质量;/>
Figure QLYQS_12
表示无人驾驶车辆质心侧偏角的变化率,/>
Figure QLYQS_17
表示无人驾驶车辆的横摆角速度,/>
Figure QLYQS_18
表示前轮的侧向力;/>
Figure QLYQS_22
表示后轮的侧向力;/>
Figure QLYQS_25
表示无人驾驶车辆的横摆转动惯量;/>
Figure QLYQS_26
表示无人驾驶车辆的横摆角速度变化率;/>
Figure QLYQS_20
和 />
Figure QLYQS_24
分别表示无人驾驶车辆的质心到前轴和后轴的距离;/>
Figure QLYQS_11
表示前轮侧偏刚度;/>
Figure QLYQS_16
表示前轮侧偏角;/>
Figure QLYQS_14
表示后轮侧偏刚度;/>
Figure QLYQS_15
表示后轮侧偏角;/>
Figure QLYQS_19
指主动前轮转向角;/>
Figure QLYQS_23
表示无人驾驶车辆的前轮转向角;/>
Figure QLYQS_13
表示无人驾驶车辆的质心侧偏角;
通过线性变参数技术,基于所述车辆二自由度动力学模型,轮胎的侧偏刚度可以通过轮胎侧偏角表示为:
Figure QLYQS_27
Figure QLYQS_28
其中,
Figure QLYQS_29
Figure QLYQS_30
式中,
Figure QLYQS_31
和/>
Figure QLYQS_35
表示前轮侧偏角的最大值和最小值,/>
Figure QLYQS_37
和/>
Figure QLYQS_33
分别为后轮侧偏角的最大值和最小值,/>
Figure QLYQS_34
和/>
Figure QLYQS_36
为前轮侧偏角的加权系数,/>
Figure QLYQS_38
和/>
Figure QLYQS_32
分别是后轮侧偏角的加权系数;
通过线性变参数技术可以得到无人驾驶车辆的线性时变车辆动力学模型如下:
Figure QLYQS_39
其中:
Figure QLYQS_40
,/>
Figure QLYQS_41
,/>
Figure QLYQS_42
,/>
Figure QLYQS_43
其中:
Figure QLYQS_44
Figure QLYQS_45
Figure QLYQS_46
Figure QLYQS_47
Figure QLYQS_48
, />
Figure QLYQS_49
Figure QLYQS_50
, />
Figure QLYQS_51
其中:
Figure QLYQS_52
表示前轮最大侧偏刚度,/>
Figure QLYQS_53
表示后轮最大侧偏刚度,/>
Figure QLYQS_54
表示前轮最小
侧偏刚度,
Figure QLYQS_55
表示后轮最小侧偏刚度,/>
Figure QLYQS_56
代表系数,/>
Figure QLYQS_57
为状态量,/>
Figure QLYQS_58
表示控制量,/>
Figure QLYQS_59
表示状态量的导数,/>
Figure QLYQS_60
表示矩阵运算。
2.根据权利要求1所述的一种无人驾驶车辆的横向稳定性控制方法,其特征在于, 所述的期望横摆角速度
Figure QLYQS_61
和期望质心侧偏角/>
Figure QLYQS_62
采用如下公式计算:
Figure QLYQS_63
Figure QLYQS_64
/>
式中,
Figure QLYQS_65
和 />
Figure QLYQS_70
分别表示无人驾驶车辆的质心到前轴和后轴的距离,/>
Figure QLYQS_72
表示前轮侧偏刚度,/>
Figure QLYQS_66
表示后轮侧偏刚度,/>
Figure QLYQS_69
指无人驾驶车辆的质量,/>
Figure QLYQS_71
指主动前轮转向角,/>
Figure QLYQS_73
表示无人驾驶车辆的前轮转向角,/>
Figure QLYQS_67
表示路面附着系数,/>
Figure QLYQS_68
表示重力加速度。
3.根据权利要求2所述的一种无人驾驶车辆的横向稳定性控制方法,其特征在于,所述预测模型为
Figure QLYQS_74
其中,
Figure QLYQS_75
代表某一时刻,/>
Figure QLYQS_76
表示在时间/>
Figure QLYQS_77
时的输入量,A代表状态矩阵,B代表输入矩阵,
Figure QLYQS_78
是状态,/>
Figure QLYQS_79
是输出量,/>
Figure QLYQS_80
表示输出矩阵。
4.根据权利要求3所述的一种无人驾驶车辆的横向稳定性控制方法,其特征在于,所述通过预测模型预测得到未来的状态信息,其中所述未来的状态信息表示为:
Figure QLYQS_81
其中,
Figure QLYQS_82
、/>
Figure QLYQS_83
、/>
Figure QLYQS_84
、/>
Figure QLYQS_85
分别代表不同的矩阵,/>
Figure QLYQS_86
表示预测的长度,取值类型为正整数;
Figure QLYQS_87
Figure QLYQS_88
Figure QLYQS_89
Figure QLYQS_90
Figure QLYQS_91
式中,
Figure QLYQS_92
为单位矩阵,其阶数为系统输出量的个数,A代表状态矩阵,B代表输入矩阵,/>
Figure QLYQS_93
表示输出矩阵,/>
Figure QLYQS_94
表示控制时域的长度,/>
Figure QLYQS_95
代表某一时刻。/>
5.根据权利要求4的一种无人驾驶车辆的横向稳定性控制方法,其特征在于,所述带约束的目标函数为:
Figure QLYQS_96
约束条件为:
Figure QLYQS_97
Figure QLYQS_98
其中,
Figure QLYQS_101
和/>
Figure QLYQS_102
表示前轮转向角最大输入量和最小输入量,/>
Figure QLYQS_105
和/>
Figure QLYQS_100
表示在采样时间内前轮转向角的最大输入量和最小输入量,/>
Figure QLYQS_103
表示预测的长度,取值类型为正整数,/>
Figure QLYQS_106
代表某一时刻,/>
Figure QLYQS_108
代表参考的值,/>
Figure QLYQS_99
,/>
Figure QLYQS_104
表示实际值和参考值之间误差的权重系数,/>
Figure QLYQS_107
表示输入量的权重系数。
6.根据权利要求5的一种无人驾驶车辆的横向稳定性控制方法,其特征在于,所述通
过量子粒子群算法进行优化求解获得附加的前轮转向角中,将带约束的目标函数转化为带惩
罚项的目标函数,所述带惩罚项的目标函数为量子粒子群算法的适应度函数。
7.根据权利要求6的一种无人驾驶车辆的横向稳定性控制方法,其特征在于,所述带惩罚项的目标函数为:
Figure QLYQS_109
其中,
Figure QLYQS_111
表示惩罚项,/>
Figure QLYQS_114
为惩罚系数,当/>
Figure QLYQS_117
中的解都满足前轮转向角的约束条件时,/>
Figure QLYQS_112
的值为零,否则/>
Figure QLYQS_115
的值为/>
Figure QLYQS_118
,/>
Figure QLYQS_120
表示实际值和参考值之间误差的权重系数,/>
Figure QLYQS_110
表示输入量的权重系数,/>
Figure QLYQS_113
代表某一时刻,/>
Figure QLYQS_116
代表参考的值,/>
Figure QLYQS_119
8.根据权利要求7的一种无人驾驶车辆的横向稳定性控制方法,其特征在于,所述量子粒子群算法中粒子的进化规则为:
Figure QLYQS_121
其中,
Figure QLYQS_139
;/>
Figure QLYQS_143
, />
Figure QLYQS_146
表示第/>
Figure QLYQS_123
次迭代;/>
Figure QLYQS_128
表示收缩-扩张系数,/>
Figure QLYQS_132
为 平均最佳粒子的第/>
Figure QLYQS_136
维;/>
Figure QLYQS_124
为第 />
Figure QLYQS_129
粒子第 />
Figure QLYQS_133
维;/>
Figure QLYQS_137
, />
Figure QLYQS_140
为第/>
Figure QLYQS_142
次迭代第/>
Figure QLYQS_145
粒子第/>
Figure QLYQS_148
维的概率函数,两个是互不相关的概率函数,在每轮迭代过程中随机生成各自的数值,且/>
Figure QLYQS_138
, />
Figure QLYQS_141
~/>
Figure QLYQS_144
表示随机变量服从(0,1) 上均匀分布;/>
Figure QLYQS_147
为第
Figure QLYQS_122
粒子的个体最佳粒子的第/>
Figure QLYQS_126
维;/>
Figure QLYQS_130
为群最佳粒子的第/>
Figure QLYQS_134
维;/>
Figure QLYQS_125
为粒子群粒子个数,/>
Figure QLYQS_127
代表更新后的下一时刻粒子所处的位置;/>
Figure QLYQS_131
代表在时间/>
Figure QLYQS_135
时粒子个体最优位置与粒子群体最优位置之间的一个随机位置。/>
CN202111424922.1A 2021-11-26 2021-11-26 一种无人驾驶车辆的横向稳定性控制方法 Active CN114162110B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111424922.1A CN114162110B (zh) 2021-11-26 2021-11-26 一种无人驾驶车辆的横向稳定性控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111424922.1A CN114162110B (zh) 2021-11-26 2021-11-26 一种无人驾驶车辆的横向稳定性控制方法

Publications (2)

Publication Number Publication Date
CN114162110A CN114162110A (zh) 2022-03-11
CN114162110B true CN114162110B (zh) 2023-05-23

Family

ID=80481151

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111424922.1A Active CN114162110B (zh) 2021-11-26 2021-11-26 一种无人驾驶车辆的横向稳定性控制方法

Country Status (1)

Country Link
CN (1) CN114162110B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115202341B (zh) * 2022-06-16 2023-11-03 同济大学 一种自动驾驶车辆横向运动控制方法及系统

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108454623A (zh) * 2018-01-22 2018-08-28 大连理工大学 一种四轮独立驱动无人驾驶电动车辆轨迹跟踪控制方法
CN109976159A (zh) * 2019-04-09 2019-07-05 台州学院 基于安全可控域的智能车辆横向控制方法

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108454623A (zh) * 2018-01-22 2018-08-28 大连理工大学 一种四轮独立驱动无人驾驶电动车辆轨迹跟踪控制方法
CN109976159A (zh) * 2019-04-09 2019-07-05 台州学院 基于安全可控域的智能车辆横向控制方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
宋晓华 ; 邵毅明 ; 屈治华 ; 束海波 ; .基于模型预测控制的车辆轨迹跟踪稳定性研究.重庆理工大学学报(自然科学).2020,(第08期),全文. *
李家齐 ; .基于模型预测控制的路径跟踪控制器模型仿真.汽车实用技术.2020,(第01期),全文. *
郭旭东 ; 杨世春 ; .自动驾驶4WS车辆路径跟踪最优控制算法仿真.计算机仿真.2020,(第04期),全文. *

Also Published As

Publication number Publication date
CN114162110A (zh) 2022-03-11

Similar Documents

Publication Publication Date Title
CN113320542B (zh) 一种自动驾驶车辆的跟踪控制方法
CN112289020B (zh) 混合网络攻击下基于自适应触发机制的车辆路径跟踪安全控制方法
CN111055921B (zh) 一种基于数据驱动的四轮转向模型预测控制方法
CN108422901A (zh) 一种基于整车综合性能最优的电动轮驱动车辆车轮转矩多目标优化方法
Xu et al. Model predictive control for lane keeping system in autonomous vehicle
CN110509915B (zh) 一种基于时变速度的四轮驱动汽车横向稳定性控制方法
CN112578672B (zh) 基于底盘非线性的无人驾驶汽车轨迹控制系统及其轨迹控制方法
Salehpour et al. Vehicle path tracking by integrated chassis control
CN114162110B (zh) 一种无人驾驶车辆的横向稳定性控制方法
CN113009829A (zh) 一种智能网联车队纵横向耦合控制方法
CN113050651A (zh) 智能车自主行驶路径跟踪的时滞控制方法及系统
CN115534938A (zh) 一种基于附加横摆力矩的人机共驾汽车紧急避撞控制方法及系统
CN115542813A (zh) 无人驾驶车辆控制方法、装置、电子设备及存储介质
CN109850015B (zh) 一种控制参数可自动调节的电动车主动前轮转向控制方法
Li et al. Adaptive sliding mode control of lateral stability of four wheel hub electric vehicles
CN113733929B (zh) 轮毂电机驱动车辆的车轮转矩协调控制方法及装置
Sousa et al. Nonlinear tire model approximation using machine learning for efficient model predictive control
Zhang et al. A fuzzy control strategy and optimization for four wheel steering system
Luo et al. Coordinated control of longitudinal/lateral/vertical tire forces for distributed electric vehicles
CN113460090B (zh) 自动驾驶车辆t型紧急避撞控制方法、系统、介质及设备
Wang et al. Road Condition Based Adaptive Model Predictive Control for Autonomous Vehicles
CN113386767A (zh) 一种基于Koopman算子的四轮转向滚动时域控制方法
Liu et al. Optimal control of path tracking for vehicle-handling dynamics
Hou et al. Integrated chassis control using ANFIS
Rao et al. On spatial smoothing and weighted subspace methods

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