CN103448716B - 分布式电驱动车辆纵-横-垂向力协同控制方法 - Google Patents
分布式电驱动车辆纵-横-垂向力协同控制方法 Download PDFInfo
- Publication number
- CN103448716B CN103448716B CN201310413708.5A CN201310413708A CN103448716B CN 103448716 B CN103448716 B CN 103448716B CN 201310413708 A CN201310413708 A CN 201310413708A CN 103448716 B CN103448716 B CN 103448716B
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- des
- mtd
- mfrac
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 67
- 238000005457 optimization Methods 0.000 claims abstract description 37
- 238000009472 formulation Methods 0.000 claims abstract description 16
- 239000000203 mixture Substances 0.000 claims abstract description 16
- 230000004888 barrier function Effects 0.000 claims abstract description 12
- 238000013461 design Methods 0.000 claims abstract description 7
- 238000009795 derivation Methods 0.000 claims abstract description 4
- 239000013598 vector Substances 0.000 claims description 28
- 239000000725 suspension Substances 0.000 claims description 22
- 230000001133 acceleration Effects 0.000 claims description 18
- 238000004088 simulation Methods 0.000 claims description 12
- 230000008569 process Effects 0.000 claims description 10
- 230000008859 change Effects 0.000 claims description 6
- 239000011159 matrix material Substances 0.000 claims description 6
- XOFYZVNMUHMLCC-ZPOLXVRWSA-N prednisone Chemical compound O=C1C=C[C@]2(C)[C@H]3C(=O)C[C@](C)([C@@](CC4)(O)C(=O)CO)[C@@H]4[C@@H]3CCC2=C1 XOFYZVNMUHMLCC-ZPOLXVRWSA-N 0.000 claims description 6
- 230000000694 effects Effects 0.000 claims description 5
- 238000012545 processing Methods 0.000 claims description 5
- 238000013459 approach Methods 0.000 claims description 3
- 230000014509 gene expression Effects 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 230000003068 static effect Effects 0.000 claims description 3
- 238000012546 transfer Methods 0.000 claims description 3
- 238000012804 iterative process Methods 0.000 claims description 2
- 101150036841 minJ gene Proteins 0.000 claims description 2
- 238000005516 engineering process Methods 0.000 description 4
- 238000011160 research Methods 0.000 description 4
- 230000008685 targeting Effects 0.000 description 3
- 238000011217 control strategy Methods 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
Landscapes
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Vehicle Body Suspensions (AREA)
Abstract
本发明涉及一种分布式电驱动车辆纵-横-垂向力协同控制方法,利用车辆控制***完成:1)期望合力与力矩的制定;2)四轮纵、横、垂向力优化分配;3)力的具体执行。其中,利用车辆的各种信息,获得整车合力和力矩的期望值,然后建立约束条件和目标函数构成完整的轮胎力优化问题,再对此问题设计优化求解算法,优化算法包括采用障碍函数法和牛顿法的约束优化方法、基于车辆状态连续性的可行域规划方法。本发明无须根据不同工况对轮胎力实施不同控制策略,实现了轮胎纵、横、垂向力的统一优化分配与控制,综合改善了车辆操纵稳定性能和车辆行驶姿态,未来可用于实现车辆的无人驾驶。
Description
技术领域
本发明涉及分布式电驱动车辆的底盘一体化控制技术,特别是关于一种分布式电驱动车辆的纵、横、垂向力优化分配与控制方法。
背景技术
随着汽车技术的进步和发展,多种多样的底盘电子控制技术得到了广泛的研究和应用。这些底盘电子控制技术主要从轮胎纵、横、垂向力三方面分别进行主动控制,提升车辆操纵稳定性能或改善车辆行驶姿态。但由于车辆***具有动力学严重耦合的复杂特性,各种底盘电子控制***在控制目标和执行效果等方面存在不同程度的冲突或互补。为消除不同底盘电子控制***之间的冲突并增强其互补性,综合提升车辆操纵稳定性并改善车辆行驶姿态,必须对车辆的纵、横、垂向力进行协同控制,从而提升车辆的综合性能。
然而,目前的底盘一体化控制研究存在着明显的不足。首先,对轮胎垂向力的主动控制缺乏对车辆操纵稳定性目标和车辆姿态目标的综合考虑。现有研究中,大多利用主动悬架力控制车身垂向振动、俯仰、侧倾等车身姿态目标;针对操纵稳定性目标仅考虑轮胎动载荷最小或按比例跟随制动力矩,并未根据车辆实际状态对各轮垂向力进行综合优化设计。其次,现有底盘一体化控制***尚未提出能真正实现轮胎纵、横、垂向力统一优化分配的方法。当前研究仅能实现轮胎纵、横向力统一优化分配,而对轮胎垂向力的分配则大多采用划分经验工况、平均分配等人为解耦的方法,缺乏严谨的理论依据,不能实现最优的控制效果。
发明内容
为解决分布式电驱动车辆纵-横-垂向力协同控制问题,本发明旨在提出一种综合考虑了操纵稳定性目标和车身姿态目标,能够实现轮胎纵、横、垂向力统一优化分配的协同控制方法。
为实现上述目的,本发明建立的分布式电驱动车辆纵-横-垂向力协同控制方法,采用如下技术方案:一种分布式电驱动车辆纵-横-垂向力协同控制方法,其特征在于:在车辆控制***的控制下,完成如下操作:
1)根据车辆状态参数实时制定车辆期望合力与力矩;
2)综合考虑车辆行驶期望、轮胎附着极限和执行器特性,建立统一目标函数,并设计约束优化和可行域规划方法相结合的求解算法,将步骤1)中获得的期望合力优化分配为四轮最优纵、横、垂向力;
3)采用电机驱动、前后轮主动转向和主动悬架控制将步骤2)中分配好的力具体执行;
其中,所述步骤2)中,期望合力优化分配为四轮最优纵、横、垂向力的具体分配过程为:
a)首先在满足如下约束条件的集合的基础上,建立目标函数:
i)约束条件的集合为式(9)-(19):
Fx,des=Fxfl+Fxfr+Fxrl+Fxrr (9)
Fy,des=Fyfl+Fyfr+Fyrl+Fyrr (10)
Fz,des=mg=Fzft+Fzfr+Fzrl+Fzrr (11)
Mx,des=0.5tf(Fzfl-Fzfr)+0.5tr(Fzrl-Fzrr) (12)
My,des=-lf(Fzft+Fzfr)+lr(Fzrl+Fzrr) (13)
Mz,des=lf(Fyfl+Fyfr)-lr(Fyrl+Fyrr)+0.5tf(-Fxfl+Fxfr)+0.5tr(-Fxrl+Fxrr) (14)
|Fxi·r|≤Tmax (16)
Fzi≥0 (19)
其中,Fx,des表示期望纵向合力,Fx,des=max,des,m为整车质量,ax,des为期望纵向加速度,ax,des由加速踏板开度值α和纵向车速Vx,以及车辆自身的MAP图查表获得;
Fy,des表示期望横向合力,R为车辆预期转向半径,其中R0为道路曲率半径,l为车辆轴距,lf、lr为车辆前、后轴分别到质心的距离,L为预先设定的行驶长度,df、dr为车辆前、后轴中心与道路中心线的距离,
Fz,des表示期望垂向合力,Fz,des=mg,
Mx,des表示期望侧倾力矩,My,des表示期望俯仰力矩,Mz,des表示期望横摆力矩:
Kp1、Kp2、Kp3分别为PID方法中的比例参数,Ki1、Ki2、Ki3分别为PID方法中的积分参数,Kd1、Kd2、Kd3分别为PID方法中的微分参数,上述参数均根据仿真调试结果得到,s为Laplace算子,车身侧倾角期望值ρdes=0,车身俯仰角期望值θdsx=0,γdes为期望横摆角速度信息,结合车辆***反馈的前、后轮侧偏角目标值信息αf,des、αr,des制定,αf,des和αr,des初始值为零;
ρ为车身侧倾角信息,θ为车身俯仰角信息,γ为横摆角速度信息;
在(9)-(19)式中,记Fxfl、Fxfr、Fxrl、Fxrr分别为左前、右前、左后、右后轮纵向力,Fyfl、Fyfr、Fyrl、Fyrr分别为左前、右前、左后、右后轮横向力,Fzfl、Fzfr、Fzrl、Fzrr分别为左前、右前、左后、右后轮垂向力,tf、tr分别为前、后轴轮距,lf、lr分别为车辆前、后轴到质心的距离,m为整车质量,g为重力加速度,μi为各轮与路面附着系数;i={fl,fr,rl,rr)={左前,右前,左后,右后},以Fxi、Fyi、Fzi分别代表左前、右前、左后、右后轮的纵向力、横向力、垂向力;Tmax为电机的最大扭矩,为最大扭矩变化率;r为轮胎半径,Δt为变化时间间隔;
ii)在上述约束条件基础上,建立用于评价力分配效果的目标函数:
其中minJ即为优化目标函数,min表示取最小值,Var、E分别表示方差运算和平均值运算符号;w1、w2为权重系数,根据仿真调试结果在1~10数字范围内调节;变量γi表示各轮轮胎负荷率,变量εi表示各轮垂向力动态系数,其定义如下:
其中Fzi,0表示静载时左前、右前、左后、右后轮所受垂向力,按下式计算:
b)在约束条件和目标函数的基础上,设计优化求解算法,将制定的期望合力与力矩分配为各轮纵、横、垂向力最优值,设计优化求解算法包括以下两方面内容:
①采用障碍函数法和牛顿法的约束优化方法
将所述优化目标函数与所述约束条件改写为统一数学描述,并针对每个不等式约束引入松弛变量sk构造障碍函数项:
其中,x=[Fxi Fyi Fzi]T代表各轮纵、横、垂向力共12个变量组成的自变量向量,为最优解向量;f(x)=Var(γi)+w1·E(γi)+w2·Var(εi)代表式(19)所述目标函数;g、h分别代表所述约束条件中的等式约束和不等式约束的表达式;k、j分别对应第k个不等式约束和第j个等式约束;sk为对应于第k个不等式约束的松弛变量;μ为障碍函数的罚因子变量,其值为正且随着下述迭代过程的进行逐渐趋近于零;
写出式(23)的Lagrangian函数并对其应用约束优化问题的KKT条件,得到最优解应满足如下方程:
记z=(x,s,y,λ),z(k)=(x(k),s(k),y,λ),对(25)式使用Taylor近似,得到最优解迭代规则如下:
其中,λk和yj分别为函数gk(x)和hj(x)的Lagrange乘子,Jg表示函数 的Jacobian矩阵,Jh表示函数 的Jacobian矩阵, Λ=diag(λ1,...,λk);
采用(26)式不断更新自变量向量x的取值,可以使得式(23)中f(x)的取值不断变小并收敛至最小值;f(x)收敛至最小值时自变量向量x的取值即对应各轮纵、横、垂向力的最优解;
②基于车辆状态连续性的可行域规划方法,用下式表示:
规划过程如下:
记最优解向量为x=[Fxi Fyi Fzi]T,期望值向量E=(ax,des,ay,des,Mx,des,My,des,Mz,des)T,有:
xopt=f(E) (27)
由于车辆行驶过程中各项车辆状态参数均具有连续性,因此f和E都连续;结合数学推导和仿真调试得到相邻两次求解时间间隔△t内E的最大变化值ΔEm,记ΔEm=(|Δax,des|max,|Δay,des|max,|ΔMx,des|max,|ΔMy,des|max,|ΔMz,des|max)T;
设在t和t+Δt时刻,期望值向量取值分别为E(t)和E(t+Δt),各轮纵、横、垂向力最优解为xopt (t)和xopt (t+Δt),由于f(E)连续,则下式成立:
|xopt (t)-xopt (t+Δt)|=|f(E(t))-f(E(t+Δt))|≤ξ(ΔEm) (28)
其中ξ(ΔEm)为根据ΔEm确定的邻域半径,其值由仿真调试确定,由此得到:
xopt (t)-ξ(ΔEm)≤xopt (t+Δt)≤xopt (t)+ξ(ΔEm) (29)。
所述步骤3)中,力的具体执行过程为:
以所得的各个轮胎的纵、横、垂向力最优分配值为目标,通过电机驱动控制实现各个轮胎纵向力,通过主动前后轮转向电机控制实现各个轮胎横向力,通过主动悬架控制实现各个轮胎垂向力;其中,根据各个轮胎的横向力最优分配值制定前、后轮转向角目标值的方法如下:
首先采用基于Dugoff模型的解析式轮胎逆模型,将轮胎横、纵、垂向力最优分配值Fxi,des、Fyi,des、Fzi,des转化为轮胎侧偏角目标值αi,des:
其中Cλ为轮胎滑移刚度,Cα为轮胎侧偏刚度,μi为各轮与路面附着系数,D的定义如下:
再利用l、lf、lr、R,可得各轮期望转向角:
各个驱动电机的输出力矩Twi,des为:
Twi,desFxi,des·r (30)。
各个主动悬架输出的主动悬架力Fzi,A为:
其中,为各轮垂向力,其值根据普遍采用的载荷转移原则估计得到,is为轮胎垂向力传递至悬架时的机械增益常量,其值由车型参数得到。
所述车辆控制***为底盘一体化控制***,包括车辆状态参数获取单元、目标制定单元、力分配单元和执行单元;其中,所述车辆状态参数获取单元包括:一安装在车辆质心处的纵向车速传感器、一安装于车辆俯仰中心的车身俯仰角传感器、一安装于车辆侧倾中心的车身侧倾角传感器、一安装于车辆质心处的车辆纵向加速度传感器、一安装于车辆质心处的车辆横向加速度传感器、一安装于转向盘管柱的转向盘转角传感器、一安装于加速踏板处的加速踏板传感器、四个分别安装于四个独立驱动电机输出轴的电机转矩传感器、一安装于仪表面板处的GPS导航仪、两个分别安装于车辆前、后轴中心处的数字摄像头,以及安装于整车控制***中的信号处理模块;所述目标制定单元包括驾驶员意图识别单元和期望合力与力矩制定单元,根据车辆状态参数获取单元获得的车辆状态信息判断驾驶员意图并统一制定车辆纵、横、垂向运动所需的期望合力与力矩;所述力分配单元建立有目标函数和约束条件并设计优化算法,将目标制定单元制定的期望合力与力矩优化分配为各轮纵、横、垂向力;所述执行单元以实现力分配单元分配的各个轮胎的纵、横、垂向力为目标,实施电机驱动、前/后轮主动转向和主动悬架控制,包括四个独立安装在四个车轮处的驱动电机、两个独立安装的前轮转向电机和后轮转向电机、四个分别安装在车辆左前、右前、左后、右后的主动悬架力作动器。
本发明通过采取以上技术方案,可以实时解算力分配的最优解,无须根据不同工况对轮胎力实施不同控制策略,实现了轮胎纵、横、垂向力的统一优化分配与控制,综合改善了车辆操纵稳定性能和车辆行驶姿态,未来可用于实现车辆的无人驾驶。
附图说明
图1为本发明的***结构示意图。
具体实施方式
下面结合附图和实施例对本发明进行详细的描述。
如图1所示,为实现本发明所述的纵、横、垂向力的协同控制方法,本发明提供了一底盘一体化控制***,基于此***实现参数的采集、力的制定与分配,以及最终的执行。因此控制***主要由车辆状态参数获取单元1、目标制定单元2、力分配单元3和执行单元4组成。其中,车辆状态参数获取单元1通过传感器获得***所需的状态参数;目标制定单元2根据车辆状态参数获取单元1获得的车辆状态信息判断驾驶员意图并统一制定车辆纵、横、垂向运动所需的期望合力与力矩;力分配单元3建立目标函数和约束条件并设计优化算法,将目标制定单元2制定的期望合力与力矩优化分配为各轮纵、横、垂向力;执行单元4以实现力分配单元3分配的各个轮胎的纵、横、垂向力为目标,实施电机驱动、前/后轮主动转向和主动悬架控制。
车辆状态参数获取单元1具体包括:一安装在车辆质心处的纵向车速传感器10、一安装于车辆俯仰中心的车身俯仰角传感器11、一安装于车辆侧倾中心的车身侧倾角传感器12、一安装于车辆质心处的车辆纵向加速度传感器13、一安装于车辆质心处的车辆横向加速度传感器14、一安装于转向盘管柱的转向盘转角传感器15、一安装于加速踏板处的加速踏板传感器16、四个分别安装于四个独立驱动电机输出轴的电机转矩传感器17、一安装于仪表面板处的GPS导航仪18、两个分别安装于车辆前、后轴中心处的数字摄像头19,以及安装于整车控制***中的信号处理模块20。其中,GPS导航仪18提供道路中心线坐标信息和道路曲率半径信息;数字摄像头19采集包含车辆位置和道路中心线的图像信息;信号处理模块20利用滤波算法滤除各个加速度信息的噪声,利用图像处理算法分别获得车辆前、后轴中心处与道路中心线的距离信息。
目标制定单元2、力分配单元3和执行单元4都安装于整车控制***中,各自植有相应的算法,在车辆状态参数获取单元1提供的信息基础上,进行期望力和力矩的制定、分配以及控制执行。具体的办法如下:
1、期望合力与力矩的制定:
这项任务由目标制定单元2完成,目标制定单元2包括驾驶员意图识别单元21和期望合力与力矩制定单元22。
1)驾驶员意图识别单元21首先利用车辆状态参数获取单元1获得的加速踏板开度值α、纵向车速信息Vx,由车辆自身MAP图查表获得期望纵向加速度ax,des,一组α和Vx确定一个唯一的ax,des,因此用下述表示:
ax,des=f(α,Vx) (1)
2)再根据转向盘转角传感器15的信息,判断驾驶员的转向需求,利用已知车辆轴距信息l、预先设定的行驶长度信息L和从车辆状态参数获取单元1获取的道路曲率半径信息R0、车辆前后轴中心与道路中心线的距离信息df、dr,制定车辆预期转向半径R:
其中,lf、lr分别为前、后轴到质心的距离。
3)再结合下文执行单元4反馈的前一时刻前、后轮侧偏角目标值信息αf,des、αr,des和从车辆状态参数获取单元1获取的纵向车速信息vx,制定车辆期望横摆角速度γdes,其中αf,des和αr,des的初始值为零:
4)期望合力与力矩制定单元22利用已知整车质量信息m和驾驶员意图识别单元21制定的期望纵向加速度信息ax,des制定期望纵向合力Fx,des:
Fx,des=max,des (4)
5)再利用驾驶员意图识别单元21制定的车辆预期转向半径R和车辆状态参数获取单元1获取的纵向车速信息vx制定期望横向合力fy,ees:
6)然后采用PID方法利用车辆状态参数获取单元1获取的车辆纵向加速度信息ax、车身侧倾角信息ρ制定期望侧倾力矩Mx,des;利用车辆状态参数获取单元1获取的车辆横向加速度信息ay、车身俯仰角信息θ、纵向车速信息Vx制定期望俯仰力矩My,des利用驾驶员意图识别单元21制定的期望横摆角速度信息γdes和实际的横摆角速度信息γ,制定期望横摆力矩Mz,des。
其中,Kp1、Kp2、Kp3分别为PID方法中的比例参数,Ki1、Ki2、Ki3分别为PID方法中的积分参数,Kd1、Kd2、Kd3分别为PID方法中的微分参数,上述参数均根据仿真调试结果确定;s为Laplace算子;车身侧倾角期望值ρdes=0、车身俯仰角期望值θdes=0。
至此,期望纵向合力Fx,des、期望横向合力Fy,des、期望侧倾力矩Mx,des、期望俯仰力矩My,des、期望横摆力矩Mz,des都计算出来了。接下来就是如何分配的问题了。
2、力在四个车轮上的具体分配:
力分配单元3主要执行四轮纵、横、垂向力的优化分配,它利用目标制定单元2制定的期望合力与力矩以及车辆执行***特性建立约束条件,综合车辆操纵稳定性目标和车辆姿态目标建立目标函数,设计优化求解算法,将目标制定单元2制定的期望合力与力矩分配为各轮纵、横、垂向力最优值。具体包含以下特征:
1)建立约束条件
a)为实现目标制定单元2制定的期望合力与力矩,各轮的纵、横、垂向力以及力矩应满足如下约束条件:
Fx,des=Fxfl+Fxfr+Fxrl+Fxar (9)
Fy,des=Fyfl+Fyfr+Fyrj+Fyrr (10)
Fz,des=mg=Fzfl+Fzfr+Fzrl+Fzrr (11)
Mx,des=0.5tf(Fzfl-Fzfr)+0.5tr(Fzrx-Fzrr) (12)
My,des=-lf(FzflFzfr)+lr(Fzrl+Fzrr) (13)
Mz,des=lf(Fyfl+Frfr)-lr(Fyrl+Fyrr)+0.5tf(-Fxfl+Fxfr)+0.5tr(-Fxrl+Fxrr) (14)
其中Fxfl、Fxfr、Fxrl、fxrr分别为左前、右前、左后、右后轮纵向力,Fyfl\ 、Fyfr、Fyfl、Fyrr分别为左前、右前、左后、右后轮横向力,Fzfl、Fzfr、Fzrl、Fzrr分别为左前、右前、左后、右后轮垂向力,tf、tr分别为前、后轴轮距,lf、lr分别为前、后轴到质心的距离,m为整车质量,g为重力加速度。下文中记下标集合i={fl,fr,rl,rr}={左前,右前,左后,右后},以Fxi、Fyi、Fzi分别代表左前、右前、左后、右后轮的纵向力、横向力、垂向力。
b)进一步,各轮纵、横向力的合力不应超过各轮与路面附着系数μi完全利用时地面所能提供的最大力,因此还须满足如下约束:
μi为各轮与路面附着系数。
c)考虑到电机的最大扭矩Tmax限制和最大扭矩变化率限制,各轮纵向力还需满足如下约束,其中r为轮胎半径,Δt为变化时间间隔:
d)针对车辆前、后轮转向***的结构特性,通常认为转向过程中左、右侧车轮的侧偏角相等。在侧偏角较小时轮胎横向力与垂向力的关系可处理为线性关系,因此左、右侧车轮的横向力与垂向力还应满足如下约束:
e)除此之外,各轮垂向力均为非负值,应满足
Fzi≥0 (19)
以上a)-e)所述约束条件必须同时满足。
2)建立优化目标函数
在满足1)所述约束条件的前提下,为将单目标制定单元2制定的期望合力与力矩分配为各轮纵、横、垂向力的最优值,必须设计合理的优化目标函数对分配效果进行评价。针对现有研究中优化目标函数无法同时满足纵、横、垂向力优化分配的不足,本发明以四轮纵、横、垂向力共12个力为自变量,提出可同时优化轮胎纵、横、垂向力的优化目标函数,其形式如下:
其中min表示最小化。该目标函数的意义在于,通过使目标函数J取得最小值,得到各轮纵、横、垂向力的最优分配值。
其中Var、E分别表示方差运算和平均值运算符号;w1、w2为权重系数,根据仿真调试结果在1-10范围内调节;变量γi表示各轮轮胎负荷率,变量εi表示各轮垂向力动态系数,其定义如下:
其中Fzi,0表示静载时左前、右前、左后、右后轮所受垂向力,按下式计算:
3)优化求解算法
由1)所述约束条件和2)所述优化目标函数构成的以各轮纵、横、垂向力Fxi、Fyi、Fzi为变量的优化问题,包含(15)、(18)式所示非线性约束,且优化目标函数(20)式为非凸函数。因此本发明利用障碍函数法和牛顿法设计最优解迭代规则,结合基于车辆状态连续性的最优解搜索空间规划,求解各轮纵、横、垂向力最优解Fxi,des、Fyi,des、Fzi,des。
该求解算法的特征在于:
①采用障碍函数法和牛顿法的约束优化方法
将2)所述优化目标函数与1)所述约束条件构成的完整优化问题改写为统一数学描述,并针对每个不等式约束引入松弛变量sk构造障碍函数项,该优化问题转化为:
其中,x=[Fxi Fyi Fzi]T代表各轮纵、横、垂向力共12个变量组成的自变量向量,为最优解向量;f(x)=Var(γi)+w1·E(γi)+w2·Var(εi)代表(20)式所述目标函数;g、h分别代表1)所述约束条件中的等式约束和不等式约束的表达式;k、j分别对应第k个不等式约束和第j个等式约束;sk为对应于第k个不等式约束的松弛变量;μ为障碍函数的罚因子变量,其值为正且随着下述迭代过程的进行逐渐趋近于零。
写出该问题的Lagrangian函数并对其应用约束优化问题的KKT条件,得到最优解应满足如下方程:
记z=(x,s,y,λ),z(k)=(x(k),s(k),y,λ)。对(25)式使用Taylor近似,得到最优解迭代规则如下:
其中,λk和yj分别为函数gk(x)和hj(x)的Lagrange乘子,Jg表示函数 的Jacobian矩阵,Jh表示函数 的Jacobian矩阵, Λ=diag(λ1,...,λk)。
采用(26)式不断更新自变量向量x的取值,可以使得式(23)中f(x)的取值不断变小并收敛至最小值;f(x)收敛至最小值时自变量向量x的取值即对应各轮纵、横、垂向力的最优解。
②基于车辆状态连续性的可行域规划方法
各轮纵、横、垂向力最优解随期望纵向加速度、期望横向加速度、期望横摆力矩、期望侧倾力矩及期望俯仰力矩的变化而变化,可认为二者具有函数关系。记最优解向量为x=[Fxi Fyi Fzi]T,期望值向量E=(ax,des,ay,des,Mx,des,My,des,Mz,des)T,有:
xopt=f(E) (27)
由于车辆行驶过程中各项车辆状态参数均具有连续性,因此f和E都连续。结合数学推导和仿真调试得到相邻两次求解时间间隔Δt内E的最大变化值ΔEm,记为ΔEm=(|Δax,des|max,|Δay,des|max,|ΔMx,des|max,|ΔMy,des|max,|ΔMz,des|max)T。设在t和t+Δt时刻,期望值向量取值分别为E(t)和E(t+Δt),各轮纵、横、垂向力最优解为xopt (t)和xopt (t+Δt)。由于f(E)连续,则下式成立:
|xopt (t)-xopt (t+Δt)|=|f(E(t))-f(E(t+Δt))|≤ξ(ΔEm) (28)
其中ξ(ΔEm)为根据ΔEm确定的邻域半径,其值由仿真调试确定。至此,得到由前一时刻最优解限定的当前时刻最优解搜索空间:
xopt (t)-ξ(ΔEm)≤xopt (t+Δt)≤xopt (t)+ξ(ΔEm) (29)
将(29)式作为新增约束条件加入1)描述的约束条件中,通过将自变量向量x的搜索空间限定在前一时刻最优解附近,就解决了(17)式所述变化率限制问题,避免因轮胎力最优分配值突变超过执行器性能限制而无法实际执行,获得了符合实际应用情况的最优解。作为补充,轮胎纵、横、垂向力的初始值按照期望合力与力矩在各轮间平均分配原则制定,以保证迭代开始阶段的收敛性。
至此,本发明考虑了1)所述全部约束条件,设计了(20)式所示的力分配优化目标函数,通过基于车辆状态连续性的最优解搜索空间规划和利用障碍函数法及牛顿法的迭代求解,使(20)式所示目标函数值达到最小值,求得满足实际应用的轮胎纵、横、垂向力最优分配。
3、力的执行
执行单元4以力分配单元3所得各个轮胎的纵、横、垂向力最优分配值为目标,实施电机驱动、主动前后轮转向及主动悬架控制。其中,分别安装于四个车轮处的驱动电机41通过输出相应的电机转矩获得各个目标轮胎纵向力,分别安装的前轮转向电机42和后轮转向电机43通过输出相应的转向力矩获得目标前轮转向角和目标后轮转向角,分别安装在车辆左前、右前、左后、右后四个部位的主动悬架力作动器44通过产生相应的主动悬架力获得各个目标轮胎垂向载荷。
各个驱动电机的输出力矩Twi,des为:
Twi,des=Fxi,des·r (30)
各个主动悬架输出的主动悬架力Fzi,A为:
其中,为各轮垂向力,其值根据普遍采用的载荷转移原则估计得到;is为轮胎垂向力传递至悬架时的机械增益常量,其值由车型参数得到。
前轮转向角和后轮转向角制定方法如下:
首先采用基于Dugoff模型的解析式轮胎逆模型,将轮胎横、纵、垂向力最优分配值Fxi,des、Fyi,des、Fzi,des转化为轮胎侧偏角目标值αi,des:
其中Cλ为轮胎滑移刚度,Cα为轮胎侧偏刚度,μi为各轮与路面附着系数,D的定义如下:
再利用(2)式所得预期转向半径R可得各轮期望转向角:
Claims (5)
1.一种分布式电驱动车辆纵-横-垂向力协同控制方法,其特征在于:在车辆控制***的控制下,完成如下操作:
1)根据车辆状态参数实时制定车辆期望合力与力矩;
2)综合考虑车辆行驶期望、轮胎附着极限和执行器特性,建立统一目标函数,并设计约束优化和可行域规划方法相结合的求解算法,将步骤1)中获得的期望合力优化分配为四轮最优纵、横、垂向力;
3)采用电机驱动、前后轮主动转向和主动悬架控制将步骤2)中分配好的力具体执行;
其中,所述步骤2)中,期望合力优化分配为四轮最优纵、横、垂向力的具体分配过程为:
a)首先在满足如下约束条件的集合的基础上,建立目标函数:
i)约束条件的集合为式(9)-(19):
Fx,des=Fxfl+Fxfr+Fxrl+Fxrr (9)
Fy,des=Fyfl+Fyfr+Fyrl+Fyrr (10)
Fz,des=mg=Fzfl+Fzfr+Fzrl+Fzrr (11)
Mx,des=0.5tf(Fzfl-Fzfr)+0.5tr(Fzrl-Fzrr) (12)
My,des=-lf(Fzfl+Fzfr)+lr(Fzrl+Fzrr) (13)
Mz,des=lf(Fyfl+Fyfr)-lr(Fyrl+Fyrr)+0.5tf(-Fxfl+Fxfr)+0.5tr(-Fxrl+Fxrr) (14)
|Fxi·r|≤Tmax (16)
Fzi≥0 (19)
其中,Fx,des表示期望纵向合力,Fx,des=max,des,m为整车质量,ax,des为期望纵向加速度,ax,des由加速踏板开度值α和纵向车速Vx,以及车辆自身的MAP图查表获得;
Fy,des表示期望横向合力,R为车辆预期转向半径,其中R0为道路曲率半径,l为车辆轴距,lf、lr为车辆前、后轴分别到质心的距离,L为预先设定的行驶长度,df、dr为车辆前、后轴中心与道路中心线的距离,
Fz,des表示期望垂向合力,Fz,des=mg,
Mx,des表示期望侧倾力矩,My,des表示期望俯仰力矩,Mz,des表示期望横摆力矩:
Kp1、Kp2、Kp3分别为PID方法中的比例参数,Ki1、Ki2、Ki3分别为PID方法中的积分参数,Kd1、Kd2、Kd3分别为PID方法中的微分参数,上述参数均根据仿真调试结果得到,s为Laplace算子,车身侧倾角期望值ρdes=0,车身俯仰角期望值θdes=0,γdes为期望横摆角速度信息,结合车辆***反馈的前、后轮侧偏角目标值信息αf,des、αr,des制定,αf,des和αr,des初始值为零;ρ为车身侧倾角信息,θ为车身俯仰角信息,γ为横摆角速度信息;
在(9)-(19)式中,记Fxfl、Fxrl Fxrr分别为左前、右前、左后、右后轮纵向力,Fyfl、Fyrl Fyrr分别为左前、右前、左后、右后轮横向力,Fzfl、Fzrl Fzrr分别为左前、右前、左后、右后轮垂向力,tf、tr分别为前、后轴轮距,lf、lr分别为车辆前、后轴到质心的距离,m为整车质量,g为重力加速度,μi为各轮与路面附着系数;以Fxi、Fzi分别代表左前、右前、左后、右后轮的纵向力、横向力、垂向力;Tmax为电机的最大扭矩,为最大扭矩变化率;r为轮胎半径,Δt为变化时间间隔;
ii)在上述约束条件基础上,建立用于评价力分配效果的目标函数:
其中minJ即为优化目标函数,min表示取最小值,Var、E分别表示方差运算和平均值运算符号;w1、w2为权重系数,根据仿真调试结果在1~10数字范围内调节;变量γi表示各轮轮胎负荷率,变量εi表示各轮垂向力动态系数,其定义如下:
其中Fzi,0表示静载时左前、右前、左后、右后轮所受垂向力,按下式计算:
b)在约束条件和目标函数的基础上,设计优化求解算法,将制定的期望合力与力矩分配为各轮纵、横、垂向力最优值,设计优化求解算法包括以下两方面内容:
①采用障碍函数法和牛顿法的约束优化方法
将所述优化目标函数与所述约束条件改写为统一数学描述,并针对每个不等式约束引入松弛变量sk构造障碍函数项:
s.t.gk(x)+sk=0 (23)
hj(x)=0
其中,x=[Fxi Fyi Fzi]T代表各轮纵、横、垂向力共12个变量组成的自变量向量,为最优解向量;f(x)=Var(γi)+w1·E(γi)+w2·Var(εi)代表式(19)所述目标函数;g、h分别代表所述约束条件中的等式约束和不等式约束的表达式;k、j分别对应第k个不等式约束和第j个等式约束;sk为对应于第k个不等式约束的松弛变量;μ为障碍函数的罚因子变量,其值为正且随着下述迭代过程的进行逐渐趋近于零;
写出式(23)的Lagrangian函数并对其应用约束优化问题的KKT条件,得到最优解应满足如下方程:
记z=(x,s,y,λ),z(k)=(x(k),s(k),y,λ),对(25)式使用Taylor近似,得到最优解迭代规则如下:
其中,λk和yj分别为函数gk(x)和hj(x)的Lagrange乘子,Jg表示函数 的Jacobian矩阵,Jh表示函数 的Jacobian矩阵, Λ=diag(λ1,...,λk);
采用(26)式不断更新自变量向量x的取值,可以使得式(23)中f(x)的取值不断变小并收敛至最小值;f(x)收敛至最小值时自变量向量x的取值即对应各轮纵、横、垂向力的最优解;
②基于车辆状态连续性的可行域规划方法,用下式表示:
xopt (t)-ξ(ΔEm)≤xopt (t+Δt)≤xopt (t)+ξ(ΔEm) (29)
规划过程如下:
记最优解向量为x=[Fxi Fyi Fzi]T,期望值向量E=(ax,des,ay,des,Mx,des,My,des,Mz,des)T,有:
xopt=f(E) (27)
由于车辆行驶过程中各项车辆状态参数均具有连续性,因此f和E都连续;结合数学推导和仿真调试得到相邻两次求解时间间隔△t内E的最大变化值△Em,记ΔEm=(|Δax,des|max,|Δay,des|max,|ΔMx,des|max,|ΔMy,des|max,|ΔMz,des|max)T;
设在t和t+Δt时刻,期望值向量取值分别为E(t)和E(t+Δt),各轮纵、横、垂向力最优解为xopt (t)和xopt (t+Δt),由于f(E)连续,则下式成立:
|xopt (t)-xopt (t+Δt)|=|f(E(t))-f(E(t+Δt))|≤ξ(ΔEm) (28)
其中ξ(ΔEm)为根据ΔEm确定的邻域半径,其值由仿真调试确定,由此得到:
xopt (t)-ξ(ΔEm)≤xopt (t+Δt)≤xopt (t)+ξ(ΔEm) (29)。
2.根据权利要求1所述的分布式电驱动车辆纵-横-垂向力协同控制方法,其特征在于:所述步骤3)中,力的具体执行过程为:
以所得的各个轮胎的纵、横、垂向力最优分配值为目标,通过电机驱动控制实现各个轮胎纵向力,通过主动前后轮转向电机控制实现各个轮胎横向力,通过主动悬架控制实现各个轮胎垂向力;其中,根据各个轮胎的横向力最优分配值制定前、后轮转向角目标值的方法如下:
首先采用基于Dugoff模型的解析式轮胎逆模型,将轮胎横、纵、垂向力最优分配值Fxi,des、Fzi,des转化为轮胎侧偏角目标值αi,des:
其中Cλ为轮胎滑移刚度,Cα为轮胎侧偏刚度,μi为各轮与路面附着系数,D的定义如下:
再利用l、lf、lr、R,可得各轮期望转向角:
3.根据权利要求2所述的分布式电驱动车辆纵-横-垂向力协同控制方法,其特征在于:
步骤3)中各个驱动电机的输出力矩Twi,des为:
Twi,des=Fxi,des·r (30)。
4.根据权利要求2或3所述的分布式电驱动车辆纵-横-垂向力协同控制方法,其特征在于:
各个主动悬架输出的主动悬架力Fzi,A为:
其中,为各轮垂向力,其值根据普遍采用的载荷转移原则估计得到,is为轮胎垂向力传递至悬架时的机械增益常量,其值由车型参数得到。
5.根据权利要求1所述的分布式电驱动车辆纵-横-垂向力协同控制方法,其特征在于:所述车辆控制***为底盘一体化控制***,包括车辆状态参数获取单元、目标制定单元、力分配单元和执行单元;其中,
所述车辆状态参数获取单元包括:一安装在车辆质心处的纵向车速传感器、一安装于车辆俯仰中心的车身俯仰角传感器、一安装于车辆侧倾中心的车身侧倾角传感器、一安装于车辆质心处的车辆纵向加速度传感器、一安装于车辆质心处的车辆横向加速度传感器、一安装于转向盘管柱的转向盘转角传感器、一安装于加速踏板处的加速踏板传感器、四个分别安装于四个独立驱动电机输出轴的电机转矩传感器、一安装于仪表面板处的GPS导航仪、两个分别安装于车辆前、后轴中心处的数字摄像头,以及安装于整车控制***中的信号处理模块;
所述目标制定单元包括驾驶员意图识别单元和期望合力与力矩制定单元,根据车辆状态参数获取单元获得的车辆状态信息判断驾驶员意图并统一制定车辆纵、横、垂向运动所需的期望合力与力矩;
所述力分配单元建立有目标函数和约束条件并设计优化算法,将目标制定单元制定的期望合力与力矩优化分配为各轮纵、横、垂向力;
所述执行单元以实现力分配单元分配的各个轮胎的纵、横、垂向力为目标,实施电机驱动、前/后轮主动转向和主动悬架控制,包括四个独立安装在四个车轮处的驱动电机、两个独立安装的前轮转向电机和后轮转向电机、四个分别安装在车辆左前、右前、左后、右后的主动悬架力作动器。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310413708.5A CN103448716B (zh) | 2013-09-12 | 2013-09-12 | 分布式电驱动车辆纵-横-垂向力协同控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310413708.5A CN103448716B (zh) | 2013-09-12 | 2013-09-12 | 分布式电驱动车辆纵-横-垂向力协同控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103448716A CN103448716A (zh) | 2013-12-18 |
CN103448716B true CN103448716B (zh) | 2015-10-07 |
Family
ID=49731680
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310413708.5A Active CN103448716B (zh) | 2013-09-12 | 2013-09-12 | 分布式电驱动车辆纵-横-垂向力协同控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103448716B (zh) |
Families Citing this family (22)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103909933B (zh) * | 2014-03-27 | 2016-04-06 | 清华大学 | 一种分布式电驱动车辆的前轮侧向力估算方法 |
CN104859650B (zh) * | 2015-05-28 | 2017-04-05 | 吉林大学 | 一种多时间尺度的车辆横摆稳定性滚动优化控制方法 |
CN104925054B (zh) * | 2015-07-23 | 2017-04-19 | 吉林大学 | 一种基于微分平坦的车辆稳定转向集成控制方法 |
CN106647256B (zh) * | 2016-10-08 | 2021-04-06 | 西南交通大学 | 一种基于h∞ pid的主动悬架控制***及控制方法 |
CN106649983B (zh) * | 2016-11-09 | 2019-11-08 | 吉林大学 | 用于无人驾驶车辆高速运动规划的车辆动力学模型建模方法 |
CN106527139B (zh) * | 2016-11-29 | 2019-07-26 | 桂林航天工业学院 | 通信受限情况下的车辆横摆运动鲁棒控制器设计方法 |
CN108237950B (zh) * | 2016-12-26 | 2020-06-16 | 北汽福田汽车股份有限公司 | 车辆的控制方法、***及车辆 |
CN107472082B (zh) * | 2017-07-20 | 2019-12-10 | 北京长城华冠汽车科技股份有限公司 | 四驱电动汽车的驱动力矩分配方法、***及电动汽车 |
CN107589434A (zh) * | 2017-08-23 | 2018-01-16 | 西安中阔卫星技术应用有限责任公司 | 一种自动获取并记录实际道路标线gps坐标的装置和方法 |
CN107804315B (zh) * | 2017-11-07 | 2019-07-16 | 吉林大学 | 一种考虑驾驶权实时分配的人车协同转向控制方法 |
CN108238045B (zh) * | 2017-12-27 | 2020-09-04 | 北京车和家信息技术有限公司 | 一种车辆控制方法及车辆 |
CN108327714B (zh) * | 2018-02-02 | 2019-12-20 | 清华大学 | 具有主动姿态调节能力的分布式独立驱动车辆控制*** |
CN109204317B (zh) * | 2018-07-24 | 2020-05-22 | 吉林大学 | 轮毂驱动电动汽车纵、横和垂向力集成控制优化方法 |
US10739768B2 (en) * | 2018-08-08 | 2020-08-11 | Toyota Motor Engineering & Manufacturing North America, Inc. | Smoothed and regularized Fischer-Burmeister solver for embedded real-time constrained optimal control problems in autonomous systems |
CN110723207B (zh) * | 2019-09-23 | 2021-08-03 | 江苏大学 | 基于模型重构的智能汽车模型预测转向控制器及其控制方法 |
CN111325975B (zh) * | 2020-02-19 | 2021-06-22 | 南京航空航天大学 | 一种智能网联车辆在汇入口区域的集中优化协调方法 |
CN111752150B (zh) * | 2020-06-12 | 2021-07-16 | 北京理工大学 | 一种轮足机器人四轮协同控制方法 |
CN111959486B (zh) * | 2020-07-01 | 2021-11-09 | 武汉理工大学 | 电机驱动车辆纵横向耦合控制方法、***及存储介质 |
JP7272330B2 (ja) | 2020-07-22 | 2023-05-12 | トヨタ自動車株式会社 | 車両制御装置 |
CN112477853B (zh) * | 2020-11-11 | 2022-06-28 | 南京航空航天大学 | 一种装备非充气车轮的车辆纵-垂集成控制***及方法 |
CN112659921B (zh) * | 2020-12-14 | 2022-11-22 | 北京航空航天大学 | 一种基于遗传算法的独立驱动电动车优化控制器设计方法 |
CN112668093A (zh) * | 2020-12-21 | 2021-04-16 | 西南交通大学 | 一种分布式驱动汽车全轮纵向力最优分配控制方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008222139A (ja) * | 2007-03-15 | 2008-09-25 | Honda Motor Co Ltd | 車両のヨーモーメント制御装置 |
JP2009202770A (ja) * | 2008-02-28 | 2009-09-10 | Nissan Motor Co Ltd | 車両の走行姿勢制御装置及び走行姿勢制御方法 |
CN102275528A (zh) * | 2011-06-03 | 2011-12-14 | 清华大学 | 一种分布式驱动电动汽车的驱动力矩协调控制***及方法 |
CN103245610A (zh) * | 2013-05-17 | 2013-08-14 | 清华大学 | 一种分布式驱动电动汽车的路面峰值附着系数估算方法 |
CN103419777A (zh) * | 2012-07-11 | 2013-12-04 | 上海理工大学 | 一种改善车道跟踪与操控稳定性能的设计方法 |
-
2013
- 2013-09-12 CN CN201310413708.5A patent/CN103448716B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008222139A (ja) * | 2007-03-15 | 2008-09-25 | Honda Motor Co Ltd | 車両のヨーモーメント制御装置 |
JP2009202770A (ja) * | 2008-02-28 | 2009-09-10 | Nissan Motor Co Ltd | 車両の走行姿勢制御装置及び走行姿勢制御方法 |
CN102275528A (zh) * | 2011-06-03 | 2011-12-14 | 清华大学 | 一种分布式驱动电动汽车的驱动力矩协调控制***及方法 |
CN103419777A (zh) * | 2012-07-11 | 2013-12-04 | 上海理工大学 | 一种改善车道跟踪与操控稳定性能的设计方法 |
CN103245610A (zh) * | 2013-05-17 | 2013-08-14 | 清华大学 | 一种分布式驱动电动汽车的路面峰值附着系数估算方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103448716A (zh) | 2013-12-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103448716B (zh) | 分布式电驱动车辆纵-横-垂向力协同控制方法 | |
CN109522666B (zh) | 一种分布式电动汽车稳定性控制方法 | |
De Novellis et al. | Wheel torque distribution criteria for electric vehicles with torque-vectoring differentials | |
CN107719372B (zh) | 基于动态控制分配的四驱电动汽车动力学多目标控制*** | |
Ni et al. | Robust control in diagonal move steer mode and experiment on an X-by-wire UGV | |
CN110254405B (zh) | 一种面向自动驾驶与智能辅助驾驶的汽车线控制动控制***及其控制方法 | |
Zhao et al. | Integrated control of in-wheel motor electric vehicles using a triple-step nonlinear method | |
Kim et al. | Vehicle stability enhancement of four-wheel-drive hybrid electric vehicle using rear motor control | |
Alipour et al. | Lateral stabilization of a four wheel independent drive electric vehicle on slippery roads | |
De Novellis et al. | Torque vectoring for electric vehicles with individually controlled motors: State-of-the-art and future developments | |
CN105936273B (zh) | 车用主动转矩轮间、轴间分配方法 | |
CN103921786B (zh) | 一种电动车辆再生制动过程的非线性模型预测控制方法 | |
Li et al. | Side-slip angle estimation based lateral dynamics control for omni-directional vehicles with optimal steering angle and traction/brake torque distribution | |
Ni et al. | Control-configured-vehicle design and implementation on an X-by-wire electric vehicle | |
CN104443022A (zh) | 一种四轮独立驱动电动汽车稳定性控制方法及*** | |
Kim et al. | Optimal brake torque distribution for a four-wheeldrive hybrid electric vehicle stability enhancement | |
Tian et al. | Integrated control with DYC and DSS for 4WID electric vehicles | |
Lv et al. | Directional-stability-aware brake blending control synthesis for over-actuated electric vehicles during straight-line deceleration | |
Mashadi et al. | Integrated AFS/DYC sliding mode controller for a hybrid electric vehicle | |
CN112668093A (zh) | 一种分布式驱动汽车全轮纵向力最优分配控制方法 | |
Velenis | FWD vehicle drifting control: The handbrake-cornering technique | |
Song et al. | Chassis integrated control for 4WIS distributed drive EVs with model predictive control based on the UKF observer | |
Vantsevich et al. | Relaxation length review and time constant analysis for agile tire dynamics control | |
Kanchwala et al. | Control of an independent 4WD electric vehicle by DYC method | |
Xiong et al. | Control allocation of vehicle dynamics control for a 4 in-wheel-motored EV |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |