CN105667577B - 带有传感器信号容错功能的线控转向***及控制方法 - Google Patents

带有传感器信号容错功能的线控转向***及控制方法 Download PDF

Info

Publication number
CN105667577B
CN105667577B CN201511024464.7A CN201511024464A CN105667577B CN 105667577 B CN105667577 B CN 105667577B CN 201511024464 A CN201511024464 A CN 201511024464A CN 105667577 B CN105667577 B CN 105667577B
Authority
CN
China
Prior art keywords
steering
signal
delta
front wheel
sensor
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
CN201511024464.7A
Other languages
English (en)
Other versions
CN105667577A (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 CN201511024464.7A priority Critical patent/CN105667577B/zh
Publication of CN105667577A publication Critical patent/CN105667577A/zh
Application granted granted Critical
Publication of CN105667577B publication Critical patent/CN105667577B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D5/00Power-assisted or power-driven steering
    • B62D5/04Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear
    • B62D5/0457Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear characterised by control features of the drive means as such
    • B62D5/046Controlling the motor

Landscapes

  • Engineering & Computer Science (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)
  • Power Steering Mechanism (AREA)

Abstract

本发明公开了一种带有信号容错功能的线控转向***及控制方法,属于汽车转向控制领域。在行驶过程中,通过采集前轮转角、横摆角速度、侧向加速度以及转向电机电流联合探测诊断传感器故障情况,如果传感器发生故障,则通过其他传感器信号估计补偿得到,控制汽车转向。通过实时探测诊断传感器故障情况,在发生故障时能够在线进行信号重构,补偿故障信号,作为信号输入,对驾驶员的转向指令做出准确的响应,对转向电机进行鲁棒控制,提高线控转向***的可靠性和汽车行驶时的稳定性和安全性。

Description

带有传感器信号容错功能的线控转向***及控制方法
技术领域
本发明涉及汽车一种线控转向***,具体讲是一种带有传感器信号容错功能的线控转向***及控制方法,属于汽车转向控制领域。
背景技术
转向***是汽车的关键部件之一,它不仅能保证汽车能按驾驶员的意志进行转向行驶,还关系到汽车的操纵稳定性。如何合理地设计转向***,使汽车具有更好更稳定的操纵性,始终是设计人员研究的重要课题。在车辆高速化、驾驶人员非职业化、车流密集化的今天,针对更多不同水平的驾驶人群,汽车的易操纵性设计变得极为重要。线控转向***的发展正是迎合了这种客观需求,是继电动助力转向***后发展起来的新一代转向***。
汽车线控转向***形式不同于以往的转向***,它取消了以往转向***方向盘到前轮的机械连接,用控制信号控制汽车转向。它主要由方向盘模块、转向执行模块、主控制器、动力电源等组成,由于线控转向***的运行强烈依赖于传感器信号,其可靠性较传统转向***大大降低。目前,现有技术中所应用的线控转向***无法通过传感器配置方式和有效的重构算法能够实现传感器之间的信号互判和解析冗余,其控制***的可靠性和稳定性相对较差,并影响行车的安全性。此外,现有的车型中大多备有一套冗余的机械***,其不仅成本昂贵,不适用于经济车型的开发,而且造成不必要的浪费。
发明内容
本发明所要解决的技术问题在于克服现有技术缺陷,提供一种能提高线控转向***的可靠性、汽车行驶时的稳定性和安全性的带有传感器信号容错功能的线控转向***及控制方法。
为了解决上述技术问题,本发明提供的带有传感器信号容错功能的线控转向***,包括转向盘总成、方向盘转角传感器、路感电机及减速机构总成、转向电机及减速机构总成、车速传感器、侧向加速度传感器、横摆角速度传感器、前轮转角传感器、齿轮齿条转向器、路感控制单元、转向控制单元和容错控制单元;
所述转向盘总成连接路感电机及其减速机构总成,方向盘转角传感器分别与路感控制单元和转向控制单元连接;所述路感控制单元连接并控制路感电机及其减速机构;
所述转向电机及减速机构总成与齿轮齿条转向器连接,齿轮齿条转向器上安装前轮;所述前轮上安装前轮转角传感器,前轮转角传感器连接容错控制单元;所述转向控制单元连接转向电机及其减速机构;
所述侧向加速传感器、横摆角速度传感器均与容错控制单元连接;所述车速传感器分别与路感控制单元和转向控制单元相连;
所述容错控制单元分别与路感控制单元和转向控制单元相连,所述容错控制单元将侧向加速信号、横摆角速度信号传输到路感控制单元,将前轮转角信号传输到转向控制单元;所述转向控制单元将转向控制信号同时传输到容错控制单元、转向电机及其减速机构。
本发明还提供了上述带有传感器信号容错功能的线控转向***的控制方法,包括以下步骤:
1)、建立转向模块与整车数学模型,求取鲁棒控制器:
式中,δ为前轮转角;v为纵向车速;β为质心侧偏角;ω为横摆角速度;ay是汽车侧向加速度;L为汽车前后轴距;m为整车质量;b为质心到后轴轴距;a为质心到前轴轴距;K1、K2为前后轮侧偏刚度;Iz为整车绕z轴转动惯量;JR、BR为齿轮齿条***的等效转动惯量与阻尼;G为齿轮齿条转向器传动比;Kz为电机转矩系数;iz为电机减速器减速比;I为电机电流;
令***状态为***控制输入u=I、v=[1,0,0,0]x、G(s)为由δ到v的传递函数,ω=δ*,z1和z2为被调输出,W1、W2为相对应的加权函数,z=[z1;z2],P(s)为广义受控对象,y为测量输出,K为控制器,设计如下的鲁棒控制***:
选择z的H2范数作为目标函数求取鲁棒控制***的控制器K;
2)、转向控制单元通过方向盘转角传感器、车速传感器采集到方向盘转角θ以及车速信号v,根据变传动比规律(4)得到汽车该时刻的理想前轮转角δ:
式中,i为转向***传动比;θ为转向盘转角;Ku为转向不足系数,计算如式(5);Ks为行驶角系数,范围为0.12-0.37 1/s:
将前轮转角传感器采集实时前轮转角信号,与求得的理想前轮转角δ做差,通过鲁棒控制器求得转向电机电流,输入到转向及减速机构总成,控制汽车转向;
3)、容错控制单元采集转向电机电流信号I、前轮转角信号δ、横摆角速度信号ω、侧向加速度信号ay:通过无迹卡尔曼滤波算法,由转向电机电流和横摆角速度估计得到前轮转角信号δ1,估计模型为:
由转向电机电流和侧向加速度估计得到前轮转角信号δ2,估计模型为:
通过δ、δ1、δ2相互做差判断故障源,|δ-δ1|>Δ时,s1设为1,否则为0;|δ12|>Δ,s2设为1,否则为0;|δ-δ2|>Δ,s3设为1,否则为0;标志向量S=[s1,s2,s3],通过标志值判断传感器是否发生故障,若S=[0,0,0],所有传感器正常;若S=[0,1,1],侧向加速度传感器故障;若S=[1,0,1],前轮转角传感器故障;若S=[1,1,0],横摆角速度传感器故障;
当前轮转角传感器故障时,通过式(7)使用侧向加速度信号和转向电机电流来重构故障信号;
当横摆角速度传感器故障时,通过式(2)和(7)使用侧向加速度信号和转向电机电流来重构故障信号;
当侧向加速度传感器故障时,通过式(2)和(6)使用横摆角速度信号和转向电机电流来重构故障信号。
本发明的有益效果在于:(1)、本发明通过采集前轮转角、横摆角速度、侧向加速度以及转向电机电流联合探测诊断各传感器故障情况,在传感器发生故障时能够在线进行信号重构,补偿故障信号,作为信号输入,对驾驶员的转向指令做出准确、快速的响应,对转向电机进行鲁棒控制,节省了使用硬件冗余容错的成本,提高线控转向***的可靠性、汽车行驶时的稳定性和安全性;(2)、避免在车辆中备置机械转向***,降低车辆制造成本,减少了资源的耗费。
附图说明
图1是本发明带有传感器信号容错功能的线控转向***结构示意图。
图2是本发明的控制原理图。
具体实施方式
下面结合附图对本发明作进一步详细说明。
如图1所示,本发明的带有传感器信号容错功能的线控转向***,包括由转向盘总成1、方向盘转角传感器2、路感电机及减速机构总成3、转向电机及减速机构总成4、车速传感器5、侧向加速度传感器6、横摆角速度传感器7、前轮8、前轮转角传感器9、齿轮齿条转向器10、转向控制单元11、容错控制单元12和路感控制单元13。转向盘总成1通过转向杆柱与路感电机及其减速机构总成2相连接,方向盘转角传感器2安装在转向杆柱上。路感控制单元13连接路感电机及其减速机构总成2,控制路感电机及其减速机构总成2的运行。方向盘转角传感器2分别连接路感控制单元13和转向控制单元11,将转向盘总成1的转向信号输入到路感控制单元13和转向控制单元11中。
转向电机及其减速机构总成4与齿轮齿条转向器10相连接,前轮8安装在齿轮齿条转向器10的两侧。前轮转角传感器9安装与前轮8上,前轮转角传感器9连接容错控制单元12,将前轮转角信号输入到容错控制单元12中。转向电机及其减速机构总成4连接转向控制单元11,转向控制单元11控制转向电机及其减速机构总成4的运行。
侧向加速传感器6和横摆角速度传感器7均与容错控制单元12连接,将采集到信号输入到容错控制单元12中。容错控制单元12的输出端分别与路感控制单元13的输入端和转向控制单元11的输入端相连接。容错控制单元12将横摆角速度信号和侧向加速度信号传输到路感控制单元13,另将前轮转角信号传输到转向控制单元11。
转向控制单元11产生的用于控制转向电机及其减速机构总成4运行的转向电机电流信号同时传输到容错控制单元12中。
如图2所示,本发明的线控转向***的控制过程,具体步骤如下:
(1)、建立转向模块与整车数学模型,求取鲁棒控制器:
转向模块与整车模型:
式中,δ为前轮转角;v为纵向车速;β为质心侧偏角;ω为横摆角速度;L为汽车前后轴距;ay是汽车侧向加速度;m为整车质量;b为质心到后轴轴距;a为质心到前轴轴距;K1、K2为前后轮侧偏刚度;Iz为整车绕z轴转动惯量;JR、BR为齿轮齿条***的等效转动惯量与阻尼;G为齿轮齿条转向器传动比;Kz为电机转矩系数;iz为电机减速器减速比;I为电机电流;
令***状态为***控制输入u=I、v=[1,0,0,0]x、G(s)为由δ到v的传递函数,ω=δ*,z1和z2为被调输出,W1、W2为相对应的加权函数,z=[z1;z2]。P(s)为广义受控对象,y为测量输出,K为控制器,设计如下的鲁棒控制***:
广义控制***
在线控转向控制过程中,要求使输出的前轮转角能够良好地跟踪理想前轮转角值,并且尽量节约能量,于此,选择z的H2范数作为目标函数求取***的鲁棒控制器K。
由于广义控制对象P(s)的H范数为求min||z||2即可变为求解控制器K,能使广义控制对象稳定且T||最小,则K即为广义控制对象P(s)的H控制器。
(2)、车辆行驶过程中,当驾驶员转动转向盘,转向控制单元通过方向盘转角传感器、车速传感器采集到方向盘转角θ以及车速信号v,根据变传动比规律式(4)得到汽车该时刻的理想前轮转角δ。通过前轮转角传感器采集实时前轮转角信号,与求得的理想前轮转角做差,通过上述鲁棒控制器求得转向电机电流,输入到转向电机及减速机构总成4,控制汽车转向:
式中,i为转向***传动比;θ为转向盘转角;Ku为转向不足系数,计算如式(5);Ks为行驶角系数,范围可根据驾驶员喜好选取,该范围为0.12-0.371/s
(3)、车辆行驶过程中,容错控制单元通过传感器采集转向电机电流信号I、前轮转角信号δ、横摆角速度信号ω、侧向加速度信号ay
通过无迹卡尔曼滤波算法,由转向电机电流和横摆角速度估计得到前轮转角信号δ1,估计模型为:
由转向电机电流和侧向加速度估计得到前轮转角信号δ2,估计模型为:
在不考虑多个传感器同时出现故障的小概率事件的前提下,通过δ、δ1、δ2相互做差判断故障源,Δ为判断阈值,超过阈值,对应的标志值设为1,没有超过则设为0;|δ-δ1|>Δ时,s1设为1,否则为0;|δ12|>Δ,s2设为1,否则为0;|δ-δ2|>Δ,s3设为1,否则为0;标志向量S=[s1,s2,s3],通过标志值判断传感器是否发生故障,若S=[0,0,0],所有传感器正常;若S=[0,1,1],侧向加速度传感器失效;若S=[1,0,1],前轮转角传感器失效;若S=[1,1,0],横摆角速度传感器失效。
当所有传感器正常时,传感器信号正常输出;当前轮转角传感器故障时,通过公式(7)使用侧向加速度信号和转向电机电流来重构故障信号;
当横摆角速度传感器故障时,通过公式(2)、(7)使用侧向加速度信号和转向电机电流来重构故障信号;
当侧向加速度传感器故障时,通过公式(2)、(6)使用横摆角速度信号和转向电机电流来重构故障信号,将得到的正确信号输入到上述的控制模块中,从而实现了一种带有传感器信号容错功能的线控转向***其控制方法。
无迹卡尔曼滤波是一套适用于计算机实现的实时递推算法,它处理的对象是随机信号,并且可以适用于非线性***,能够根据***数学模型对所需信号进行最优估计,排除噪声干扰,符合信号重构的要求,得到较好的应用。上述步骤(3)中的无迹卡尔曼滤波具体流程如下:
对于非线性离散***:
设定初值:
时间更新:
①k>1时,按式构造2n+1个sigma点,即
②计算预测sigma点,即
③计算预测sigma点的均值和方差,即
测量更新,当获得新的测量值z(k)后,利用以下公式对状态均值和方差进行更新,即
式中,
本发明的应用途径很多,以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进,这些改进也应视为本发明的保护范围。

