CN111497867B - 考虑驾驶员转向特性的线控转向***容错策略 - Google Patents

考虑驾驶员转向特性的线控转向***容错策略 Download PDF

Info

Publication number
CN111497867B
CN111497867B CN202010265087.0A CN202010265087A CN111497867B CN 111497867 B CN111497867 B CN 111497867B CN 202010265087 A CN202010265087 A CN 202010265087A CN 111497867 B CN111497867 B CN 111497867B
Authority
CN
China
Prior art keywords
steering
motor
fault
vehicle
driver
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
CN202010265087.0A
Other languages
English (en)
Other versions
CN111497867A (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.)
Nanjing University of Aeronautics and Astronautics
Original Assignee
Nanjing University of Aeronautics and Astronautics
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 Nanjing University of Aeronautics and Astronautics filed Critical Nanjing University of Aeronautics and Astronautics
Priority to CN202010265087.0A priority Critical patent/CN111497867B/zh
Publication of CN111497867A publication Critical patent/CN111497867A/zh
Application granted granted Critical
Publication of CN111497867B publication Critical patent/CN111497867B/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
    • 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
    • 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/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F30/00Computer-aided design [CAD]
    • G06F30/20Design optimisation, verification or simulation
    • 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/0029Mathematical model of the driver
    • 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/0031Mathematical model of the vehicle

Landscapes

  • Engineering & Computer Science (AREA)
  • Theoretical Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Transportation (AREA)
  • Automation & Control Theory (AREA)
  • Evolutionary Computation (AREA)
  • General Physics & Mathematics (AREA)
  • General Engineering & Computer Science (AREA)
  • Geometry (AREA)
  • Computer Hardware Design (AREA)
  • Human Computer Interaction (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)
  • Power Steering Mechanism (AREA)

Abstract

本发明提供了一种考虑驾驶员转向特性的线控转向***容错策略,基于线控转向***,针对三种不同驾驶员提出了一种个性化的容错控制策略。它由一个故障检测和诊断控制器和一个性化容错控制器组成。故障检测和诊断控制器由干扰观测器和遗忘因子递推最小二乘算法组成,实时检测并估算执行器的状态和参数,并将与电机有关的状态或部分损坏的程度反馈给ECU。ECU发出容错命令后,将打开个性化容错控制器,以处理故障电机对不同驾驶员的影响。个性化容错控制策略可以在转向电机发生故障时,辅助驾驶员较好的跟踪参考路径,大大降低电机故障给驾驶员带来的生理和心理负担。

Description

