CN109733464B - 基于线控转向双电机的主动容错和故障缓解***及其控制方法 - Google Patents

基于线控转向双电机的主动容错和故障缓解***及其控制方法 Download PDF

Info

Publication number
CN109733464B
CN109733464B CN201811549717.6A CN201811549717A CN109733464B CN 109733464 B CN109733464 B CN 109733464B CN 201811549717 A CN201811549717 A CN 201811549717A CN 109733464 B CN109733464 B CN 109733464B
Authority
CN
China
Prior art keywords
motor
torque
fault
yaw rate
compensation
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
CN201811549717.6A
Other languages
English (en)
Other versions
CN109733464A (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 CN201811549717.6A priority Critical patent/CN109733464B/zh
Publication of CN109733464A publication Critical patent/CN109733464A/zh
Priority to US17/258,378 priority patent/US20210269087A1/en
Priority to PCT/CN2019/116041 priority patent/WO2020125249A1/zh
Application granted granted Critical
Publication of CN109733464B publication Critical patent/CN109733464B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • 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/60Other road transportation technologies with climate change mitigation effect
    • Y02T10/72Electric energy management in electromobility

Landscapes

  • Steering Control In Accordance With Driving Conditions (AREA)
  • Power Steering Mechanism (AREA)

Abstract

本申请公开一种基于线控转向双电机的主动容错和故障缓解***及其模式切换控制方法,该***包含所述***包括依次连接的采集单元、转向盘总成、ECU控制模块和前轮转向总成,容错控制器;其控制方法包括采集单元将采集到的汽车信号传递给ECU控制模块,再通过容错控制策略单元、横摆角速度计算单元,稳定性控制单元、双机补偿单元,选取对应的补偿策略,作用于齿条机构;本申请提供的***和方法可以依据故障电机不同的故障工况,在主动容错及故障缓解模式中进行切换,实现汽车实时性能的最优控制,从而保证汽车在汽车野外故障条件下的行驶性和较高的性能。

Description

基于线控转向双电机的主动容错和故障缓解***及其控制方法
技术领域
本发明涉及线控转向***及容错控制***技术领域,特别是在依据线控转向双电机不同故障工况下切换工作模式功能,并保证良好的汽车行驶性能和续航能力的线控转向双电机容错***及其模式切换控制方法。
背景技术
目前,关于汽车故障容错普遍采用硬件冗余和软件冗余两种方式。其中硬件冗余可以在汽车发生故障的时候采取替换的方式,用新的硬件替换掉故障的硬件,以此保证汽车的正常行驶;但硬件冗余方式将加大汽车的经济成本,没有考虑汽车实时的故障状况,不能实现汽车实时最优分配,是一种较为保守的容错方式。软件冗余是一种以软件冗余来减少硬件冗余开发成本的方式,软件冗余的核心方式是主动容错的方式,该方式通过其他组正确数据的辨识及推导,用推导出的近似正确的数据替换掉因传感器等失效测得的错误数据,这样可以解决因为某些传感器失效带来的连锁误差,可大大减少容错的开发成本。但有些执行器不适合完全用主动容错的方式替代,因为有些执行器的故障,不仅仅会造成数据的错误,更会直接影响汽车的执行效果。比如汽车线控转向的执行电机,单转向执行电机发生故障,只采用主动容错的方式无法替代转向电机失效带来的转向影响,不能保证野外工况下唯一执行器转向执行电机发生故障,汽车的正常行驶和最优控制。
单独的主动容错方式无法解决执行器故障问题,单独的硬件冗余方式或硬件冗余与主动容错方式结合无法解决汽车行驶实时最优化问题,会造成故障执行器资源的浪费。
发明内容
针对现有容错理念及现有技术的不足,本发明提出了一种新型容错理念-故障缓解,并基于此理念提供了一种基于线控转向双执行电机的主动容错和故障环节***及其模式切换方法,在保证安全性的基础上,通过硬件冗余和主动容错及故障缓解三者相结合的方式极大的提高了***的安全性、可靠性、以及性能的实时优越性,实现了汽车安全性与可靠性完美的融合,解决了在单电机故障的情况下,汽车无法运行或者性能急剧下降的问题,解决了硬件冗余与主动容错技术直接隔离故障电机,因方式过于保守造成的故障电机性能浪费的问题,更解决了汽车行驶过程中不能依据汽车故障类型实现汽车实时最优化性能的问题。
本发明是通过如下技术方案实现的:
首先,本发明提供了一种基于线控转向双电机的主动容错和故障缓解***,该***包括:采集单元、转向盘总成、ECU控制模块、双机执行单元;
其中,采集单元分别与ECU控制模块、转向盘总成、双机执行单元连接;所述采集单元包括转向盘转角传感器4,转向盘力矩传感器5,前轮转角传感器9,前轮力矩传感器12,车速传感器19,横摆角速度传感器采集汽车状态的传感器;并将采集到的信号或指令分别转递给ECU控制模块、转向盘总成、双机执行单元,具体而言:采集单元实时将汽车行驶过程中车速信号、转向盘转角信号、转速传感器获得转向电机的转角信号、转矩传感器获得转矩电机的转矩信号以及横摆角速度传感器获得的汽车横摆角速度信号、转向前轮的转角信号等传给电子控制单元及横摆角速度计算单元;将转角电机与转矩电机的电阻、电压、电流信号发送给电机故障诊断单元;将故障诊断单元发送的指令传递给容错控制策略单元;将横摆角速度计算单元得出的理想横摆角速度与实际横摆角速度差值信号及路面干扰侧向风干扰等信号发送给双机容错补偿控制单元;
ECU控制模块分别与采集单元、双机执行单元、转向盘总成连接,其主要包括运算控制器7和容错控制器18,运算控制器7包括电机故障诊断单元、电子控制单元;容错控制器18即容错控制器,包括容错控制策略单元,横摆角速度计算单元,稳定性控制单元,双电机容错补偿单元;
ECU控制模块接收来自采集单元的信号,经过计算后把相应的指令传输给双机执行单元进行动作;具体而言,电机故障诊断单元为自适应的Kalman滤波器,以实现转角电机和转矩电机电阻,电流,电压的在线辨识,其根据采集单元传送的转角电机与转矩电机实时的电阻、电流、电压信号,判定电机的状态,并将电机的实际电压,电流信号传递给容错控制器。
容错控制器根据电机故障诊断单元传来的信号,对于不同的电机故障,通过主动容错及故障缓解的方式进行相应的容错补偿控制策略;横摆角速度计算单元根据采集单元传送的方向盘转角信号、车速信号计算出理想的横摆角速度信号,再根据理想的横摆角速度信号与实际的横摆角速度信号计算出所需调整的理想横摆角速度差值,并把横摆角速度差值传递给稳定性控制单元;稳定性控制单元根据横摆角速度计算单元传递的横摆角速度差值综合考虑路面干扰,侧向风,***摩擦等对汽车稳定的影响,从***鲁棒性出发,以保证汽车的稳定性为前提,得出补偿转矩并传递给双机容错补偿单元;双机容错补偿单元接收稳定性控制单元传递的补偿转矩信号,并且根据容错控制策略单元的容错策略,通过转矩电机控制器16控制转矩电机13动作,对***进行补偿,从而实现故障的主动容错或故障缓解。
转向盘总成包括转向盘1、转向柱2、路感电机3,路感电机控制器6,转向盘1通过转向杆柱2与路感电机3及其转向盘转角传感器4相连接,转向盘力矩传感器5安装在转向杆柱2上;路感电机控制器6连接路感电机3及转向盘力矩传感器5,控制路感电机3的运行。
双机执行单元包括依次连接的转角电机控制器8,转角电机10,双极减速器11,转矩电机控制器16,转矩电机13,减速器14,齿轮齿条机构15,前轮17;转角电机10及转矩电机13及双极减速器11、减速器14与齿轮齿条转向器15相连接,前轮17安装在齿轮齿条转向器15的两侧,前轮转角传感器9安装与前轮17上,转角传感器9与前轮力矩传感器12连接F1exray总线,将转角电机控制器8及转矩电机控制器16信号输入到总线中,再通过总线传输到容错控制器18中;转角电机10及其减速机构11连接转角控制单元8,转角电机控制单元8控制转角电机10及双极减速器11的运行,转矩电机13及减速器14连接转矩电机控制器16,转矩电机控制器16控制转矩电机13及减速器14的运行;容错控制器18的输出端分别与路感电机控制器6的输入端和Flexray总线相连接;容错控制器18接收传入到Flexary的前轮力矩电机传感器12,前轮转角电机传感器9,转向盘力矩传感器5的信号及运算控制器7的信号,行鲁棒性控制及补偿策略的控制,并把指令输入Flexery总线,并将指令传送给转角电机控制器8及转矩电机控制器16使相应电机动作。
其次,本发明还提供了一种基于上述线控转向双电机的主动容错和故障缓解***的模式切换控制方法,该方法包括如下步骤:
步骤1:汽车在行驶途中,采集单元将转角电机R2和转矩电机的电阻R3,电流信号I2和I3传递给电机故障诊断单元,电机故障诊断单元根据电阻与电流的大小,判定电机状态,并且输出电机电流与转矩的关系T=f(I),并将指令传递给容错控制策略单元;
步骤2:容错控制策略单元接收到来自故障诊断单元的诊断结果,得到转角电机或者转矩电机运行状态工况,并且通过比较转角电机电压U2和转距电机电压U3与参考阈值U0比较,决定采取主动容错策略1,或主动容错策略2,或故障缓解策略1,或故障缓解策略2;
步骤3:横摆角速度计算单元根据采集单元实时采集的方向盘转角信号δsw,车速信号u根据变传动比规律计算出实时的理想的横摆角速度信号ωr *,再根据理想的横摆角速度信号ωr *与实际的横摆角速度信号ωr计算出所需调整的理想横摆角速度差值Δωr,并把横摆角速度差值Δωr传递给稳定性控制单元;
横摆角速度计算单元根据汽车实时车速u和前轮转角输入整车转向二自由度模型得到实际横摆角速度ωr
Figure BDA0001910324850000031
Δωr=ωrr *  (2)
式(1)中:m为汽车质量;Iz为汽车绕z轴的转动惯量;k1、k2分别为前后车轮的侧偏刚度;δf为前轮转角;a,b分别为前、后轴至车辆质心的距离;u为车辆前进速度;ωr为横摆角速度;β为质心侧偏角;
步骤4:稳定性控制单元接收来自横摆角速度控制单元输入的横摆角速度差值Δωr,转换成相应的补偿转矩T1,综合路面干扰形成的补偿转矩T2,***摩擦形成的补偿转矩T3,考虑***稳定性控制因素,采用μ综合鲁棒控制器控制,提高***抵抗外界干扰的能力,并且把补偿转矩ΔT传递给双机补偿单元;
ΔT=ΔT1+ΔT2+ΔT3  (3)
ΔT使总的补偿转矩,ΔT1使弥补横摆角速度差值所需的补偿转矩,ΔT2路面干扰形成的补偿转矩,ΔT3***摩擦形成的补偿转矩;
步骤5:容错控制器接收来自稳定性控制单元的补偿转矩T,通过接受到容错控制器传来的的容错策略,选取对应的补偿策略,作用于双机执行单元和转向盘总成,保证汽车能有好的横摆角速度控制效果,及较好的稳定性。
进一步的,在上述一种基于上述线控转向双电机的主动容错和故障缓解***的模式切换控制方法中,还包括在步骤1中构建电机故障诊断单元,可以通过设计一个自适应的Kalman滤波器实现转角电机和转矩电机电阻,电流,电压的在线辨识:
其中:对于离散线性***:
x(k)=Ax(k-1)+B(u(k)+w(k))  (4)
yv(k)=Cx(k)+v(k)  (5)
式(4)、(5)中,x(k)时k时刻的***状态,x(k-1)时k-1时刻的***状态,A,B是***参数,u(k)是k时刻对***的控制量,w(k)为过程噪声信号,v(k)为测量噪声信号,yv(k)是***k时刻的测量值,C是矩阵;
离散卡尔曼滤波递推算法为:
Mn(k)=P(k)CT/[CP(k)CT+R]  (6)
P(k)=AP(k-1)AT+BQBT  (7)
P(k)=(En-Mn(k)C)P(k)  (8)
x(k)=Ax(k-1)+Mn(k)(yv(k)-CAx(k-1))  (9)
ye(k)=Cx(k)  (10)
式(6)-(10)中x(k)时k时刻的***状态,x(k-1)时k-1时刻的***状态,A,B,R是***参数,C是矩阵,AT是A矩阵的转置矩阵,BT是B矩阵的转置矩阵,CT是C矩阵的转置矩阵,ye(k)是经过卡尔曼滤波器修正后的输出信号,P(k)是***k时刻的协方差,P(k-1)是***k-1时刻的协方差,En是单位向量,Mn(k)是中间变量
En为单位向量,则***误差的协方差errcov(k)为:
errcov(k)=CP(k)CT  (11)
式(11)中,errcov(k)是***误差的协方差,C是矩阵,CT是C矩阵的转置矩阵,P(k)是***k时刻的协方差。
根据基尔霍夫电压定律,构建转角电机与转矩电机的回路模型:
转角电机电学方程为:
Figure BDA0001910324850000051
式(12)中:L为转向电机电感;R2为转向电机电阻;kb2为电动势常数;u2是转角电机的输入电压,
Figure BDA0001910324850000052
是转角电机的电流,
Figure BDA0001910324850000053
是转角电机转角加速度,kb2是转角电机的刚度。
转矩电机电学方程为:
Figure BDA0001910324850000054
式中:L为转矩电机电感;R3为转矩电机电阻;kb3为电动势常数;u3是转矩电机的输入电压,ia3是转矩电机的电流,
Figure BDA0001910324850000055
是转矩电机转角加速度,kb3是转角电机的刚度。
自适应的Kalman滤波器将转角电机,转矩电机的电压,电流,电阻信号传递给容错控制策略单元。
进一步的,所述步骤2中形成的四种实时容错控制策略,主动容错策略1,或主动容错策略2,或故障缓解策略1,或故障缓解策略2的流程包括:
步骤2.1:Kalman滤波器通过监测电阻波动超出正常范围,可以判定转角电机或转矩电机故障。从电机性能最优化考虑,当电机的输出最大电压大于安全裕度电压即U>=0.5Umax,U0=0.5Umax时,即可以认为电机可发挥电机部分功能,输出一定的转矩,转矩T=f(I),这是故障缓解策略的前提,较高的输出电压能力也是电机可以进行补偿工作的保证;
从安全性考虑,为了防止转角电机或者转矩电机不能够及时输出足够的转矩,当电机的最大电压小于安全裕度即U<=0.5Umax,U0=0.5Umax时,即可认为故障电机不可发挥功能,故障电机不能完成补偿工作,此时***隔离故障电机,并进行主动容错策略的控制;
步骤2.2:定义0表示转角电机正常运行,1表示转角电机半正常运行,2代表转角电机不能运行,全故障,定义3表示转矩电机正常运行,4表示转矩电机半正常运行,5表示转矩电机不能运行,全故障;半正常运行表示U2>=U0或者U3>=U0;按照转角电机与转矩电机故障情况形成故障向量表,该故障向量表包括转角电机与转矩电机的运行状态和对应的故障情况;所述故障向量表如下:
故障向量表
故障向量 故障情况
03 两个电机正常
25 两个电机全故障
04 转角电机正常,转矩电机半正常
13 转角电机半正常,转矩电机正常
05 转角电机正常,转矩电机全故障
23 转角电机全故障,转矩电机正常
15 转角电机半正常,转矩电机全故障
24 转角电机全故障,转矩电机半正常
14 转角电机半正常,转矩半正常
步骤2采取的容错策略具体包括:
1)当转角电机与转矩电机全部正常工作时,两个电机共同作用,控制前轮转角,以及汽车横摆角速度,此时无需容错策略;两个电机正常工作下,齿条运动分析如下:
齿条的运动微分方程为:
Figure BDA0001910324850000061
式中:mrack为齿条的质量;yrack为齿条的位移;rL为主销轴的偏置;KL为转向拉杆刚度;Brack为齿条阻尼系数;Ffrrack为***间的摩擦力,G为双减速器机构的减速比;Tg2是转向电机2的输出转矩;Tg3是转向电机3的输出转矩;
Figure BDA0001910324850000062
为齿条加速度,
Figure BDA0001910324850000063
为齿条的运动速度;
车轮的运动微分方程为:
Figure BDA0001910324850000064
式(15)中:Jw为前轮的转动惯量;Tfrkp为摩擦力矩;Bkp主销的阻尼系数。
Figure BDA0001910324850000065
转向前轮的转角加速度,
Figure BDA0001910324850000066
为转向前轮角速度,MZ为车轮的回正力矩;
2)当转角电机正常,转矩电机半正常,***进行故障缓解策略1,转角电机主要进行汽车横摆角速度控制,而转矩电机补偿横摆角速度控制器反馈回来的补偿扭矩ΔT1
对综合ΔT1=ΔT11+ΔT21+ΔT31  (16)其中ΔT1使总的补偿转矩,T11使弥补横摆角速度差值所需的补偿转矩,T21路面干扰形成的补偿转矩,T31***摩擦形成的补偿转矩;
Figure BDA0001910324850000071
式(17)中,mrack为齿条的质量;yrack为齿条的位移;rL为主销轴的偏置;KL为转向拉杆刚度;Brack为齿条阻尼系数;Ffrrack为***间的摩擦力,G为双减速器机构的减速比;Tg2是转向电机2的输出转矩;Ta3是转向电机3的输出转矩;
3)当转角电机半正常,转矩电机正常,采用故障缓解策略2,转矩电机充当转角电机功能进行主要控制,转角电机充当转矩电机功能,进行补偿横摆角速度控制器反馈回来的补偿扭矩ΔT2
对综合ΔT2=ΔT12+ΔT22+ΔT32  (18)
其中ΔT2使总的补偿转矩,T12使弥补横摆角速度差值所需的补偿转矩,T22路面干扰形成的补偿转矩,T32***摩擦形成的补偿转矩;
Figure BDA0001910324850000072
4)当转角电机正常,转矩电机全故障,采用主动容错策略1,切断转矩电机电流输入,转角电机单独控制,进行补偿横摆角速度控制器反馈回来的补偿扭矩ΔT3
对其综合ΔT3=ΔT13+ΔT23+ΔT33  (20)
其中ΔT3使总的补偿转矩,T13使弥补横摆角速度差值所需的补偿转矩,T23路面干扰形成的补偿转矩,T33***摩擦形成的补偿转矩;
Figure BDA0001910324850000073
式(21)中,mrack为齿条的质量;yrack为齿条的位移;rL为主销轴的偏置;KL为转向拉杆刚度;Brack为齿条阻尼系数;Ffrrack为***间的摩擦力,G为双减速器机构的减速比;Tg2是转向电机2的输出转矩;Ta3是转向电机3的输出转矩;
5)当转角电机全故障,转矩电机正常,采用主动容错策略2,切断转角电机电流输入,转矩电机单独控制,转矩电机充当转角电机功能,进行补偿横摆角速度控制器反馈回来的补偿扭矩ΔT4
对其综合ΔT4=ΔT14+ΔT24+ΔT34  (22)
其中ΔT4使总的补偿转矩,T14使弥补横摆角速度差值所需的补偿转矩,T24路面干扰形成的补偿转矩,T34***摩擦形成的补偿转矩;
Figure BDA0001910324850000081
6)当两个电机正常的时候,不需要应用容错策略,当两个电机都有故障(半正常,或者全故障),几率很小,不在本申请讨论范围之内。
进一步,上述基于线控转向双电机的主动容错和故障缓解***的模式切换控制方法中,所述步骤4中,μ综合鲁棒控制器的控制框架包括:
a)横摆角速度跟踪,||Z1||2=||W1(ωr*r)||2  (24)
其中,W1为加权函数,通常设置成低通滤波器W1=k1(as+b)/(cs+d)  (25)
式(24)(25)中||Z1||2式被控对象的评价输出的2范数,ωr *是理想横摆角速度值,ωr是实际汽车横摆角速度值,W1为加权函数,a,s,b,a,d是低通滤波器的参数。
μ综合鲁棒控制器要能够快速的跟踪不同容错策略下的理想横摆角速度与实际横摆角速度差值,又要对外界干扰如地面干扰,侧向风干扰有一个较好的干扰抑制,或者输出相应的补偿扭矩并且把补偿转矩ΔT传递给双机补偿单元;
b)补偿反馈,稳定性控制:ΔT=ΔT1+ΔT2+ΔT3  (26)
其中ΔT使总的补偿转矩,ΔT1使弥补横摆角速度差值所需的补偿转矩,ΔT2路面干扰形成的补偿转矩,ΔT3***摩擦形成的补偿转矩。
本发明中,故障缓解的容错理念是相对于传统容错理念提出的。传统的研究思路是采用硬件冗余或者软件冗余的方式,硬件冗余考虑的是用新的硬件替代发生故障的硬件,将发生错误的硬件从***中分离出来,或者采用软件冗余的方式,用软件冗余代替硬件冗余,通过其他传感器或者执行器的计算数据通过推导,代替发生故障的部件的数据。而在实际过程中这是较为保守的容错方式,本质上就是替代关系,用新的部件代替故障的部件,用其他数据替代错误的数据,而此时的汽车可以称作“无病工作”。然而故障部件的剩余功能没有得到充分开发而浪费,而比如电机发生故障后并没有完全瘫痪,是可以使用一部分功能输出一定的扭矩,针对电机不同故障工况,可以采取故障电机与正常的电机同时工作,此时的汽车可以称作“带病工作”。本申请通过故障电机与正常电机的匹配与比较实现汽车实时最优控制。并且同时可以保证汽车在极端野外环境下较好的工作能力与性能,也为汽车到最进的维修点修理提供了保证。
与现有即使相比,通过本发明的线控转向双电机***及其容错模式切换控制方法,在汽车线控转向***中实现了多种转向模式功能,依据汽车转向执行双电机不同的故障进行转向模式的切换,实现汽车实时的最优控制,是线控转向汽车经济性与灵活性的统一,并且充分利用故障部件的剩余功能,节省资源,具有广阔的市场应用前景。
附图说明
图1为本发明线控转向双电机***的结构布置简图。
图2为本发明线控转向双电机主动容错与故障缓解容错***控制装置原理图。
图3为本发明线控转向双电机主动容错与故障缓解容错***控制策略总图。
图4为基于横摆角速度反馈的带有容错功能的线控转向双电机汽车车辆稳定性控制***框图。
图中,1、转向盘;2、转向柱;3、路感电机;4、转向盘转角传感器;5、转向盘力矩传感器;6、路感电机控制器;7、运算控制器;8、转角电机控制器;9、前轮转角传感器;10、转角电机;11、双极减速器;12、前轮力矩传感器;13、转矩电机;14、减速器;15、齿轮齿条机构;16、转矩电机控制器;17、前轮;18、容错控制器;19、车速传感器。
具体实施方式
为了便于本领域技术人员的理解,下面结合实例与附图对本发明作进一步的说明,实施方式提及的内容并非对本发明的限定。
参照图1所示本发明的一种基于线控转向双电机的主动容错和故障缓解***在车体上的布置图,包括:采集单元、转向盘总成、ECU控制模块(型号MT20U2,在具体实施中,也可以使用M7或MT20U)、双机执行单元;
其中,采集单元与ECU控制模块、转向盘总成、双机执行单元分别连接;采集单元包括转向盘转角传感器4,转向盘力矩传感器5,前轮转角传感器9,前轮力矩传感器12,车速传感器19,横摆角速度传感器等采集汽车状态的传感器;采集单元实时将汽车行驶过程中车速信号、转向盘转角信号、转速传感器获得转向电机的转角信号、转矩传感器获得转矩电机的转矩信号以及横摆角速度传感器获得的汽车横摆角速度信号、转向前轮的转角信号等传给电子控制单元及横摆角速度计算单元;将转角电机与转矩电机的电阻、电压、电流信号发送给电机故障诊断单元;将故障诊断单元发送的指令传递给容错控制策略单元;将横摆角速度计算单元得出的理想横摆角速度与实际横摆角速度差值信号及路面干扰侧向风干扰等信号发送给双机容错补偿控制单元;
ECU控制模块与采集单元、双机执行单元、转向盘总成分别连接,主要包括运算控制器7和容错控制器18,运算控制器7包括电机故障诊断单元、电子控制单元;容错控制器18即容错控制器,包括容错控制策略单元,横摆角速度计算单元,稳定性控制单元,双电机容错补偿单元;
ECU控制模块接收来自采集单元的信号,经过计算后把相应的指令传输给双机执行单元进行动作;具体而言,电机故障诊断单元为自适应的Kalman滤波器,以实现转角电机和转矩电机电阻,电流,电压的在线辨识,其根据采集单元传送的转角电机与转矩电机实时的电阻、电流、电压信号,判定电机的状态,并将电机的实际电压,电流信号传递给容错控制器。
容错控制器根据电机故障诊断单元传来的信号,对于不同的电机故障,通过主动容错及故障缓解的方式进行相应的容错补偿控制策略;横摆角速度计算单元根据采集单元传送的方向盘转角信号、车速信号计算出理想的横摆角速度信号,再根据理想的横摆角速度信号与实际的横摆角速度信号计算出所需调整的理想横摆角速度差值,并把横摆角速度差值传递给稳定性控制单元;稳定性控制单元根据横摆角速度计算单元传递的横摆角速度差值综合考虑路面干扰,侧向风,***摩擦等对汽车稳定的影响,从***鲁棒性出发,以保证汽车的稳定性为前提,得出补偿转矩并传递给双机容错补偿单元;双机容错补偿单元接收稳定性控制单元传递的补偿转矩信号,并且根据容错控制策略单元的容错策略,通过转矩电机控制器16控制转矩电机13动作,对***进行补偿,从而实现故障的主动容错或故障缓解。
转向盘总成与采集单元、ECU控制模块分别连接,所述转向盘总成包括转向盘1、转向柱2、路感电机3,路感电机控制器6,转向盘1通过转向杆柱2与路感电机3及其转向盘转角传感器4相连接,转向盘力矩传感器5安装在转向杆柱2上;路感电机控制器6连接路感电机3及转向盘力矩传感器5,控制路感电机3的运行。
双机执行单元与采集单元、ECU控制模块分别连接,所述双机执行单元包括依次连接的转角电机控制器8,转角电机10,双极减速器11,转矩电机控制器16,转矩电机13,减速器14,齿轮齿条机构15,前轮17;转角电机10及转矩电机13及双极减速器11、减速器14与齿轮齿条转向器15相连接,前轮17安装在齿轮齿条转向器15的两侧,前轮转角传感器9安装与前轮17上,转角传感器9与前轮力矩传感器12连接Flexray总线,将转角电机控制器8及转矩电机控制器16信号输入到总线中,再通过总线传输到容错控制器18中;转角电机10及其减速机构11连接转角控制单元8,转角电机控制单元8控制转角电机10及双极减速器11的运行,转矩电机13及减速器14连接转矩电机控制器16,转矩电机控制器16控制转矩电机13及减速器14的运行;容错控制器18的输出端分别与路感电机控制器6的输入端和Flexray总线相连接;容错控制器18接收传入到Flexary的前轮力矩电机传感器12,前轮转角电机传感器9,转向盘力矩传感器5的信号及运算控制器7的信号,行鲁棒性控制及补偿策略的控制,并把指令输入Flexery总线,并将指令传送给转角电机控制器8及转矩电机控制器16使相应电机动作。
图2、3为线控转向双电机主动容错与故障缓解容错***控制装置原理图和线控转向双电机主动容错与故障缓解容错***控制策略总图,本发明的控制流程如下:
步骤1:汽车在行驶途中,采集单元将转角电机R2和转矩电机的电阻R3,电流信号I2和I3传递给电机故障诊断单元,电机故障诊断单元根据电阻与电流的大小,判定电机状态,并且输出电机电流与转矩的关系T=f(I),并将指令(转矩电机的电压,电流,电阻信号)传递给容错控制策略单元;
所述电机故障诊断单元包括自适应的Kalman滤波器实现转角电机和转矩电机电阻,电流,电压的在线辨识:
其中:对于离散线性***:
x(k)=Ax(k-1)+B(u(k)+w(k))  (4)
yv(k)=Cx(k)+v(k)  (5)
式(4)、(5)中,x(k)时k时刻的***状态,x(k-1)时k-1时刻的***状态,A,B是***参数,u(k)是k时刻对***的控制量,w(k)为过程噪声信号,v(k)为测量噪声信号,yv(k)是***k时刻的测量值,C是矩阵;
离散卡尔曼滤波递推算法为:
Mn(k)=P(k)CT/[CP(k)CT+R]  (6)
P(k)=AP(k-1)AT+BQBT  (7)
P(k)=(En-Mn(k)C)P(k)  (8)
x(k)=Ax(k-1)+Mn(k)(yv(k)-CAx(k-1))  (9)
ye(k)=Cx(k)  (10)
式(6)-(10)中x(k)时k时刻的***状态,x(k-1)时k-1时刻的***状态,A,B,R是***参数,C是矩阵,AT是A矩阵的转置矩阵,BT是B矩阵的转置矩阵,CT是C矩阵的转置矩阵,ye(k)是经过卡尔曼滤波器修正后的输出信号,P(k)是***k时刻的协方差,P(k-1)是***k-1时刻的协方差,En是单位向量,Mn(k)是中间变量
En为单位向量,则***误差的协方差errcov(k)为:
errcov(k)=CP(k)CT  (11)
式(11)中,errcov(k)是***误差的协方差,C是矩阵,CT是C矩阵的转置矩阵,P(k)是***k时刻的协方差。
根据基尔霍夫电压定律,构建转角电机与转矩电机的回路模型:
转角电机电学方程为:
Figure BDA0001910324850000121
式(12)中:L为转向电机电感;R2为转向电机电阻;kb2为电动势常数;u2是转角电机的输入电压,
Figure BDA0001910324850000122
是转角电机的电流,
Figure BDA0001910324850000123
是转角电机转角加速度,kb2是转角电机的刚度。
转矩电机电学方程为:
Figure BDA0001910324850000124
式中:L为转矩电机电感;R3为转矩电机电阻;kb3为电动势常数;u3是转矩电机的输入电压,ia3是转矩电机的电流,
Figure BDA0001910324850000125
是转矩电机转角加速度,kb3是转角电机的刚度;
步骤2:容错控制策略单元接收到来自故障诊断单元的诊断结果,得到转角电机或者转矩电机运行状态工况,并且通过比较转角电机电压U2和转距电机电压U3与参考阈值U0比较,决定采取主动容错策略1,或主动容错策略2,或故障缓解策略1,或故障缓解策略2;
上述主动容错策略1,或主动容错策略2,或故障缓解策略1,或故障缓解策略2的流程包括:
步骤2.1:Kalman滤波器通过监测电阻波动超出正常范围,可以判定转角电机或转矩电机故障。从电机性能最优化考虑,当电机的输出最大电压大于安全裕度电压即U>=0.5Umax,U0=0.5Umax时,即可以认为电机可发挥电机部分功能,输出一定的转矩,转矩T=f(I),这是故障缓解策略的前提,较高的输出电压能力也是电机可以进行补偿工作的保证;
从安全性考虑,为了防止转角电机或者转矩电机不能够及时输出足够的转矩,当电机的最大电压小于安全裕度即U<=0.5Umax,U0=0.5Umax时,即可认为故障电机不可发挥功能,故障电机不能完成补偿工作,此时***隔离故障电机,并进行主动容错策略的控制;
步骤2.2:定义0表示转角电机正常运行,1表示转角电机半正常运行,2代表转角电机不能运行,全故障,定义3表示转矩电机正常运行,4表示转矩电机半正常运行,5表示转矩电机不能运行,全故障;半正常运行表示U2>=U0或者U3>=U0;按照转角电机与转矩电机故障情况形成故障向量表,该故障向量表包括转角电机与转矩电机的运行状态和对应的故障情况;所述故障向量表如下:
故障向量表
Figure BDA0001910324850000126
Figure BDA0001910324850000131
步骤2采取的容错策略具体包括:
1)当转角电机与转矩电机全部正常工作时,两个电机共同作用,控制前轮转角,以及汽车横摆角速度,此时无需容错策略;两个电机正常工作下,齿条运动分析如下:
齿条的运动微分方程为:
Figure BDA0001910324850000132
式中:mrack为齿条的质量;yrack为齿条的位移;rL为主销轴的偏置;KL为转向拉杆刚度;Brack为齿条阻尼系数;Ffrrack为***间的摩擦力,G为双减速器机构的减速比;Tg2是转向电机2的输出转矩;Tg3是转向电机3的输出转矩;
Figure BDA0001910324850000133
为齿条加速度,
Figure BDA0001910324850000134
为齿条的运动速度;
车轮的运动微分方程为:
Figure BDA0001910324850000135
式(15)中:Jw为前轮的转动惯量;Tfrkp为摩擦力矩;Bkp主销的阻尼系数。
Figure BDA0001910324850000136
转向前轮的转角加速度,
Figure BDA0001910324850000137
为转向前轮角速度,MZ为车轮的回正力矩;
2)当转角电机正常,转矩电机半正常,***进行故障缓解策略1,转角电机主要进行汽车横摆角速度控制,而转矩电机补偿横摆角速度控制器反馈回来的补偿扭矩ΔT1
对综合ΔT1=ΔT11+ΔT21+ΔT31  (16)
其中ΔT1使总的补偿转矩,T11使弥补横摆角速度差值所需的补偿转矩,T21路面干扰形成的补偿转矩,T31***摩擦形成的补偿转矩;
Figure BDA0001910324850000138
式(17)中,mrack为齿条的质量;yrack为齿条的位移;rL为主销轴的偏置;KL为转向拉杆刚度;Brack为齿条阻尼系数;Ffrrack为***间的摩擦力,G为双减速器机构的减速比;Ta2是转向电机2的输出转矩;Ta3是转向电机3的输出转矩;
3)当转角电机半正常,转矩电机正常,采用故障缓解策略2,转矩电机充当转角电机功能进行主要控制,转角电机充当转矩电机功能,进行补偿横摆角速度控制器反馈回来的补偿扭矩ΔT2
对综合ΔT2=ΔT12+ΔT22+ΔT32  (18)其中ΔT2使总的补偿转矩,T12使弥补横摆角速度差值所需的补偿转矩,T22路面干扰形成的补偿转矩,T32***摩擦形成的补偿转矩;
Figure BDA0001910324850000141
4)当转角电机正常,转矩电机全故障,采用主动容错策略1,切断转矩电机电流输入,转角电机单独控制,进行补偿横摆角速度控制器反馈回来的补偿扭矩ΔT3
对其综合ΔT3=ΔT13+ΔT23+ΔT33  (20)
其中ΔT3使总的补偿转矩,T13使弥补横摆角速度差值所需的补偿转矩,T23路面干扰形成的补偿转矩,T33***摩擦形成的补偿转矩;
Figure BDA0001910324850000142
式(21)中,mrack为齿条的质量;yrack为齿条的位移;rL为主销轴的偏置;KL为转向拉杆刚度;Brack为齿条阻尼系数;Ffrrack为***间的摩擦力,G为双减速器机构的减速比;Ta2是转向电机2的输出转矩;Ta3是转向电机3的输出转矩;
5)当转角电机全故障,转矩电机正常,采用主动容错策略2,切断转角电机电流输入,转矩电机单独控制,转矩电机充当转角电机功能,进行补偿横摆角速度控制器反馈回来的补偿扭矩ΔT4
对其综合ΔT4=ΔT14+ΔT24+ΔT34  (22)
其中ΔT4使总的补偿转矩,T14使弥补横摆角速度差值所需的补偿转矩,T24路面干扰形成的补偿转矩,T34***摩擦形成的补偿转矩;
Figure BDA0001910324850000143
6)当两个电机正常的时候,不需要应用容错策略,当两个电机都有故障(半正常,或者全故障),几率很小,不在本申请讨论范围之内。
进一步,上述基于线控转向双电机的主动容错和故障缓解***的模式切换控制方法中,所述步骤4中,μ综合鲁棒控制器的控制框架图如图4所示,图4中,K为控制器,***的扰动输入ωr为理想的横摆角速度,干扰输入为理想的前轮转角δf *,侧向风干扰Fv以及路面的干扰力矩Tr,W1,W2为加权函数,通常设置成高通滤波器。Wd为干扰加权矩阵,ΔG为未知参数摄动,ΔI是补偿电流,z1,z2为评价输出。
具体而言,μ综合鲁棒控制器的控制框架包括:
a)横摆角速度跟踪,||Z1||2=||W1r *r)||2  (24)
其中,W1为加权函数,通常设置成低通滤波器W1=k1(as+b)/(cs+d)  (25)
式(24)(25)中||ZZ||2式被控对象的评价输出的2范数,ωr *是理想横摆角速度值,ωr是实际汽车横摆角速度值,W1为加权函数,a,s,b,a,d是低通滤波器的参数。
μ综合鲁棒控制器要能够快速的跟踪不同容错策略下的理想横摆角速度与实际横摆角速度差值,又要对外界干扰如地面干扰,侧向风干扰有一个较好的干扰抑制,或者输出相应的补偿扭矩并且把补偿转矩ΔT传递给双机补偿单元;
b)补偿反馈,稳定性控制:ΔT=ΔT1+ΔT2+ΔT3  (26)
其中ΔT使总的补偿转矩,ΔT1使弥补横摆角速度差值所需的补偿转矩,ΔT2路面干扰形成的补偿转矩,ΔT3***摩擦形成的补偿转矩;
步骤3:横摆角速度计算单元根据采集单元实时采集的方向盘转角信号δsw,车速信号u根据变传动比规律计算出实时的理想的横摆角速度信号ωr *,再根据理想的横摆角速度信号ωr *与实际的横摆角速度信号ωr计算出所需调整的理想横摆角速度差值Δωr,并把横摆角速度差值Δωr传递给稳定性控制单元;
横摆角速度计算单元根据汽车实时车速u和前轮转角输入整车转向二自由度模型得到实际横摆角速度ωr
Figure BDA0001910324850000151
Δωr=ωrr *  (2)
式(1)中:m为汽车质量;Iz为汽车绕z轴的转动惯量;k1、k2分别为前后车轮的侧偏刚度;δf为前轮转角;a,b分别为前、后轴至车辆质心的距离;u为车辆前进速度;ωr为横摆角速度;β为质心侧偏角;
步骤4:稳定性控制单元接收来自横摆角速度控制单元输入的横摆角速度差值Δωr,转换成相应的补偿转矩T1,综合路面干扰形成的补偿转矩T2,***摩擦形成的补偿转矩T3,考虑***稳定性控制因素,采用μ综合鲁棒控制器控制,提高***抵抗外界干扰的能力,并且把补偿转矩ΔT传递给双机补偿单元;
ΔT=ΔT1+ΔT2+ΔT3  (3)
ΔT使总的补偿转矩,ΔT1使弥补横摆角速度差值所需的补偿转矩,ΔT2路面干扰形成的补偿转矩,ΔT3***摩擦形成的补偿转矩;
步骤5:容错控制器接收来自稳定性控制单元的补偿转矩T,通过接受到容错控制器传来的的容错策略,选取对应的补偿策略,作用于齿条机构,保证汽车能有好的横摆角速度控制效果,及较好的稳定性。
本发明具体应用途径很多,以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,再不脱离本发明原理的前提下,还可以做出若干改进,这些改进也应视为本发明的保护范围。