Claims (1)

1.一种带有传感器信号容错功能的线控转向***的控制方法,其特征在于包括以下步骤:
1)、建立转向模块与整车数学模型,求取鲁棒控制器:
<mrow> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mover> <mi>&amp;delta;</mi> <mo>&amp;CenterDot;</mo> </mover> </mtd> </mtr> <mtr> <mtd> <mover> <mi>&amp;delta;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> </mtd> </mtr> <mtr> <mtd> <mover> <mi>&amp;beta;</mi> <mo>&amp;CenterDot;</mo> </mover> </mtd> </mtr> <mtr> <mtd> <mover> <mi>&amp;omega;</mi> <mo>&amp;CenterDot;</mo> </mover> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mfrac> <msub> <mi>K</mi> <mi>t</mi> </msub> <mrow> <msub> <mi>J</mi> <mi>R</mi> </msub> <msup> <mi>G</mi> <mn>2</mn> </msup> </mrow> </mfrac> </mtd> <mtd> <mrow> <mo>-</mo> <mfrac> <msub> <mi>B</mi> <mi>R</mi> </msub> <msub> <mi>J</mi> <mi>R</mi> </msub> </mfrac> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mfrac> <msub> <mi>K</mi> <mi>t</mi> </msub> <mrow> <msub> <mi>J</mi> <mi>R</mi> </msub> <msup> <mi>G</mi> <mn>2</mn> </msup> </mrow> </mfrac> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mfrac> <mrow> <msub> <mi>K</mi> <mi>t</mi> </msub> <mi>a</mi> </mrow> <mrow> <msub> <mi>J</mi> <mi>R</mi> </msub> <msup> <mi>G</mi> <mn>2</mn> </msup> <mi>v</mi> </mrow> </mfrac> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mfrac> <msub> <mi>K</mi> <mn>1</mn> </msub> <mrow> <mi>m</mi> <mi>v</mi> </mrow> </mfrac> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mfrac> <mrow> <msub> <mi>K</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>K</mi> <mn>2</mn> </msub> </mrow> <mrow> <mi>m</mi> <mi>v</mi> </mrow> </mfrac> </mtd> <mtd> <mrow> <mo>(</mo> <mfrac> <mrow> <msub> <mi>aK</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>bK</mi> <mn>2</mn> </msub> </mrow> <mrow> <msup> <mi>mv</mi> <mn>2</mn> </msup> </mrow> </mfrac> <mo>-</mo> <mn>1</mn> <mo>)</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mfrac> <mrow> <msub> <mi>aK</mi> <mn>1</mn> </msub> </mrow> <msub> <mi>I</mi> <mi>z</mi> </msub> </mfrac> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mfrac> <mrow> <msub> <mi>aK</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>bK</mi> <mn>2</mn> </msub> </mrow> <msub> <mi>I</mi> <mi>z</mi> </msub> </mfrac> </mtd> <mtd> <mfrac> <mrow> <msup> <mi>a</mi> <mn>2</mn> </msup> <msub> <mi>K</mi> <mn>1</mn> </msub> <mo>+</mo> <msup> <mi>b</mi> <mn>2</mn> </msup> <msub> <mi>K</mi> <mn>2</mn> </msub> </mrow> <mrow> <msub> <mi>I</mi> <mi>z</mi> </msub> <mi>v</mi> </mrow> </mfrac> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mi>&amp;delta;</mi> </mtd> </mtr> <mtr> <mtd> <mover> <mi>&amp;delta;</mi> <mo>&amp;CenterDot;</mo> </mover> </mtd> </mtr> <mtr> <mtd> <mi>&amp;beta;</mi> </mtd> </mtr> <mtr> <mtd> <mi>&amp;omega;</mi> </mtd> </mtr> </mtable> </mfenced> <mo>+</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mfrac> <mrow> <msub> <mi>K</mi> <mi>z</mi> </msub> <msub> <mi>i</mi> <mi>g</mi> </msub> </mrow> <mrow> <msub> <mi>J</mi> <mi>R</mi> </msub> <mi>G</mi> </mrow> </mfrac> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> </mtr> </mtable> </mfenced> <mi>I</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <msub> <mi>a</mi> <mi>y</mi> </msub> <mo>=</mo> <mfrac> <mrow> <msub> <mi>aK</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>bK</mi> <mn>2</mn> </msub> </mrow> <mrow> <mi>m</mi> <mi>v</mi> </mrow> </mfrac> <mi>&amp;omega;</mi> <mo>+</mo> <mfrac> <mrow> <msub> <mi>K</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>K</mi> <mn>2</mn> </msub> </mrow> <mi>m</mi> </mfrac> <mi>&amp;beta;</mi> <mo>-</mo> <mfrac> <msub> <mi>K</mi> <mn>1</mn> </msub> <mi>m</mi> </mfrac> <mi>&amp;delta;</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </mrow>
式中,δ为前轮转角;v为纵向车速;β为质心侧偏角;ω为横摆角速度;ay是汽车侧向加速度;L为汽车前后轴距;m为整车质量;b为质心到后轴轴距;a为质心到前轴轴距;K1、K2为前后轮侧偏刚度;Iz为整车绕z轴转动惯量;JR、BR为齿轮齿条***的等效转动惯量与阻尼;G为齿轮齿条转向器传动比;Kz为电机转矩系数;iz为电机减速器减速比;I为电机电流;
令***状态为***控制输入u=I、v=[1,0,0,0]x、G(s)为由δ到v的传递函数,ω=δ*,z1和z2为被调输出,W1、W2为相对应的加权函数,z=[z1;z2],P(s)为广义受控对象,y为测量输出,K为控制器,设计如下的鲁棒控制***:
<mrow> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mi>z</mi> <mn>1</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>z</mi> <mn>2</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mi>y</mi> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mi>P</mi> <mrow> <mo>(</mo> <mi>s</mi> <mo>)</mo> </mrow> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mi>W</mi> <mn>1</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>W</mi> <mn>2</mn> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mi>G</mi> <mrow> <mo>(</mo> <mi>s</mi> <mo>)</mo> </mrow> <mi>W</mi> <mn>2</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mi>I</mi> </mtd> <mtd> <mrow> <mo>-</mo> <mi>G</mi> <mrow> <mo>(</mo> <mi>s</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msup> <mi>&amp;delta;</mi> <mo>*</mo> </msup> </mtd> </mtr> <mtr> <mtd> <mi>I</mi> </mtd> </mtr> </mtable> </mfenced> <mo>,</mo> <mi>u</mi> <mo>=</mo> <mi>K</mi> <mi>y</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </mrow>
选择z的H2范数作为目标函数求取鲁棒控制***的控制器K;
2)、转向控制单元通过方向盘转角传感器、车速传感器采集到方向盘转角θ以及车速信号v,根据变传动比规律(4)得到汽车该时刻的理想前轮转角δ:
<mrow> <mi>i</mi> <mo>=</mo> <mfrac> <mi>&amp;theta;</mi> <mi>&amp;delta;</mi> </mfrac> <mo>=</mo> <mfrac> <mi>v</mi> <mrow> <msub> <mi>K</mi> <mi>s</mi> </msub> <mrow> <mo>(</mo> <mi>L</mi> <mo>+</mo> <msub> <mi>K</mi> <mi>u</mi> </msub> <msup> <mi>v</mi> <mn>2</mn> </msup> <mo>)</mo> </mrow> </mrow> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>4</mn> <mo>)</mo> </mrow> </mrow>
式中,i为转向***传动比;θ为转向盘转角;Ku为转向不足系数,计算如式(5);Ks为行驶角系数,范围为0.12-0.37 1/s:
<mrow> <msub> <mi>K</mi> <mi>u</mi> </msub> <mo>=</mo> <mfrac> <mrow> <mi>m</mi> <mrow> <mo>(</mo> <msub> <mi>bK</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>aK</mi> <mn>1</mn> </msub> <mo>)</mo> </mrow> </mrow> <mrow> <msub> <mi>K</mi> <mn>1</mn> </msub> <msub> <mi>K</mi> <mn>2</mn> </msub> <mi>L</mi> </mrow> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>5</mn> <mo>)</mo> </mrow> </mrow>
将前轮转角传感器采集实时前轮转角信号,与求得的理想前轮转角δ做差,通过鲁棒控制器求得转向电机电流,输入到转向及减速机构总成,控制汽车转向;
3)、容错控制单元采集转向电机电流信号I、前轮转角信号δ、横摆角速度信号ω、侧向加速度信号ay:通过无迹卡尔曼滤波算法,由转向电机电流和横摆角速度估计得到前轮转角信号δ1,估计模型为:
<mrow> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mover> <mi>&amp;delta;</mi> <mo>&amp;CenterDot;</mo> </mover> </mtd> </mtr> <mtr> <mtd> <mover> <mi>&amp;delta;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> </mtd> </mtr> <mtr> <mtd> <mover> <mi>&amp;beta;</mi> <mo>&amp;CenterDot;</mo> </mover> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mfrac> <msub> <mi>K</mi> <mi>t</mi> </msub> <mrow> <msub> <mi>J</mi> <mi>R</mi> </msub> <msup> <mi>G</mi> <mn>2</mn> </msup> </mrow> </mfrac> </mtd> <mtd> <mrow> <mo>-</mo> <mfrac> <msub> <mi>B</mi> <mi>R</mi> </msub> <msub> <mi>J</mi> <mi>R</mi> </msub> </mfrac> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mfrac> <msub> <mi>K</mi> <mi>t</mi> </msub> <mrow> <msub> <mi>J</mi> <mi>R</mi> </msub> <msup> <mi>G</mi> <mn>2</mn> </msup> </mrow> </mfrac> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mfrac> <msub> <mi>K</mi> <mn>1</mn> </msub> <mrow> <mi>m</mi> <mi>v</mi> </mrow> </mfrac> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mfrac> <mrow> <msub> <mi>K</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>K</mi> <mn>2</mn> </msub> </mrow> <mrow> <mi>m</mi> <mi>v</mi> </mrow> </mfrac> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mi>&amp;delta;</mi> </mtd> </mtr> <mtr> <mtd> <mover> <mi>&amp;delta;</mi> <mo>&amp;CenterDot;</mo> </mover> </mtd> </mtr> <mtr> <mtd> <mi>&amp;beta;</mi> </mtd> </mtr> </mtable> </mfenced> <mo>+</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mfrac> <mrow> <msub> <mi>K</mi> <mi>z</mi> </msub> <msub> <mi>i</mi> <mi>g</mi> </msub> </mrow> <mrow> <msub> <mi>J</mi> <mi>R</mi> </msub> <mi>G</mi> </mrow> </mfrac> </mtd> <mtd> <mrow> <mo>-</mo> <mfrac> <mrow> <msub> <mi>K</mi> <mi>t</mi> </msub> <mi>a</mi> </mrow> <mrow> <msub> <mi>J</mi> <mi>R</mi> </msub> <mi>G</mi> <mi>v</mi> </mrow> </mfrac> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>(</mo> <mfrac> <mrow> <msub> <mi>aK</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>bK</mi> <mn>2</mn> </msub> </mrow> <mrow> <msup> <mi>mv</mi> <mn>2</mn> </msup> </mrow> </mfrac> <mo>-</mo> <mn>1</mn> <mo>)</mo> </mrow> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mi>I</mi> </mtd> </mtr> <mtr> <mtd> <mi>&amp;omega;</mi> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>6</mn> <mo>)</mo> </mrow> </mrow>
由转向电机电流和侧向加速度估计得到前轮转角信号δ2,估计模型为:
<mrow> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mover> <mi>&amp;delta;</mi> <mo>&amp;CenterDot;</mo> </mover> </mtd> </mtr> <mtr> <mtd> <mover> <mi>&amp;delta;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> </mtd> </mtr> <mtr> <mtd> <mover> <mi>&amp;beta;</mi> <mo>&amp;CenterDot;</mo> </mover> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mfrac> <msub> <mi>K</mi> <mi>t</mi> </msub> <mrow> <msub> <mi>J</mi> <mi>R</mi> </msub> <msup> <mi>G</mi> <mn>2</mn> </msup> </mrow> </mfrac> <mrow> <mo>(</mo> <mfrac> <mrow> <msub> <mi>bK</mi> <mn>2</mn> </msub> </mrow> <mrow> <msub> <mi>aK</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>bK</mi> <mn>2</mn> </msub> </mrow> </mfrac> <mo>)</mo> </mrow> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mfrac> <msub> <mi>B</mi> <mi>R</mi> </msub> <msub> <mi>J</mi> <mi>R</mi> </msub> </mfrac> </mrow> </mtd> <mtd> <mrow> <mfrac> <msub> <mi>K</mi> <mi>t</mi> </msub> <mrow> <msub> <mi>J</mi> <mi>R</mi> </msub> <msup> <mi>G</mi> <mn>2</mn> </msup> </mrow> </mfrac> <mrow> <mo>(</mo> <mfrac> <mrow> <mo>(</mo> <mi>a</mi> <mo>+</mo> <mi>b</mi> <mo>)</mo> <msub> <mi>K</mi> <mn>2</mn> </msub> </mrow> <mrow> <msub> <mi>aK</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>bK</mi> <mn>2</mn> </msub> </mrow> </mfrac> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mfrac> <mrow> <msub> <mi>K</mi> <mn>1</mn> </msub> <mi>v</mi> </mrow> <mrow> <msub> <mi>aK</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>bK</mi> <mn>2</mn> </msub> </mrow> </mfrac> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mfrac> <mrow> <mo>(</mo> <msub> <mi>K</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>K</mi> <mn>2</mn> </msub> <mo>)</mo> <mi>v</mi> </mrow> <mrow> <msub> <mi>aK</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>bK</mi> <mn>2</mn> </msub> </mrow> </mfrac> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mi>&amp;delta;</mi> </mtd> </mtr> <mtr> <mtd> <mover> <mi>&amp;delta;</mi> <mo>&amp;CenterDot;</mo> </mover> </mtd> </mtr> <mtr> <mtd> <mi>&amp;beta;</mi> </mtd> </mtr> </mtable> </mfenced> <mo>+</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mfrac> <mrow> <msub> <mi>K</mi> <mi>z</mi> </msub> <msub> <mi>i</mi> <mi>g</mi> </msub> </mrow> <mrow> <msub> <mi>J</mi> <mi>R</mi> </msub> <mi>G</mi> </mrow> </mfrac> </mtd> <mtd> <mrow> <mo>-</mo> <mfrac> <mrow> <msub> <mi>amK</mi> <mi>t</mi> </msub> </mrow> <mrow> <mo>(</mo> <msub> <mi>aK</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>bK</mi> <mn>2</mn> </msub> <mo>)</mo> <msub> <mi>J</mi> <mi>R</mi> </msub> <msup> <mi>G</mi> <mn>2</mn> </msup> </mrow> </mfrac> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mfrac> <mn>1</mn> <mi>v</mi> </mfrac> <mo>-</mo> <mfrac> <mrow> <mi>m</mi> <mi>v</mi> </mrow> <mrow> <msub> <mi>aK</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>bK</mi> <mn>2</mn> </msub> </mrow> </mfrac> </mrow> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mi>I</mi> </mtd> </mtr> <mtr> <mtd> <msub> <mi>a</mi> <mi>y</mi> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>7</mn> <mo>)</mo> </mrow> </mrow>
通过δ、δ1、δ2相互做差判断故障源,|δ-δ1|>Δ时,s1设为1,否则为0;|δ12|>Δ,s2设为1,否则为0;|δ-δ2|>Δ,s3设为1,否则为0;标志向量S=[s1,s2,s3],通过标志值判断传感器是否发生故障,若S=[0,0,0],所有传感器正常;若S=[0,1,1],侧向加速度传感器故障;若S=[1,0,1],前轮转角传感器故障;若S=[1,1,0],横摆角速度传感器故障;
当前轮转角传感器故障时,通过式(7)使用侧向加速度信号和转向电机电流来重构故障信号;
当横摆角速度传感器故障时,通过式(2)和(7)使用侧向加速度信号和转向电机电流来重构故障信号;
当侧向加速度传感器故障时,通过式(2)和(6)使用横摆角速度信号和转向电机电流来重构故障信号。
CN201511024464.7A 2015-12-30 2015-12-30 带有传感器信号容错功能的线控转向***及控制方法 Active CN105667577B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201511024464.7A CN105667577B (zh) 2015-12-30 2015-12-30 带有传感器信号容错功能的线控转向***及控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201511024464.7A CN105667577B (zh) 2015-12-30 2015-12-30 带有传感器信号容错功能的线控转向***及控制方法