考虑驾驶员转向特性的线控转向***容错策略
技术领域
本发明涉及辅助驾驶***领域,具体是一种考虑驾驶员转向特性的线控转向***容错策略。
背景技术
线控转向***作为未来智能驾驶的重要平台,日益凸显其重要的地位。如今关于线控转向***的研究主要着重集中在提高***的性能方面,很少有人关注车辆转向过程中驾驶员的驾驶状态,主要包括生理负担和心理负担。
发明内容
本发明为了解决现有技术的问题,提供了一种考虑驾驶员转向特性的线控转向***容错策略,在转向电机发生故障时,辅助驾驶员较好的跟踪参考路径,大大降低电机故障给驾驶员带来的生理和心理负担。
本发明采用的装置由一个故障检测和诊断控制器和一个性化容错控制器组成。故障检测和诊断控制器由干扰观测器和遗忘因子递推最小二乘算法组成,实时检测并估算执行器的状态和参数,并将与电机有关的状态或部分损坏的程度反馈给ECU。ECU发出容错命令后,将打开个性化容错控制器,以处理故障电机对不同驾驶员的影响。
具体容错策略包括以下步骤:
1)人-车-转向***模型的建立:
1.1)驾驶员转向模型:
假设线控转向***的转向传动比是Rg,θfd=θsw/Rg是驾驶员输入的前轮转角,在零初始条件下可以得到:
Figure BDA0002440968920000011
其中:θsw(s)是驾驶员的转向盘转角;Gh是转向比例增益;τL是微分时间常数;τd1是纯延迟时间;τd2是驾驶员反应的延迟时间,
Figure BDA0002440968920000012
代表着预瞄点的理想侧向位移;τp是预瞄时间;Y(s)和φ(s)是车辆当前的侧向位移和偏航角;L是驾驶员的预瞄距离,vx是车辆纵向车速;
1.2)车辆***运动学和动力学模型
假设车辆在大地平面上的质心位置是(X,Y),车辆***的动力学和运动学关系可以推导如下:
Figure BDA0002440968920000021
其中:φ是车辆的偏航角:β是车辆的的质心侧偏角;ωr是车辆的横摆角速度;V是车辆的实际速度;Vx是车辆的横向速度;Vy车辆的纵向速度;m是汽车的质量;k1是前轮刚度;k2后轮刚度;Iz是车辆的横摆惯性矩;a是车辆的前轴轴距;b是车辆的后轴轴距;δf是车辆的前轮转角;d1和d2代表着模型误差;
1.3)线控***动力学模型:
作为线控***,转向执行器模块中转向扭矩从两个转向电机传输到前轮转角,这个过程涉及两个直流电机,两个减速器,两个转向管柱,一个齿轮齿条机构,线控子***的动力学模型如下:
Figure BDA0002440968920000022
其中:θs是总的小齿轮转角;BR是等效阻尼系数;JR等效惯性矩;G2小齿轮到车轮的减速比;G1是减速比;η是减速器的效率;dr是路面干扰;τR是回正力矩;tp,tm是轮胎的拖距;T是双电机总的输出扭矩;Xr是齿条位移;rp是小齿轮半径;
2)用以下公式表述转向电机的故障情况:
ui=λiudi+Δui(i=fl,fr) (4)
其中i=fl,fr代表左右两个转向电机;udi是理想的电机输出扭矩和ui是实际的电机输出扭矩;λi∈[0,1]代表着失效系数;Δui代表着增加的故障;
从公式(4)可知:当λi=0和Δui=0时,转向电机无故障;
电机故障情况可以用ui=λiudi+Δu或者ui=λiudi建模表示,其中λi∈(0,1),λi的值代表着电机故障的损坏程度;
定义:λavei=(λi maxi min)/2 (5)
Figure BDA0002440968920000023
其中λi maxi min是λi的最大值和最小值;
λi可以被描述如下:
Figure BDA0002440968920000031
其中Ni是时变变量;
定义u=[Tm1,Tm2];udi=[Tmd1,Tmd2];Δu=[Δum1,Δum2]有利于公式的简化和推导,其中Tm1,Tm2是转向电机的实际输出扭矩;Tmd1 Tmd2是转向电机理想状态下的输出扭矩;Δum1,Δum2代表着转向电机增加的故障;
可以得到:u=λudi+Δu(8)
把公式(7)带入公式(8),可以得到:
Figure BDA0002440968920000032
其中
Figure BDA0002440968920000033
根据公式(9),可以进一步写成如下:
Figure BDA0002440968920000034
其中
Figure BDA0002440968920000035
Figure BDA0002440968920000036
是相应的估计的效率损失系数和附加的故障;
定义转向电机估计的输出扭矩
Figure BDA0002440968920000037
如下:
Figure BDA0002440968920000038
其中
Figure BDA0002440968920000039
是干扰观测器提供的估电机转矩;
考虑到估计值和真实值来自于车辆不确定性的误差,将公式(10)和(11)进一步描述如下:
Figure BDA00024409689200000310
其中dobsi是真实的电机扭矩,
Figure BDA00024409689200000311
是干扰观测器估计出的增加的电机故障扭矩;ρ∈[1,1.08]是估计结果的影响范围,由汽车质量的不确定性构成;
把公式(12)带入公式(10),可以推导如下:
Figure BDA00024409689200000312
故障检测和诊断控制器由干扰观测器和遗忘因子递推最小二乘算法组成,用来估计实际电机的扭矩,损失效率λ和增加的故障Δu,干扰观测器用来估计电机的扭矩和状态;遗忘因子递推最小二乘算法被用来去估计电机的损失效率和增加的故障;
根据公式(3),可以得到
Figure BDA00024409689200000313
根据公式(3)和(14),线控转向***可以推导为
Figure BDA0002440968920000041
其中:
Figure BDA0002440968920000042
dobsi=u是干扰观测输入,F是干扰输入矩阵,xobs是观测的车辆状态;
f(x,σ)=[f1(x,σ) f2(x,σ) f3(x,σ)]T
(16)
Figure BDA0002440968920000043
Figure BDA0002440968920000044
Figure BDA0002440968920000045
Figure BDA0002440968920000046
估计的干扰值
Figure BDA0002440968920000047
通过以下观测器获得:
Figure BDA0002440968920000048
其中F+是F的广义逆,
Figure BDA0002440968920000049
基于干扰观测器估计的电机的输出扭矩,遗忘因子递推最小二乘算法被使用去估计电机的失效系数λ;
根据公式(12)和公式(13),可以得到:
Figure BDA00024409689200000410
其中φi(k)=[udi 1]T,
Figure BDA00024409689200000411
Figure BDA00024409689200000412
是需要估计的状态向量;
定义性能指标为:
Figure BDA00024409689200000413
其中:t是遗忘因子(0.95<=t<=1),y(k)是参考值;
根据公式(22)和公式(23),估计的带有遗忘因子的递推最小二乘算法可以被推导为:
Figure BDA0002440968920000051
3)通过对无故障电机进行扭矩补偿来减少转向盘转角跟踪误差,并提供个性化的容错控制:
3.1)转向盘转角的跟踪误差可以定义如下:
θswe=θswdsw (25)
其中:θswd是参考的转向盘转角,θsw是实际的转向盘转角;
3.2)在稳定状态,横摆角速度ωr *是固定值,所需的前轮转角δf到横摆角速度的响应是:
Figure BDA0002440968920000052
结合公式(25)和公式(26),可以得到:
Figure BDA0002440968920000053
其中
Figure BDA0002440968920000054
是由于转向盘转角跟踪误差导致的车辆横摆角速度补偿值;
3.3)设定控制***的状态变量是
Figure BDA0002440968920000055
控制输出是u=[ΔT],测量输出是y1=[ωr],y2=[ΔT],基于主动前轮转向的横摆角速度补偿控制的状态空间可以实现如下:
Figure BDA0002440968920000056
Figure BDA0002440968920000057
Figure BDA0002440968920000058
其中:Δθs是补偿的小齿轮转角和ΔT是正常电机的补偿扭矩由于横摆角速度补偿控制;
4)对***中存在的不确定性进行相应的处理:
线控***的乘法权函数需要满足以下要求:
Figure BDA0002440968920000061
根据公式(17),前轮刚度k1的刚度不确定范围是15%,后轮刚度k2的刚度不确定性范围是10%,并且车速的不确定性范围是10%,对G(s),Gfr(s)乘法加权函数进行求解,Wp是性能权重函数;因此,加权函数矩阵被选取为:
Figure BDA0002440968920000062
5)利用结构奇异值μ分析***鲁棒性。μ控制器的设计是为了在给定条件内最小化μ值,利用间接的D-K迭代算法考虑H和μ分析被引入区求解,采用MATLAB进行μ控制算法的实现。
本发明有益效果在于:
1、可以在转向电机发生故障时,辅助驾驶员较好的跟踪参考路径,大大降低电机故障给驾驶员带来的生理和心理负担。
2、控制器可以通过人车协作和容错补偿的方法为不同的驾驶员提供适当的辅助控制,从而应对复杂的执行器状况,大大提高了人车***的容错性能,提高了***的安全性,并具有个性化特征,具有广阔的发展前景和应用价值。
附图说明
图1为容错控制原理图。
图2为μ控制器设计框图。
图3为D-K迭代算法原理图。
图4(a)为故障检测和诊断的仿真结果中电机扭矩估计。
图4(b)为故障检测和诊断的仿真结果中失效系数估计。
图4(c)为故障检测和诊断的仿真结果中增加的故障估计。
图5(a)为仿真结果采用个性化容错控制器当λ=75%。
图5(b)为仿真结果采用个性化容错控制器当λ=50%。
具体实施方式
下面结合附图对本发明作进一步说明。
本发明容错控制原理图如图1所示,描述了故障检测与诊断控制器的设计在此基础上进行了容错控制器的设计。首先根据故障检测与诊断控制器被使用去估计转向电机的实际扭矩,基于扭矩估计结果在线确定失效系数和附加故障。然后,根据故障检测与诊断控制器的估计结果,针对多种驾驶员设计个性化容错控制器以减少电机故障对驾驶员的影响。控制器的综合目标时使实际的转向盘转角追踪理想的转向盘转角,其中理想的转向盘转角可以通过日常数据获得。
具体容错策略包括以下步骤:
1)人-车-转向***模型的建立:
1.1)驾驶员转向模型:
假设线控转向***的转向传动比是Rg,θfd=θsw/Rg是驾驶员输入的前轮转角,在零初始条件下可以得到:
Figure BDA0002440968920000071
其中:θsw(s)是驾驶员的转向盘转角;Gh是转向比例增益;τL是微分时间常数;τd1是纯延迟时间;τd2是驾驶员反应的延迟时间,
Figure BDA0002440968920000072
代表着预瞄点的理想侧向位移;τp是预瞄时间;Y(s)和φ(s)是车辆当前的侧向位移和偏航角;L是驾驶员的预瞄距离,vx是车辆纵向车速;
1.2)车辆***运动学和动力学模型
假设车辆在大地平面上的质心位置是(X,Y),车辆***的动力学和运动学关系可以推导如下:
Figure BDA0002440968920000073
其中:φ是车辆的偏航角:β是车辆的的质心侧偏角;ωr是车辆的横摆角速度;V是车辆的实际速度;Vx是车辆的横向速度;Vy车辆的纵向速度;m是汽车的质量;k1是前轮刚度;k2后轮刚度;Iz是车辆的横摆惯性矩;a是车辆的前轴轴距;b是车辆的后轴轴距;δf是车辆的前轮转角;d1和d2代表着模型误差;
1.3)线控***动力学模型:
作为线控***,转向执行器模块中转向扭矩从两个转向电机传输到前轮转角,这个过程涉及两个直流电机,两个减速器,两个转向管柱,一个齿轮齿条机构,线控子***的动力学模型如下:
Figure BDA0002440968920000081
其中:θs是总的小齿轮转角;BR是等效阻尼系数;JR等效惯性矩;G2小齿轮到车轮的减速比;G1是减速比;η是减速器的效率;dr是路面干扰;τR是回正力矩;tp,tm是轮胎的拖距;T是双电机总的输出扭矩;Xr是齿条位移;rp是小齿轮半径;
2)用以下公式表述转向电机的故障情况:
ui=λiudi+Δui(i=fl,fr) (4)
其中i=fl,fr代表左右两个转向电机;udi是理想的电机输出扭矩和ui是实际的电机输出扭矩;λi∈[0,1]代表着失效系数;Δui代表着增加的故障;
从公式(4)可知:当λi=0和Δui=0时,转向电机无故障;
电机故障情况可以用ui=λiudi+Δu或者ui=λiudi建模表示,其中λi∈(0,1),λi的值代表着电机故障的损坏程度;
定义:λavei=(λimaximin)/2 (5)
Figure BDA0002440968920000082
其中λi maxi min是λi的最大值和最小值;
λi可以被描述如下:
Figure BDA0002440968920000083
其中Ni是时变变量;
定义u=[Tm1,Tm2];udi=[Tmd1,Tmd2];Δu=[Δum1,Δum2]有利于公式的简化和推导,其中Tm1,Tm2是转向电机的实际输出扭矩;Tmd1 Tmd2是转向电机理想状态下的输出扭矩;Δum1,Δum2代表着转向电机增加的故障;
可以得到:u=λudi+Δu (8)
把公式(7)带入公式(8),可以得到:
Figure BDA0002440968920000084
其中Λm=diag(λ12),
Figure BDA0002440968920000091
根据公式(9),可以进一步写成如下:
Figure BDA0002440968920000092
其中
Figure BDA0002440968920000093
Figure BDA0002440968920000094
是相应的估计的效率损失系数和附加的故障;
定义转向电机估计的输出扭矩
Figure BDA0002440968920000095
如下:
Figure BDA0002440968920000096
其中
Figure BDA0002440968920000097
是干扰观测器提供的估电机转矩;
考虑到估计值和真实值来自于车辆不确定性的误差,将公式(10)和(11)进一步描述如下:
Figure BDA0002440968920000098
其中dobsi是真实的电机扭矩,
Figure BDA0002440968920000099
是干扰观测器估计出的增加的电机故障扭矩;ρ∈[1,1.08]是估计结果的影响范围,由汽车质量的不确定性构成;
把公式(12)带入公式(10),可以推导如下:
Figure BDA00024409689200000910
故障检测和诊断控制器由干扰观测器和遗忘因子递推最小二乘算法组成,用来估计实际电机的扭矩,损失效率λ和增加的故障Δu,干扰观测器用来估计电机的扭矩和状态;遗忘因子递推最小二乘算法被用来去估计电机的损失效率和增加的故障;
根据公式(3),可以得到
Figure BDA00024409689200000911
根据公式(3)和(14),线控转向***可以推导为
Figure BDA00024409689200000912
其中:
Figure BDA00024409689200000913
dobsi=u是干扰观测输入,F是干扰输入矩阵,xobs是观测的车辆状态;
f(x,σ)=[f1(x,σ) f2(x,σ) f3(x,σ)]T (16)
Figure BDA00024409689200000914
Figure BDA00024409689200000915
Figure BDA0002440968920000101
Figure BDA0002440968920000102
估计的干扰值
Figure BDA0002440968920000103
通过以下观测器获得:
Figure BDA0002440968920000104
其中F+是F的广义逆,
Figure BDA0002440968920000105
基于干扰观测器估计的电机的输出扭矩,遗忘因子递推最小二乘算法被使用去估计电机的失效系数λ;
根据公式(12)和公式(13),可以得到:
Figure BDA0002440968920000106
其中φi(k)=[udi 1]T,
Figure BDA0002440968920000107
Figure BDA0002440968920000108
是需要估计的状态向量;
定义性能指标为:
Figure BDA0002440968920000109
其中:t是遗忘因子(0.95<=t<=1),y(k)是参考值;
根据公式(22)和公式(23),估计的带有遗忘因子的递推最小二乘算法可以被推导为:
Figure BDA00024409689200001010
3)通过对无故障电机进行扭矩补偿来减少转向盘转角跟踪误差,并提供个性化的容错控制:
3.1)转向盘转角的跟踪误差可以定义如下:
θswe=θswdsw (25)
其中:θswd是参考的转向盘转角,θsw是实际的转向盘转角;
3.2)在稳定状态,横摆角速度ωr *是固定值,所需的前轮转角δf到横摆角速度的响应是:
Figure BDA00024409689200001011
结合公式(25)和公式(26),可以得到:
Figure BDA0002440968920000111
其中
Figure BDA0002440968920000112
是由于转向盘转角跟踪误差导致的车辆横摆角速度补偿值;
3.3)设定控制***的状态变量是
Figure BDA0002440968920000113
控制输出是u=[ΔT],测量输出是y1=[ωr],y2=[ΔT],基于主动前轮转向的横摆角速度补偿控制的状态空间可以实现如下:
Figure BDA0002440968920000114
Figure BDA0002440968920000115
Figure BDA0002440968920000116
其中:Δθs是补偿的小齿轮转角和ΔT是正常电机的补偿扭矩由于横摆角速度补偿控制;
4)对***中存在的不确定性进行相应的处理:
线控***的乘法权函数需要满足以下要求:
Figure BDA0002440968920000117
根据公式(17),前轮刚度k1的刚度不确定范围是15%,后轮刚度k2的刚度不确定性范围是10%,并且车速的不确定性范围是10%,对G(s),Gfr(s)乘法加权函数进行求解,Wp是性能权重函数;因此,加权函数矩阵被选取为:
Figure BDA0002440968920000118
5)利用结构奇异值μ分析***鲁棒性。μ控制器设计框图如图2所示,μ控制器的设计是为了在给定条件内最小化μ值,利用间接的D-K迭代算法考虑H和μ分析被引入区求解,采用MATLAB进行μ控制算法的实现。D-K迭代算法原理图如图3所示。
个性化容错控制器验证:
故障检测和诊断控制结果:
第一组仿真结果用来去分析故障检测和诊断模块的估计效果。假设车辆在进行双移线跟踪实验的时候,做转向电机部分失效且又转向电机正常。图4展示了当执行器突然失效的情况下故障检测和诊断控制器的估计功能。设计的干扰观测器不仅可以在电机正常时估计电机的输出扭矩而且在电机失效时对此时电机的输出扭矩依旧有很高的估计精度见图4(a)。因此干扰观测器可以满足在电机复杂条件下对电机扭矩估计的要求。基于以上结果,进一步使用遗忘因子递推最小二乘算法对电机失效系数和增加故障程度进行参数估计。正如图4(b)和图4(c)所示,电机失效系数估计的收敛速度和估计的精度收到递推最小而成算法忠遗忘因子的影响。当遗忘因子t=0.98时,收敛时间稍微降低但是稳态误差的波动范围较大,这样会对控制器的设计产生一定的影响。当遗忘因子t=0.995,参数估计的收敛时间是可接受的并且稳态状态下的估计误差很小,这种情况加强了故障检测和诊断控制器的鲁棒性能且满足控制器的设计要求。
个性化容错控制器的容错结果:
第二组仿真结果主要集中研究在电机不同失效系数下三种驾驶员的容错特性。提出的容错控制策略被采用在仿真实验中,并且电机相应的失效系数被设为75%(图5a)和50%(图5b)。本专利同时采用三种函数去评估转向***的性能,驾驶员的生理和心理负担。因此,量化指标被采用去进一步分析提出的控制对人-车***的影响。
Figure BDA0002440968920000121
专利设计的控制器可以在电机发生不同程度失效时辅助不同的驾驶员跟踪理想的方向盘转角见图5。这种方法极大的减轻了执行器失效对驾驶员的影响通过相应的容错控制。除此之外,个性化容错控制器充分考虑到了在故障发生时不同驾驶员的转向特性差异。图5的仿真结果表明当驾驶员配备有匹配的控制器时,比如驾驶员A和控制器A,驾驶员B和控制器B,驾驶员C和控制器C,转向盘转角的跟踪误差最小(简写driverA+CA,driverB+CB,driverC+CC)。表1的数据展示了容错控器极大的提高了车辆的性能,减轻了驾驶员的生理和心理负担。当相应的匹配设计会使人车***的性能达到最佳。
表1
Figure BDA0002440968920000131
本发明具体应用途径很多,以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以作出若干改进,这些改进也应视为本发明的保护范围。