Claims (4)

1.一种线控转向双电机的主动容错和故障缓解***的模式切换控制方法,其特征在于,具体步骤如下:
步骤1:汽车在行驶途中,采集单元将转角电机的电阻R2和转矩电机的电阻R3,电流信号I2和I3传递给电机故障诊断单元,电机故障诊断单元根据电阻与电流的大小,判定电机状态,并且输出电机电流与转矩的关系T=f(I),并将指令传递给容错控制策略单元;
步骤2:容错控制策略单元接收到来自故障诊断单元的诊断结果,得到转角电机或者转矩电机运行状态工况,并且通过比较转角电机电压U2和转距电机电压U3与参考阈值U0比较,决定采取主动容错策略1,或主动容错策略2,或故障缓解策略1,或故障缓解策略2;
步骤2.1:当电机的输出最大电压大于安全裕度电压,即U>=0.5Umax,U0=0.5Umax时,即可以认为电机可发挥电机部分功能,输出一定的转矩,转矩T=f(I);当电机的最大电压小于安全裕度,即U<=0.5Umax,U0=0.5Umax时,认为故障电机不可发挥功能,故障电机不能完成补偿工作,此时***隔离故障电机,并进行主动容错策略的控制;
步骤2.2:定义0表示转角电机正常运行,1表示转角电机半正常运行,2代表转角电机不能运行,全故障,定义3表示转矩电机正常运行,4表示转矩电机半正常运行,5表示转矩电机不能运行,全故障;半正常运行表示U2>=U0或者U3>=U0
步骤3:横摆角速度计算单元根据采集单元实时采集的方向盘转角信号δsw,车速信号u根据变传动比规律计算出实时的理想的横摆角速度信号ωr *,再根据理想横摆角速度信号ωr *与实际的横摆角速度信号ωr计算出所需调整的理想横摆角速度差值Δωr,并把横摆角速度差值Δωr传递给稳定性控制单元;
横摆角速度计算单元根据汽车实时车速u和前轮转角输入整车转向二自由度模型得到实际横摆角速度ωr
Figure FDA0004088705180000011
Δωr=ωrr * (2)
式(1)中:m为汽车质量;Iz为汽车绕z轴的转动惯量;k1、k2分别为前后车轮的侧偏刚度;δf为前轮转角;a,b分别为前、后轴至车辆质心的距离;u为车辆前进速度;ωr为横摆角速度;β为质心侧偏角;
步骤4:稳定性控制单元接收来自横摆角速度控制单元输入的横摆角速度差值Δωr,转换成相应的补偿转矩T1,综合路面干扰形成的补偿转矩T2,***摩擦形成的补偿转矩T3,考虑***稳定性控制因素,采用μ综合鲁棒控制器控制,并且把补偿转矩ΔT传递给双机补偿单元;
ΔT=ΔT1+ΔT2+ΔT3 (3)
ΔT使总的补偿转矩,ΔT1使弥补横摆角速度差值所需的补偿转矩,ΔT2路面干扰形成的补偿转矩,ΔT3***摩擦形成的补偿转矩;
步骤5:容错控制器接收来自稳定性控制单元的补偿转矩T,通过接受到容错控制器传来的容错策略,选取对应的补偿策略,作用于双机执行单元;
所述线控转向双电机的主动容错和故障缓解***包括采集单元、转向盘总成、ECU控制模块、双机执行单元;
其中,采集单元与ECU控制模块、转向盘总成及双机执行单元分别连接;所述采集单元包括转向盘转角传感器(4),转向盘力矩传感器(5),前轮转角传感器(9),前轮力矩传感器(12),车速传感器(19),横摆角速度传感器;
所述采集单元实时将汽车行驶过程中车速信号、转向盘转角信号、转速传感器获得转角电机的转角信号、转矩传感器获得转矩电机的转矩信号以及横摆角速度传感器获得的汽车横摆角速度信号、转向前轮的转角信号传给电子控制单元及横摆角速度计算单元;将转角电机与转矩电机的电阻、电压、电流信号发送给电机故障诊断单元;将故障诊断单元发送的指令传递给容错控制策略单元;将横摆角速度计算单元得出的理想横摆角速度与实际横摆角速度差值信号及路面干扰侧向风干扰信号发送给双机容错补偿控制单元;
ECU控制模块与采集单元、双机执行单元、转向盘总成分别连接,所述ECU控制模块包括运算控制器(7)和容错控制器(18),运算控制器(7)包括电机故障诊断单元、电子控制单元;容错控制器(18)包括容错控制策略单元,横摆角速度计算单元,稳定性控制单元,双电机容错补偿单元;ECU控制模块接收来自采集单元的信号,经过计算后把相应的指令传输给双机执行单元进行动作;
容错控制器(18)根据电机故障诊断单元传来的信号,对于不同的电机故障,通过主动容错及故障缓解的方式进行相应的容错补偿控制策略;横摆角速度计算单元根据采集单元传送的方向盘转角信号、车速信号计算出理想的横摆角速度信号,再根据理想的横摆角速度信号与实际的横摆角速度信号计算出所需调整的理想横摆角速度差值,并把横摆角速度差值传递给稳定性控制单元;稳定性控制单元根据横摆角速度计算单元传递的横摆角速度差值得出补偿转矩并传递给双机容错补偿单元;双机容错补偿单元接收稳定性控制单元传递的补偿转矩信号,并且根据容错控制策略单元的容错策略,通过转矩电机控制器(16)控制转矩电机(13)动作;
转向盘总成包括转向盘(1)、转向柱(2)、路感电机(3),路感电机控制器(6),转向盘(1)通过转向杆柱(2)与路感电机(3)及转向盘转角传感器(4)相连接,转向盘力矩传感器(5)安装在转向杆柱(2)上,路感电机控制器(6)连接路感电机(3)及转向盘力矩传感器(5),控制路感电机(3)的运行;
双机执行单元包括转角电机控制器(8),转角电机(10),双极减速器(11),转矩电机控制器(16),转矩电机(13),减速器(14),齿轮齿条机构(15),前轮(17);
齿轮齿条机构(15)与转角电机(10)、转矩电机(13)、双极减速器(11)、减速器(14)分别连接,前轮(17)安装在齿轮齿条机构(15)的两侧,前轮转角传感器(9)安装在前轮(17)上,前轮转角传感器(9)与前轮力矩传感器(12)连接总线,将转角电机控制器(8)及转矩电机控制器(16)的信号输入到总线中,再通过总线传输到容错控制器(18)中;转角电机(10)及双极减速器(11)分别连接转角电机控制器(8);转矩电机(13)及减速器(14)连接转矩电机控制器(16),转矩电机控制器(16)控制转矩电机(13)及减速器(14)的运行;容错控制器(18)的输出端分别与路感电机控制器(6)的输入端和总线相连接;容错控制器(18)接收前轮力矩传感器(12),前轮转角传感器(9),转向盘力矩传感器(5),运算控制器(7)传递的信号,并将指令传送给转角电机控制器(8)及转矩电机控制器(16)。
2.根据权利要求1所述的方法,其特征在于,步骤1中,所述电机故障诊断单元,包括通过Kalman滤波器实现转角电机和转矩电机电阻,电流,电压的在线辨识:
其中:对于离散线性***:
x(k)=Ax(k-1)+B(u(k)+w(k)) (4)
yv(k)=Cx(k)+v(k) (5)
式(4)、(5)中,x(k)为k时刻的***状态,x(k-1)为k-1时刻的***状态,A,B是***参数,u(k)是k时刻对***的控制量,w(k)为过程噪声信号,v(k)为测量噪声信号,yv(k)是***k时刻的测量值,C是矩阵;
离散卡尔曼滤波递推算法为:
Mn(k)=P(k)CT/[CP(k)CT+R] (6)
P(k)=AP(k-1)AT+BQBT (7)
P(k)=(En-Mn(k)C)P(k) (8)
x(k)=Ax(k-1)+Mn(k)(yv(k)-CAx(k-1)) (9)
ye(k)=Cx(k) (10)
式(6)-(10)中x(k)时k时刻的***状态,x(k-1)时k-1时刻的***状态,A,B,R是***参数,C是矩阵,AT是A矩阵的转置矩阵,BT是B矩阵的转置矩阵,CT是C矩阵的转置矩阵,ye(k)是经过卡尔曼滤波器修正后的输出信号,P(k)是***k时刻的协方差,P(k-1)是***k-1时刻的协方差,En是单位向量,Mn(k)是中间变量;
En为单位向量,则***误差的协方差errcov(k)为:
errcov(k)=CP(k)CT (11)
式(11)中,errcov(k)是***误差的协方差,C是矩阵,CT是C矩阵的转置矩阵,P(k)是***k时刻的协方差;
根据基尔霍夫电压定律,构建转角电机与转矩电机的回路模型:
转角电机电学方程为:
Figure FDA0004088705180000041
式(12)中:L为转角电机电感;R2为转角电机电阻;kb2为电动势常数;u2是转角电机的输入电压,
Figure FDA0004088705180000042
是转角电机的电流,
Figure FDA0004088705180000043
是转角电机转角加速度,kb2是转角电机的刚度;
转矩电机电学方程为:
Figure FDA0004088705180000044
式中:L为转矩电机电感;R3为转矩电机电阻;kb3为电动势常数;u3是转矩电机的输入电压,ia3是转矩电机的电流,
Figure FDA0004088705180000045
是转矩电机转角加速度,kb3是转角电机的刚度。
3.根据权利要求2所述的方法,其特征在于,步骤2中形所述主动容错策略1,或主动容错策略2,或故障缓解策略1,或故障缓解策略2的流程包括:
1)当转角电机与转矩电机全部正常工作时,两个电机共同作用,控制前轮转角,以及汽车横摆角速度,此时无需容错策略;两个电机正常工作下,齿条运动分析如下:
齿条的运动微分方程为:
Figure FDA0004088705180000046
式中:mrack为齿条的质量;yrack为齿条的位移;rL为主销轴的偏置;KL为转向拉杆刚度;Brack为齿条阻尼系数;Ffrrack为***间的摩擦力,G为双减速器机构的减速比;Tg2是转角电机的输出转矩;Tg3是转矩电机的输出转矩;
Figure FDA0004088705180000047
为齿条加速度,
Figure FDA0004088705180000048
为齿条的运动速度;δf为转向前轮转角;
车轮的运动微分方程为:
Figure FDA0004088705180000051
式(15)中:Jw为前轮的转动惯量;Tfrkp为摩擦力矩;Bkp主销的阻尼系数;
Figure FDA0004088705180000052
转向前轮的转角加速度,
Figure FDA0004088705180000053
为转向前轮角速度,MZ为车轮的回正力矩;
2)当转角电机正常,转矩电机半正常,***进行故障缓解策略1,转角电机主要进行汽车横摆角速度控制,而转矩电机补偿横摆角速度控制器反馈回来的补偿扭矩ΔT1
对综合ΔT1=ΔT11+ΔT21+ΔT31      (16)
其中ΔT1使总的补偿转矩,ΔT11使弥补横摆角速度差值所需的补偿转矩,ΔT21路面干扰形成的补偿转矩,ΔT31***摩擦形成的补偿转矩;
Figure FDA0004088705180000054
式(17)中,mrack为齿条的质量;yrack为齿条的位移;rL为主销轴的偏置;KL为转向拉杆刚度;Brack为齿条阻尼系数;Ffrrack为***间的摩擦力,G为双减速器机构的减速比;Tg2是转角电机的输出转矩;Tg3是转矩电机的输出转矩;
3)当转角电机半正常,转矩电机正常,采用故障缓解策略2,转矩电机充当转角电机功能进行主要控制,转角电机充当转矩电机功能,进行补偿横摆角速度控制器反馈回来的补偿扭矩ΔT2
对综合ΔT2=ΔT12+ΔT22+ΔT32      (18)
其中ΔT2使总的补偿转矩,ΔT12使弥补横摆角速度差值所需的补偿转矩,ΔT22路面干扰形成的补偿转矩,ΔT32***摩擦形成的补偿转矩;
Figure FDA0004088705180000055
4)当转角电机正常,转矩电机全故障,采用主动容错策略1,切断转矩电机电流输入,转角电机单独控制,进行补偿横摆角速度控制器反馈回来的补偿扭矩ΔT3
对其综合ΔT3=ΔT13+ΔT23+ΔT33                              (20)
其中ΔT3使总的补偿转矩,ΔT13使弥补横摆角速度差值所需的补偿转矩,ΔT23路面干扰形成的补偿转矩,ΔT33***摩擦形成的补偿转矩;
Figure FDA0004088705180000056
式(21)中,mrack为齿条的质量;yrack为齿条的位移;rL为主销轴的偏置;KL为转向拉杆刚度;Brack为齿条阻尼系数;Ffrrack为***间的摩擦力,G为双减速器机构的减速比;
5)当转角电机全故障,转矩电机正常,采用主动容错策略2,切断转角电机电流输入,转矩电机单独控制,转矩电机充当转角电机功能,进行补偿横摆角速度控制器反馈回来的补偿扭矩ΔT4
对其综合ΔT4=ΔT14+ΔT24+ΔT34        (22)
其中ΔT4使总的补偿转矩,ΔT14使弥补横摆角速度差值所需的补偿转矩,ΔT24路面干扰形成的补偿转矩,ΔT34***摩擦形成的补偿转矩;
Figure FDA0004088705180000061
4.根据权利要求2所述的方法,其特征在于,步骤4中,所述μ综合鲁棒控制器的控制框架包括:
a)横摆角速度跟踪,||Z1||2=||W1r *r)||2    (24)
其中,W1为加权函数,通常设置成低通滤波器W1=k1(as+b)/(cs+d)    (25)
式(24)(25)中,||Z1||2式被控对象的评价输出的2范数,ωr *是理想横摆角速度值,ωr是实际汽车横摆角速度值,W1为加权函数,a,s,b,a,d是低通滤波器的参数;
μ综合鲁棒控制器输出相应的补偿扭矩并且把补偿转矩ΔT传递给双机补偿单元;
b)补偿反馈,稳定性控制:ΔT=ΔT1+ΔT2+ΔT3    (26)
其中ΔT使总的补偿转矩,ΔT1使弥补横摆角速度差值所需的补偿转矩,ΔT2路面干扰形成的补偿转矩,ΔT3***摩擦形成的补偿转矩。
CN201811549717.6A 2018-12-18 2018-12-18 基于线控转向双电机的主动容错和故障缓解***及其控制方法 Active CN109733464B (zh)