Publications (2)

Publication Number Publication Date
CN105667577A CN105667577A (zh) 2016-06-15
CN105667577B true CN105667577B (zh) 2018-02-06

Family

ID=56189837

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201511024464.7A Active CN105667577B (zh) 2015-12-30 2015-12-30 带有传感器信号容错功能的线控转向***及控制方法

Country Status (1)

Country Link
CN (1) CN105667577B (zh)

Families Citing this family (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106184350B (zh) * 2016-07-08 2018-11-09 南京航空航天大学 一种多模式的四轮转向***及转向模式控制方法
CN106706345A (zh) * 2016-11-25 2017-05-24 合肥工业大学 一种线控转向***路感模拟硬件在环仿真平台及仿真方法
CN107054453A (zh) * 2017-04-28 2017-08-18 南京航空航天大学 一种汽车转向稳定性控制***及其控制方法
CN107140012B (zh) * 2017-05-10 2023-04-04 南京航空航天大学 一种基于可抑制发散的卡尔曼滤波器的线控转向***及控制方法
CN107512305B (zh) * 2017-08-08 2019-08-27 南京汽车集团有限公司 线控转向***及其稳定性控制方法
DE102018217352A1 (de) * 2018-10-10 2020-04-16 Conti Temic Microelectronic Gmbh Aktorvorrichtung sowie Verfahren zur Kompensation eines magnetischen Streufeldes bei einer Aktorvorrichtung
CN109733464B (zh) * 2018-12-18 2023-04-25 南京航空航天大学 基于线控转向双电机的主动容错和故障缓解***及其控制方法
CN109664938B (zh) * 2018-12-29 2023-12-01 南京航空航天大学 基于驾驶员行为辨识的线控转向双电机***及其横摆稳定性补偿策略
CN110816654B (zh) * 2019-08-08 2021-03-09 中国第一汽车股份有限公司 一种信号估计方法、装置、车辆和存储介质
CN111516755A (zh) * 2020-04-22 2020-08-11 东风汽车集团有限公司 一种方向盘转角信号校准方法和转角零位确认方法
CN113147892B (zh) * 2021-05-11 2022-04-08 浙江吉利控股集团有限公司 一种转向传动机构安全预警方法、***及车辆
CN113562066B (zh) * 2021-07-20 2022-09-09 浙江万安科技股份有限公司 一种线控转向***及故障诊断方法
CN113525512A (zh) * 2021-08-20 2021-10-22 京东鲲鹏(江苏)科技有限公司 基于自适应控制的车辆转向控制方法、装置、电子设备
CN114104096A (zh) * 2021-11-23 2022-03-01 合肥工业大学智能制造技术研究院 一种用于线控转向***的转向管柱转角传感器故障判断方法
CN115257911B (zh) * 2022-08-26 2023-12-29 上海集度汽车有限公司 线控转向控制***、方法、车辆及存储介质

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101596915A (zh) * 2009-07-10 2009-12-09 奇瑞汽车股份有限公司 一种基于线控的汽车转向***
CN102673569A (zh) * 2012-05-25 2012-09-19 同济大学 车辆状态测算装置、方法及使用该装置的车辆
CN205381303U (zh) * 2015-12-30 2016-07-13 南京航空航天大学 带有传感器信号容错功能的线控转向***

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE10052343A1 (de) * 2000-10-21 2002-07-11 Bosch Gmbh Robert Verfahren zum Steuern eines Steerby-Wire-Lenksystems

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101596915A (zh) * 2009-07-10 2009-12-09 奇瑞汽车股份有限公司 一种基于线控的汽车转向***
CN102673569A (zh) * 2012-05-25 2012-09-19 同济大学 车辆状态测算装置、方法及使用该装置的车辆
CN205381303U (zh) * 2015-12-30 2016-07-13 南京航空航天大学 带有传感器信号容错功能的线控转向***

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
线控前轮转向控制策略及其容错研究;***;《工程科技Ⅱ辑》;20150115;线控前轮转向控制策略及其容错研究 *

Also Published As

Publication number Publication date
CN105667577A (zh) 2016-06-15

Similar Documents

Publication Publication Date Title
CN105667577B (zh) 带有传感器信号容错功能的线控转向***及控制方法
CN105774902B (zh) 一种带有容错功能的汽车动力转向控制装置及控制方法
CN109808764A (zh) 一种具备冗余功能的线控转向装置及控制方法
CN110775154B (zh) 一种电动卡车线控转向***及其网络不确定控制方法
CN105279309B (zh) 基于回正力矩估计的主动转向理想方向盘转矩设计方法
Zhang et al. Fault-tolerant control for intelligent electrified vehicles against front wheel steering angle sensor faults during trajectory tracking
CN106347449B (zh) 一种人机共驾型电动助力转向***及模式切换方法
CN103587576B (zh) 一种电动汽车线控转向***及控制方法
WO2020125249A1 (zh) 基于线控转向双电机的主动容错和故障缓解***及其控制方法
CN109733464B (zh) 基于线控转向双电机的主动容错和故障缓解***及其控制方法
CN108688719B (zh) 用于估算转向扭矩的***和方法
CN109159816B (zh) 一种线控四轮转向汽车及其控制方法
CN111645755B (zh) 一种控制方法和装置
CN114454950B (zh) 一种双电机线控转向***及其容错控制方法
CN102582626B (zh) 重型半挂车状态估计方法
CN107738691A (zh) 一种适时四驱复合转向***及其多目标优化方法
CN110329347B (zh) 一种基于驾驶员特性的转向控制***及其控制方法
US20150158525A1 (en) Methods and systems for aligning a steering system of a vehicle
CN108909828A (zh) 一种线控转向和制动***及其控制方法
CN205381303U (zh) 带有传感器信号容错功能的线控转向***
Gao et al. Dynamic modeling and steering performance analysis of active front steering system
CN111376971A (zh) 一种基于齿条力的路面识别及自适应方向盘力矩补偿方法
CN112026777B (zh) 一种车辆复合转向***及其模式切换控制方法
CN206871167U (zh) 一种基于参数估计的线控转向控制***
CN112026749B (zh) 一种线控转向***稳定性控制方法

Legal Events

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