Claims (4)

1.一种考虑驾驶员转向特性的线控转向***容错策略,其特征在于包括以下步骤:
1)建立人-车-转向***模型,包括驾驶员转向模型、车辆***运动学和动力学模型、线控***动力学模型;
2)用以下公式表述转向电机的故障情况:
ui=λiudi+Δui(i=fl,fr) (4)
其中i=fl,fr代表左右两个转向电机;udi是理想的电机输出扭矩和ui是实际的电机输出扭矩;λi∈[0,1]代表着失效系数;Δui代表着增加的故障;
从公式(4)可知:当λi=0和Δui=0时,转向电机无故障;
电机故障情况可以用ui=λiudi+Δu或者ui=λiudi建模表示,其中λi∈(0,1),λi的值代表着电机故障的损坏程度;
定义:λavei=(λimaximin)/2 (5)
Figure FDA0002440968910000011
其中λimaximin是λi的最大值和最小值;
λi可以被描述如下:
Figure FDA0002440968910000012
其中Ni是时变变量;
定义u=[Tm1,Tm2];udi=[Tmd1,Tmd2];Δu=[Δum1,Δum2]有利于公式的简化和推导,其中Tm1,Tm2是转向电机的实际输出扭矩;Tmd1 Tmd2是转向电机理想状态下的输出扭矩;Δum1,Δum2代表着转向电机增加的故障;
可以得到:u=λudi+Δu (8)
把公式(7)带入公式(8),可以得到:
Figure FDA0002440968910000013
其中Λm=diag(λ12),
Figure FDA0002440968910000014
根据公式(9),可以进一步写成如下:
Figure FDA0002440968910000015
其中
Figure FDA0002440968910000016
Figure FDA0002440968910000017
是相应的估计的效率损失系数和附加的故障;
定义转向电机估计的输出扭矩
Figure FDA0002440968910000018
如下:
Figure FDA0002440968910000019
其中
Figure FDA00024409689100000110
是干扰观测器提供的估电机转矩;
考虑到估计值和真实值来自于车辆不确定性的误差,将公式(10)和(11)进一步描述如下:
Figure FDA0002440968910000021
其中dobsi是真实的电机扭矩,
Figure FDA0002440968910000022
是干扰观测器估计出的增加的电机故障扭矩;ρ∈[1,1.08]是估计结果的影响范围,由汽车质量的不确定性构成;
把公式(12)带入公式(10),可以推导如下:
Figure FDA0002440968910000023
故障检测和诊断控制器由干扰观测器和遗忘因子递推最小二乘算法组成,用来估计实际电机的扭矩,损失效率λ和增加的故障Δu,干扰观测器用来估计电机的扭矩和状态;遗忘因子递推最小二乘算法被用来去估计电机的损失效率和增加的故障;
根据线控***动力学模型,可以得到
Figure FDA0002440968910000024
根据线控***动力学模型和(14),线控转向***可以推导为
Figure FDA0002440968910000025
其中:
Figure FDA0002440968910000026
dobsi=u是干扰观测输入,F是干扰输入矩阵,xobs是观测的车辆状态;
f(x,σ)=[f1(x,σ) f2(x,σ) f3(x,σ)]T (16)
Figure FDA0002440968910000027
Figure FDA0002440968910000028
Figure FDA0002440968910000029
Figure FDA00024409689100000210
估计的干扰值
Figure FDA00024409689100000211
通过以下观测器获得:
Figure FDA00024409689100000212
其中F+是F的广义逆,
Figure FDA0002440968910000031
基于干扰观测器估计的电机的输出扭矩,遗忘因子递推最小二乘算法被使用去估计电机的失效系数λ;
根据公式(12)和公式(13),可以得到:
Figure FDA0002440968910000032
其中φi(k)=[udi 1]T,
Figure FDA0002440968910000033
Figure FDA0002440968910000034
是需要估计的状态向量;
定义性能指标为:
Figure FDA0002440968910000035
其中:t是遗忘因子(0.95<=t<=1),y(k)是参考值;
根据公式(22)和公式(23),估计的带有遗忘因子的递推最小二乘算法可以被推导为:
Figure FDA0002440968910000036
3)通过对无故障电机进行扭矩补偿来减少转向盘转角跟踪误差,并提供个性化的容错控制:
3.1)转向盘转角的跟踪误差可以定义如下:
θswe=θswdsw (25)
其中:θswd是参考的转向盘转角,θsw是实际的转向盘转角;
3.2)在稳定状态,横摆角速度ωr *是固定值,所需的前轮转角δf到横摆角速度的响应是:
Figure FDA0002440968910000037
结合公式(25)和公式(26),可以得到:
Figure FDA0002440968910000038
其中
Figure FDA0002440968910000039
是由于转向盘转角跟踪误差导致的车辆横摆角速度补偿值;
3.3)设定控制***的状态变量是
Figure FDA00024409689100000310
控制输出是u=[ΔT],测量输出是y1=[ωr],y2=[ΔT],基于主动前轮转向的横摆角速度补偿控制的状态空间可以实现如下:
Figure FDA00024409689100000311
Figure FDA0002440968910000041
Figure FDA0002440968910000042
其中:Δθs是补偿的小齿轮转角和ΔT是正常电机的补偿扭矩由于横摆角速度补偿控制;
4)对***中存在的不确定性进行相应的处理:
5)利用结构奇异值μ分析***鲁棒性。
2.根据权利要求1所述的考虑驾驶员转向特性的线控转向***容错策略,其特征在于所述的人-车-转向***模型具体如下:
1.1)驾驶员转向模型:
假设线控转向***的转向传动比是Rg,θfd=θsw/Rg是驾驶员输入的前轮转角,在零初始条件下可以得到:
Figure FDA0002440968910000043
其中:θsw(s)是驾驶员的转向盘转角;Gh是转向比例增益;τL是微分时间常数;τd1是纯延迟时间;τd2是驾驶员反应的延迟时间,
Figure FDA0002440968910000044
代表着预瞄点的理想侧向位移;τp是预瞄时间;Y(s)和φ(s)是车辆当前的侧向位移和偏航角;L是驾驶员的预瞄距离,vx是车辆纵向车速;
1.2)车辆***运动学和动力学模型
假设车辆在大地平面上的质心位置是(X,Y),车辆***的动力学和运动学关系可以推导如下:
Figure FDA0002440968910000051
其中:φ是车辆的偏航角:β是车辆的的质心侧偏角;ωr是车辆的横摆角速度;V是车辆的实际速度;Vx是车辆的横向速度;Vy车辆的纵向速度;m是汽车的质量;k1是前轮刚度;k2后轮刚度;Iz是车辆的横摆惯性矩;a是车辆的前轴轴距;b是车辆的后轴轴距;δf是车辆的前轮转角;d1和d2代表着模型误差;
1.3)线控***动力学模型:
作为线控***,转向执行器模块中转向扭矩从两个转向电机传输到前轮转角,这个过程涉及两个直流电机,两个减速器,两个转向管柱,一个齿轮齿条机构,线控子***的动力学模型如下:
Figure FDA0002440968910000052
其中:θs是总的小齿轮转角;BR是等效阻尼系数;JR等效惯性矩;G2小齿轮到车轮的减速比;G1是减速比;η是减速器的效率;dr是路面干扰;τR是回正力矩;tp,tm是轮胎的拖距;T是双电机总的输出扭矩;Xr是齿条位移;rp是小齿轮半径。
3.根据权利要求1所述的考虑驾驶员转向特性的线控转向***容错策略,其特征在于:所述的步骤4)中,线控***的乘法权函数需要满足以下要求:
Figure FDA0002440968910000053
根据公式(17),前轮刚度k1的刚度不确定范围是15%,后轮刚度k2的刚度不确定性范围是10%,并且车速的不确定性范围是10%,对G(s),Gfr(s)乘法加权函数进行求解,Wp是性能权重函数;因此,加权函数矩阵被选取为:
Figure FDA0002440968910000061
4.根据权利要求1所述的考虑驾驶员转向特性的线控转向***容错策略,其特征在于:所述的步骤5)中,μ控制器的设计是为了在给定条件内最小化μ值,利用间接的D-K迭代算法考虑H和μ分析被引入区求解,采用MATLAB进行μ控制算法的实现。
CN202010265087.0A 2020-04-07 2020-04-07 考虑驾驶员转向特性的线控转向***容错策略 Active CN111497867B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010265087.0A CN111497867B (zh) 2020-04-07 2020-04-07 考虑驾驶员转向特性的线控转向***容错策略

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010265087.0A CN111497867B (zh) 2020-04-07 2020-04-07 考虑驾驶员转向特性的线控转向***容错策略