Priority Applications (3)

Application Number Priority Date Filing Date Title
CN201811549717.6A CN109733464B (zh) 2018-12-18 2018-12-18 基于线控转向双电机的主动容错和故障缓解***及其控制方法
US17/258,378 US20210269087A1 (en) 2018-12-18 2019-11-06 Active Fault Tolerance and Fault Mitigation System Based on Steer-by-wire with Dual Motors and Control Method Therefor
PCT/CN2019/116041 WO2020125249A1 (zh) 2018-12-18 2019-11-06 基于线控转向双电机的主动容错和故障缓解***及其控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201811549717.6A CN109733464B (zh) 2018-12-18 2018-12-18 基于线控转向双电机的主动容错和故障缓解***及其控制方法

Publications (2)

Publication Number Publication Date
CN109733464A CN109733464A (zh) 2019-05-10
CN109733464B true CN109733464B (zh) 2023-04-25

Family

ID=66360535

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201811549717.6A Active CN109733464B (zh) 2018-12-18 2018-12-18 基于线控转向双电机的主动容错和故障缓解***及其控制方法

Country Status (1)

Country Link
CN (1) CN109733464B (zh)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2020125249A1 (zh) * 2018-12-18 2020-06-25 南京航空航天大学 基于线控转向双电机的主动容错和故障缓解***及其控制方法
CN110329248B (zh) * 2019-06-18 2021-02-19 南京航空航天大学 一种脑机交互的线控智能转向***及其紧急避障方法
CN110758550B (zh) * 2019-10-11 2021-08-06 南京航空航天大学 线控双电机耦合转向***的能量优化方法
CN111017010B (zh) * 2020-01-03 2023-11-07 南京航空航天大学 一种双电机智能线控转向***及同步控制方法
CN111422249B (zh) * 2020-04-16 2023-01-03 芜湖汽车前瞻技术研究院有限公司 后轮转向控制方法、装置和计算机存储介质
CN112977602B (zh) * 2021-02-04 2022-04-08 南京航空航天大学 一种双电机线控转向***及其混合鲁棒稳定性控制方法
CN113086000B (zh) * 2021-04-30 2022-04-08 哈尔滨工业大学 一种线控转向***齿条力容错估计方法
CN114454950B (zh) * 2021-12-30 2022-12-23 南京航空航天大学 一种双电机线控转向***及其容错控制方法
CN114454951B (zh) * 2021-12-30 2022-12-06 南京航空航天大学 一种双电机线控转向***及其卷积神经网络容错控制方法

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002166844A (ja) * 2000-12-01 2002-06-11 Toyoda Mach Works Ltd 電動パワーステアリング装置の制御装置
DE10204955A1 (de) * 2001-02-06 2002-08-08 Bosch Gmbh Robert Verfahren zur Positionsregelung eines elektrischen Antriebs und zum Lenken eines Kraftfahrzeugs mit einer Steer-by-Wire-Lenkung
JP6187042B2 (ja) * 2013-08-29 2017-08-30 株式会社ジェイテクト 電動パワーステアリング装置
CN103587576B (zh) * 2013-12-06 2015-09-02 中国石油大学(华东) 一种电动汽车线控转向***及控制方法
CN105667577B (zh) * 2015-12-30 2018-02-06 南京航空航天大学 带有传感器信号容错功能的线控转向***及控制方法
CN105774902B (zh) * 2016-03-08 2018-02-06 南京航空航天大学 一种带有容错功能的汽车动力转向控制装置及控制方法
CN107512305B (zh) * 2017-08-08 2019-08-27 南京汽车集团有限公司 线控转向***及其稳定性控制方法

Also Published As

Publication number Publication date
CN109733464A (zh) 2019-05-10

Similar Documents

Publication Publication Date Title
CN109733464B (zh) 基于线控转向双电机的主动容错和故障缓解***及其控制方法
WO2020125249A1 (zh) 基于线控转向双电机的主动容错和故障缓解***及其控制方法
CN105667577B (zh) 带有传感器信号容错功能的线控转向***及控制方法
CN109291991B (zh) 一种双电机线控复合转向***及其控制方法
CN109808764A (zh) 一种具备冗余功能的线控转向装置及控制方法
CN109606379B (zh) 一种分布式驱动无人驾驶车辆路径跟踪容错控制方法
CN105774902B (zh) 一种带有容错功能的汽车动力转向控制装置及控制方法
CN111717278B (zh) 一种电动汽车转向失效的容错控制方法及***
US9783227B2 (en) Vehicle steering device
WO2016059903A1 (ja) 電動パワーステアリング装置
JP6493571B2 (ja) 電動パワーステアリング装置
CN109850003B (zh) 一种蓄能式线控转向***及容错控制方法
CN114454950B (zh) 一种双电机线控转向***及其容错控制方法
Zheng et al. Fault tolerant steer-by-wire road wheel control system
CN112519793A (zh) 一种基于数字孪生的智能线控底盘架构及其主动容错方法
CN105164001A (zh) 确定交通工具的转向柱的转向角度的机动交通工具、***和方法
CN112519873A (zh) 一种四轮独立线控转向电动汽车执行机构主动容错控制算法及***
KR101480252B1 (ko) 4륜구동 독립제어 조향시스템의 고장대처장치 및 방법
CN116573037A (zh) 一种双绕组分布式线控转向***及其容错控制方法
CN205381303U (zh) 带有传感器信号容错功能的线控转向***
CN114043995A (zh) 无人驾驶车辆自主转向***的容错装置及容错控制方法
CN111062088B (zh) 一种四轮独立驱动电动汽车参考车速容错自适应估计方法
CN111497867A (zh) 考虑驾驶员转向特性的线控转向***容错策略
CN115384528A (zh) 一种集中式底盘域控制架构及方法
CN110920747A (zh) 一种主动转向***电机转向装置及转角助力扭矩估算方法

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