Publications (2)

Publication Number Publication Date
CN111497867A CN111497867A (zh) 2020-08-07
CN111497867B true CN111497867B (zh) 2021-05-25

Family

ID=71870902

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010265087.0A Active CN111497867B (zh) 2020-04-07 2020-04-07 考虑驾驶员转向特性的线控转向***容错策略

Country Status (1)

Country Link
CN (1) CN111497867B (zh)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113815720B (zh) * 2021-11-05 2023-09-22 安徽奇米智能科技有限公司 一种无人驾驶汽车线控转向***的故障观测器的设计方法
CN116888034A (zh) * 2022-09-26 2023-10-13 宁德时代新能源科技股份有限公司 车辆的控制方法及相关装置

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105416298B (zh) * 2015-11-27 2017-08-29 吉林大学 一种基于线控转向***的路面不平度预警与主动避障装置
JP6690581B2 (ja) * 2017-03-09 2020-04-28 オムロン株式会社 運転モード切替制御装置、方法およびプログラム
DE102018201221A1 (de) * 2017-12-07 2019-06-13 Robert Bosch Gmbh Lenkvorrichtung
JP6647326B2 (ja) * 2018-02-02 2020-02-14 本田技研工業株式会社 車両の制御装置
CN109664938B (zh) * 2018-12-29 2023-12-01 南京航空航天大学 基于驾驶员行为辨识的线控转向双电机***及其横摆稳定性补偿策略
CN110758550B (zh) * 2019-10-11 2021-08-06 南京航空航天大学 线控双电机耦合转向***的能量优化方法
CN110826192B (zh) * 2019-10-15 2024-02-13 南京航空航天大学 一种基于纳什谈判准则的人-车合作型博弈控制方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
驾驶员影响汽车侧翻稳定性机理分析与控制;金智林,严正华,赵万忠;《机械工程学报》;20190220;第55卷(第4期);109-117 *

Also Published As

Publication number Publication date
CN111497867A (zh) 2020-08-07

Similar Documents

Publication Publication Date Title
US6766230B1 (en) Model-based fault detection and isolation system and method
CN108688719B (zh) 用于估算转向扭矩的***和方法
Tseng et al. The development of vehicle stability control at Ford
DE102007037508B4 (de) Verfahren zur Fahrzeugsteuerung
CN109733464B (zh) 基于线控转向双电机的主动容错和故障缓解***及其控制方法
CN111497867B (zh) 考虑驾驶员转向特性的线控转向***容错策略
Yih Steer-by-wire: implications for vehicle handling and safety
US20040148080A1 (en) Control strategy for computer-controlled steering
CN105774902B (zh) 一种带有容错功能的汽车动力转向控制装置及控制方法
US20100077847A1 (en) Tire state estimator and tire state estimation method
CN113183950B (zh) 一种电动汽车主动前轮转向的自适应控制方法
Zhao et al. Individual auxiliary and fault-tolerant control of steer-by-wire system considering different drivers steering characteristics
CN113359457B (zh) 智能车底盘域控制器的高维动力学模型解算装置及方法
CN114454950B (zh) 一种双电机线控转向***及其容错控制方法
US11648933B2 (en) Method for controlling wheel slip of vehicle
US6687585B1 (en) Fault detection and isolation system and method
CN115339507B (zh) 转向控制***
CN112519873A (zh) 一种四轮独立线控转向电动汽车执行机构主动容错控制算法及***
CN111098837B (zh) 用于车辆的集成控制***
CN111062088B (zh) 一种四轮独立驱动电动汽车参考车速容错自适应估计方法
CN113306624A (zh) 一种基于路感力矩反馈模型的线控转向***路感调节方法
US20230406306A1 (en) Method for controlling driving force of vehicle
CN108860137A (zh) 失稳车辆的控制方法、装置及智能车辆
CN116141984A (zh) 车辆及其控制方法和控制装置、计算机可读存储介质
US11628723B2 (en) Method of controlling posture of vehicle

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