CN113086000B - A fault-tolerant estimation method for rack force of steer-by-wire system - Google Patents
A fault-tolerant estimation method for rack force of steer-by-wire system Download PDFInfo
- Publication number
- CN113086000B CN113086000B CN202110485757.4A CN202110485757A CN113086000B CN 113086000 B CN113086000 B CN 113086000B CN 202110485757 A CN202110485757 A CN 202110485757A CN 113086000 B CN113086000 B CN 113086000B
- Authority
- CN
- China
- Prior art keywords
- observer
- rack
- motor
- steering
- feedback
- 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
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D5/00—Power-assisted or power-driven steering
- B62D5/04—Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear
- B62D5/0457—Power-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/046—Controlling the motor
- B62D5/0463—Controlling the motor calculating assisting torque from the motor based on driver input
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D5/00—Power-assisted or power-driven steering
- B62D5/04—Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear
- B62D5/0457—Power-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/0481—Power-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 monitoring the steering system, e.g. failures
- B62D5/049—Power-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 monitoring the steering system, e.g. failures detecting sensor failures
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D6/00—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
- B62D6/008—Control of feed-back to the steering input member, e.g. simulating road feel in steer-by-wire applications
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
技术领域technical field
本发明涉及一种线控转向系统齿条力容错估计方法,属于汽车线控转向技术领域。The invention relates to a rack force error-tolerant estimation method of a wire-controlled steering system, and belongs to the technical field of automobile wire-controlled steering.
背景技术Background technique
线控转向技术作为转向操纵自动化的硬件基础,取消了转向机构与转向盘之间的机械连接,使用电信号进行信息的双向传递:驾驶员输入的转向盘转角指令通过车载网络传递给电子控制单元,电子控制单元接收到控制指令进而控制转向执行机构完成驾驶员的转向意图;同时传感器将路面反馈的有关信息传递给电子控制单元,电子控制单元计算出路感反馈力矩后控制路感反馈电机输出对应大小的力矩,完成路感反馈。Steering-by-wire technology, as the hardware basis of steering automation, cancels the mechanical connection between the steering mechanism and the steering wheel, and uses electrical signals to transmit information in both directions: the steering wheel angle command input by the driver is transmitted to the electronic control unit through the in-vehicle network. , the electronic control unit receives the control command and then controls the steering actuator to complete the driver's steering intention; at the same time, the sensor transmits the relevant information of the road feedback to the electronic control unit, and the electronic control unit calculates the road sense feedback torque and controls the road sense feedback motor output corresponding to The size of the torque, complete the road sense feedback.
线控转向系统的搭建包含两个关键技术:一个是转向随动控制,即车轮的转角跟踪控制,其难点在于路面作用于轮胎产生的回正力矩是不易测量的干扰,会影响跟踪控制的精度;另一个是路感的规划与模拟,在传统的机械转向系统中路感可以理解为车轮的回正力矩通过机械传动装置传递给驾驶员的阻力矩,其中包含了整车运动及轮胎受力的状态信息,该信息通过机械连接传递给驾驶员,帮助驾驶员判断汽车运行状态和路面环境,而在线控转向系统中取消了转向系统的机械连接,路感需要在电子控制单元中综合各类传感器信号计算得出,其难点在于如何模拟出接近传统机械转向系统的路感。The construction of the steer-by-wire system includes two key technologies: one is the steering follow-up control, that is, the wheel angle tracking control. The difficulty lies in the fact that the realigning moment generated by the road surface acting on the tire is an interference that is not easy to measure, which will affect the accuracy of the tracking control. ; The other is the planning and simulation of road feel. In the traditional mechanical steering system, road feel can be understood as the resistance torque transmitted by the wheel's return torque to the driver through the mechanical transmission device, which includes the movement of the whole vehicle and the force on the tires. Status information, which is transmitted to the driver through a mechanical connection to help the driver judge the running state of the car and the road environment, while the mechanical connection of the steering system is canceled in the steer-by-wire system, and the road sense needs to integrate various sensors in the electronic control unit The signal calculation shows that the difficulty lies in how to simulate the road feeling close to the traditional mechanical steering system.
齿条力作为轮胎回正力矩通过转向拉杆作用于齿条的力,既是影响转角跟踪控制精度的干扰,也是包含路感信息被用于生成路感反馈力矩的重要部分,因此被广泛研究,现有的对齿条力进行测量和估计的方法如下:The rack force is the force acting on the rack through the steering rod as the tire aligning torque, which is not only the interference that affects the accuracy of the corner tracking control, but also an important part of the road feeling information used to generate the road feeling feedback torque, so it has been widely studied. Some methods of measuring and estimating rack force are as follows:
公开日为2020年03月24日,公开号为CN110901761A,名称为《线控转向系统和用于估计线控转向系统的齿条力的方法》的韩国发明专利,公开了通过转向执行电机转角传感器和齿条位移传感器测量出的减速器前端和后端的齿条位置差来计算减速器受力,进而通过动力学模型计算出齿条力。该方法的缺点是对传感器精度要求高,估计效果对传动机构的刚度参数变化敏感,传动机构的刚度无法准确测量,受材料使用时间等多种因素影响,刚度参数的变化会导致齿条力计算失真。The publication date is March 24, 2020, the publication number is CN110901761A, and the Korean invention patent titled "Steer-by-wire system and method for estimating the rack force of the steer-by-wire system" discloses a steering-actuated motor rotation angle sensor Calculate the force of the reducer by using the rack position difference between the front end and the rear end of the reducer measured by the rack displacement sensor, and then calculate the rack force through the dynamic model. The disadvantage of this method is that it requires high accuracy of the sensor, the estimation effect is sensitive to the change of the stiffness parameter of the transmission mechanism, the stiffness of the transmission mechanism cannot be accurately measured, and is affected by various factors such as the use time of the material, and the change of the stiffness parameter will lead to the calculation of the rack force. distortion.
公开日为2020年01月21日,公开号为CN110712676A,名称为《转向系统的齿条力估计》的美国发明专利,公开了通过对轮胎建模,估计横向速度,计算滑移角进而计算轮胎横向受力,得到齿条力。该方法的缺点是对模型的依赖较强,轮胎拖距无法准确测量,导致齿条力估计的精度较低。The publication date is January 21, 2020, the publication number is CN110712676A, and the US invention patent titled "Rack Force Estimation of Steering System" discloses that by modeling tires, estimating lateral velocity, calculating slip angle and then calculating tires The lateral force is applied to obtain the rack force. The disadvantage of this method is that it has a strong dependence on the model, and the tire trail cannot be accurately measured, resulting in a low accuracy of rack force estimation.
公开日为2019年10月08日,公开号为CN110304135A,名称为《转向系统的齿条力估计》的中国发明专利,公开了将齿条力作为转向执行机构的干扰进行建模,引入非线性的增益函数完成观测器的设计。该观测器收敛速度快、实时性好,可以满足在复杂工况下对齿条力估计的需求。该方法的不足是其模型仅有一个自由度,对实际物理系统的动力学描述不够精准,观测器的观测效果受制于单一转角传感器,若转角传感器出现故障,则会严重影响齿条力的估计效果。The publication date is October 8, 2019, the publication number is CN110304135A, and the Chinese invention patent titled "Rack Force Estimation of Steering System" discloses that the rack force is used as the interference of the steering actuator to model, and the nonlinearity is introduced. The gain function of , completes the design of the observer. The observer has fast convergence speed and good real-time performance, and can meet the requirements of rack force estimation under complex working conditions. The disadvantage of this method is that its model has only one degree of freedom, and the dynamic description of the actual physical system is not accurate enough. The observation effect of the observer is limited by a single rotation angle sensor. If the rotation angle sensor fails, it will seriously affect the estimation of the rack force. Effect.
发明内容SUMMARY OF THE INVENTION
为解决背景技术中存在的问题,本发明提供一种线控转向系统齿条力容错估计方法。In order to solve the problems existing in the background art, the present invention provides a method for estimating fault tolerance of the rack force of a steering-by-wire system.
实现上述目的,本发明采取下述技术方案:一种线控转向系统齿条力容错估计方法,所述估计方法包括如下步骤:To achieve the above object, the present invention adopts the following technical scheme: a method for estimating fault tolerance of rack force of a steering-by-wire system, the estimation method comprises the following steps:
S1:构建转向执行机构的动力学建模,并确定线控转向系统的状态空间;S1: Construct the dynamic modeling of the steering actuator and determine the state space of the steer-by-wire system;
S2:设计扩张干扰观测器,估计广义齿条力;S2: Design an expanded disturbance observer to estimate the generalized rack force;
S3:基于稳定性理论设计扩张干扰观测器的反馈增益;S3: Design the feedback gain of the extended disturbance observer based on stability theory;
S4:给出线控转向系统齿条力容错估计方法。S4: A fault-tolerant estimation method for the rack force of the steer-by-wire system is given.
与现有技术相比,本发明的有益效果是:Compared with the prior art, the beneficial effects of the present invention are:
1、本发明在转向执行机构建模中设置了两个自由度,相比于现有技术中的单自由度模型更精确,同时两个自由度也为观测器的容错机制提供了设计基础。1. The present invention sets two degrees of freedom in the modeling of the steering actuator, which is more accurate than the single-degree-of-freedom model in the prior art, and at the same time, the two degrees of freedom also provide a design basis for the fault-tolerant mechanism of the observer.
2、本发明中同时使用电机转角、齿条位移和电机输出转矩观测齿条力的方法,融合了仅靠电机转角、电机输出转矩观测齿条力和仅靠所述齿条位移、电机输出转矩观测齿条力两种方法的优点:精度高、受所述电机转矩波动影响小。2. In the present invention, the method of observing the rack force by using the motor rotation angle, the rack displacement and the motor output torque at the same time combines the observation of the rack force only by the motor rotation angle, the motor output torque and the measurement of the rack force only by the rack displacement and the motor output torque. The advantages of the two methods of output torque observation of rack force: high precision and little influence by the motor torque fluctuation.
3、本发明提升了齿条力估计的可靠性,提供了观测器故障容错的策略:当电机转角传感器发生故障时,给出了仅使用齿条位移和电机输出转矩为输入的齿条力观测器;当齿条位移传感器发生故障时,给出了仅使用电机转角和所述电机输出转矩为输入的齿条力观测器。3. The invention improves the reliability of rack force estimation, and provides a fault-tolerant strategy for the observer: when the motor rotation angle sensor fails, the rack force using only the rack displacement and the motor output torque as input is given. Observer; when the rack displacement sensor fails, a rack force observer using only the motor rotation angle and the output torque of the motor is given.
4、转向随动控制和路感模拟都对系统的实时性有较高要求,本发明设计的观测器收敛速度快,对广义齿条力的估计实时性好,因此该广义齿条力不仅可以在转向随动控制中被用于设计前馈控制器以提高转角跟踪的精度,还可以在路感模拟中被用于设计反馈路感。4. Both steering follow-up control and road feel simulation have high requirements on the real-time performance of the system. The observer designed in the present invention has fast convergence speed and good real-time performance for estimating the generalized rack force. Therefore, the generalized rack force can not only It is used to design a feedforward controller in steering follow-up control to improve the accuracy of corner tracking, and can also be used to design feedback road feel in road feel simulation.
5、本发明中设计的观测器还可以实现对所述转向执行电机转角、转速以及所述齿条位移、速度的观测。5. The observer designed in the present invention can also realize the observation of the rotation angle and rotational speed of the steering execution motor, as well as the displacement and speed of the rack.
附图说明Description of drawings
图1是本发明的线控转向系统的结构示意图;1 is a schematic structural diagram of a steering-by-wire system of the present invention;
图2是扩张干扰观测器原理图;Fig. 2 is the principle diagram of the expansion disturbance observer;
图3是观测器容错机制运行流程图;Figure 3 is a flow chart of the operation of the observer fault tolerance mechanism;
图4是观测器容错机制中三种观测器的示意图;Figure 4 is a schematic diagram of three observers in the observer fault tolerance mechanism;
图5是转角阶跃输入下三种观测器对于给定广义齿条力的观测效果曲线;Fig. 5 is the observation effect curve of three kinds of observers for a given generalized rack force under the step input of rotation angle;
图6是双移线性路线输入下三种观测器对于给定广义齿条力的观测效果曲线。Figure 6 is the observation effect curve of three kinds of observers for a given generalized rack force under the double-shift linear route input.
具体实施方式Detailed ways
下面将结合本发明实施例中的附图,对本发明中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅是发明的一部分实施例,而不是全部的实施例,基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。The technical solutions in the present invention will be clearly and completely described below with reference to the accompanying drawings in the embodiments of the present invention. Obviously, the described embodiments are only a part of the embodiments of the present invention, rather than all the embodiments, based on the present invention The embodiments in the present invention, all other embodiments obtained by those of ordinary skill in the art without creative work, fall within the protection scope of the present invention.
一种线控转向系统齿条力容错估计方法,所述线控转向系统包括转向执行机构、路感反馈机构以及对转向执行机构和路感反馈机构进行协调控制的控制器12;所述转向执行机构包括转向执行电机5、转向执行电机减速器6、转矩转角传感器一7、位移传感器8、小齿轮9、齿条10以及车轮11;所述路感反馈机构包括转向盘1、转矩转角传感器二2、路感反馈电机减速器3以及路感反馈电机4;A method for estimating rack force fault tolerance of a steering-by-wire system, the steering-by-wire system includes a steering actuator, a road-sensing feedback mechanism, and a
所述转向执行电机5的输出轴通过转向执行电机减速器6与小齿轮9连接,并设有转矩转角传感器一7,所述小齿轮9与齿条10啮合连接,所述齿条10上设有位移传感器8,并与车轮11连接;The output shaft of the
所述路感反馈电机4的输出轴通过路感反馈电机减速器3与转向盘1连接,并设有转矩转角传感器二2;The output shaft of the road
其特征在于:所述估计方法包括如下步骤:It is characterized in that: the estimation method comprises the following steps:
S1:构建转向执行机构的动力学建模,并确定线控转向系统的状态空间;S1: Construct the dynamic modeling of the steering actuator and determine the state space of the steer-by-wire system;
对转向执行机构进行建模,将其描述为拥有两自由度的二阶系统,其中齿条结构和转向执行电机轴视为刚体,忽略电机轴上的摩擦损耗,所述动力学的微分方程为:Model the steering actuator and describe it as a second-order system with two degrees of freedom, in which the rack structure and the steering actuator motor shaft are regarded as rigid bodies, ignoring the friction loss on the motor shaft, the differential equation of the dynamics is :
其中,in,
Jm是转向执行电机5的转子和减速器等效到电机轴上的转动惯量;J m is the moment of inertia equivalent to the motor shaft of the rotor and the reducer of the
是转向执行电机5转子的角加速度; is the angular acceleration of the
Bm是转向执行电机5和转向执行电机减速器6的粘性阻尼系数;B m is the viscous damping coefficient of the
是转向执行电机5转子的旋转角速度; is the rotational angular velocity of the rotor of the
Km是转向执行电机5的扭转刚度;K m is the torsional stiffness of the
θm是转向执行电机5转子的转角速度;θ m is the angular speed of the rotor of the
Gm是转向执行电机减速器6减速比;G m is the reduction ratio of the steering
Xr是齿条10的横向位移;X r is the lateral displacement of the
rp是小齿轮9的分度圆半径;r p is the indexing circle radius of the
Tm是转向执行电机5的输出转矩;T m is the output torque of the
mr是齿条10的质量;m r is the mass of the
是齿条10的加速度; is the acceleration of the
Br是齿条10的阻尼;B r is the damping of the
是齿条10的速度; is the speed of the
Ff,r是齿条10运动时受到的摩擦力;F f,r is the friction force received by the
Fr是齿条10运动时受到的转向拉杆的力。 Fr is the force of the steering rod received when the
所述线控转向系统状态空间的确定,包括如下步骤:The determination of the state space of the steer-by-wire system includes the following steps:
S101:忽略电机运行中的摩擦转矩Tf,m,同时将齿条运动时受到的摩擦力Ff,r和受到的转向拉杆力Fr之和作为广义齿条力Fe,即系统中需要进行估计的部分,并假设其一阶微分有界:S101: Ignore the friction torque T f,m during the operation of the motor, and at the same time take the sum of the friction force F f,r and the steering rod force F r received during the movement of the rack as the generalized rack force F e , that is, in the system The part that needs to be estimated, assuming its first derivative is bounded:
Fe=Fr+Ff,r;F e =F r +F f,r ;
S102:定义状态变量x1=θm、x3=Xr、输出y1=θm、y3=Xr,则线控转向系统状态空间为:S102: Define the state variable x 1 =θ m , x 3 =X r , Output y 1 =θ m , y 3 =X r , the state space of the steer-by-wire system is:
基于表达式(2)设计的线控转向系统的扩张干扰观测器的状态空间描述如下:The state space of the extended disturbance observer of the steer-by-wire system based on expression (2) is described as follows:
式中,In the formula,
Z1、Z2、Z3、Z4、Z5和Z6为观测器反馈增益:Z 1 , Z 2 , Z 3 , Z 4 , Z 5 and Z 6 are the observer feedback gains:
其中,in,
α1、α2、α3、β1、β2、β3和ε是可变(待设计)参数;α 1 , α 2 , α 3 , β 1 , β 2 , β 3 and ε are variable (to be designed) parameters;
和分别表示状态x1、x2、x3、x4和x5的估计值。 and represent the estimated values of states x 1 , x 2 , x 3 , x 4 and x 5 , respectively.
S2:设计扩张干扰观测器,估计广义齿条力;S2: Design an expanded disturbance observer to estimate the generalized rack force;
所述估计广义齿条力包括如下步骤:The estimating generalized rack force includes the following steps:
S201:将原系统的S101所述的广义齿条力Fe作为系统干扰d,定义为观测器系统的扩张状态x5,假设其一阶微分有界,满足S201: Take the generalized rack force Fe described in S101 of the original system as the system disturbance d, and define it as the expansion state x 5 of the observer system, assuming that its first-order differential is bounded, it satisfies
其中in
是系统干扰的一阶微分, is the first derivative of the system disturbance,
ξ是一个正数。ξ is a positive number.
S202:将原系统的输出y1和y3引入观测器系统,与观测器系统的状态和作用生成误差项,并乘以不同的观测器反馈增益之后作用于观测器的不同状态变量上。S202: Introduce the outputs y 1 and y 3 of the original system into the observer system, which is consistent with the state of the observer system and The action generates an error term, which is multiplied by different observer feedback gains and acts on different state variables of the observer.
S3:基于稳定性理论设计扩张干扰观测器的反馈增益;所述扩张干扰观测器的反馈增益包括如下步骤:S3: Design the feedback gain of the extended disturbance observer based on the stability theory; the feedback gain of the extended disturbance observer includes the following steps:
S301:给出扩张干扰观测器的估计误差方程如下:定义扩张干扰观测器的误差向量为 S301: The estimated error equation of the extended disturbance observer is given as follows: the error vector of the extended disturbance observer is defined as
其中:in:
S302:观测误差状态方程:其中: S302: Observation error state equation: in:
是误差向量对时间的一阶导数。 is the first derivative of the error vector with respect to time.
矩阵的特征方程写为:matrix The characteristic equation of is written as:
其中,λ为待求解的特征值,I为五阶单位矩阵;Among them, λ is the eigenvalue to be solved, and I is the fifth-order unit matrix;
利用劳斯判据得到观测器误差方程稳定的条件:The conditions under which the observer error equation is stable are obtained using the Rouse criterion:
其中:in:
当参数α1、α2、α3、β1、β2、β3和ε满足不等式(4)时,观测器误差方程稳定;When the parameters α 1 , α 2 , α 3 , β 1 , β 2 , β 3 and ε satisfy the inequality (4), the observer error equation is stable;
观测误差方程稳定则对于任意给定的正定阵Q,总能找到一个对称正定阵P满足以下李雅普诺夫方程:If the observation error equation is stable, for any given positive definite matrix Q, a symmetric positive definite matrix P can always be found to satisfy the following Lyapunov equation:
其中,为状态矩阵的转置;in, is the state matrix transpose of ;
观测器的李雅普诺夫函数可以被定义为:The Lyapunov function of the observer can be defined as:
V=εηTPηV=εη T Pη
其中ηT为误差向量η的转置。where η T is the transpose of the error vector η.
则对于V对时间的一阶导数有:Then for the first derivative of V with respect to time Have:
由李雅普诺夫稳定判据可知为负定,故有不等式:From the Lyapunov stability criterion, we know that is negative definite, so there is an inequality:
其中,λmin(Q)为Q的最小特征值,由此可得关于广义齿条力矩一阶微分的不等式:Among them, λ min (Q) is the minimum eigenvalue of Q, from which the inequality of the first-order differential of the generalized rack moment can be obtained:
由表达式(5)可得广义齿条力矩一阶微分的上界,为了保证系统渐进稳定,ε应尽量取小些。同时为了保证观测器系统的收敛速度,构造高增益的观测器,使观测器系统的动态特性远高于实际物理系统,也需要ε的取值尽量小。From the expression (5), the upper bound of the first-order differential of the generalized rack moment can be obtained. In order to ensure the asymptotic stability of the system, ε should be taken as small as possible. At the same time, in order to ensure the convergence speed of the observer system, a high-gain observer is constructed, so that the dynamic characteristics of the observer system are much higher than the actual physical system, and the value of ε is also required to be as small as possible.
S4:给出线控转向系统齿条力容错估计方法。S4: A fault-tolerant estimation method for the rack force of the steer-by-wire system is given.
所述给出线控转向系统齿条力容错估计方法如下:The fault-tolerant estimation method for the rack force of the steer-by-wire system is given as follows:
当转向执行电机5的转角传感器和齿条10的位移传感器8正常工作时,给出一种以电机转角差和齿条位移差为反馈信号的观测器,如图4中的(a)所示,称为电机转角-齿条位移观测器;When the rotation angle sensor of the
当转角传感器故障时,在正常系统观测器基础上屏蔽转角差信号,只使用齿条位移差构建反馈回路,形成新的观测器,如图4中的(b)所示,称为齿条位移观测器;When the rotation angle sensor fails, the rotation angle difference signal is shielded on the basis of the normal system observer, and only the rack displacement difference is used to construct a feedback loop to form a new observer, as shown in (b) in Figure 4, which is called rack displacement observer;
当位移传感器故障时,在正常系统观测器基础上屏蔽位移差信号,只使用电机转角差构建反馈回路,形成新的观测器,如图4中的(c)所示,称为电机转角观测器;When the displacement sensor fails, the displacement difference signal is shielded on the basis of the normal system observer, and only the motor angle difference is used to build a feedback loop to form a new observer, as shown in (c) in Figure 4, which is called the motor angle observer ;
当电机转角传感器和齿条位移传感器均出现故障时,系统报错,观测器无法估计齿条力;When both the motor angle sensor and the rack displacement sensor fail, the system reports an error, and the observer cannot estimate the rack force;
电机输出转矩Tm作为观测器的输入信号会引入大量杂波,对观测器的观测效果有一定的影响。由表达式(3)可知电机输出转矩Tm直接作用于电机角速度的微分,由此可知Tm对于系统两自由度中的电机转角影响较大,为了减弱其对观测器系统观测效果的影响,将α3设为零,即取消扩张状态x5中对应电机转角的部分,只设计α1、α2、β1、β2、β3和ε的参数。The output torque T m of the motor as the input signal of the observer will introduce a lot of clutter, which has a certain influence on the observation effect of the observer. From the expression (3), it can be known that the motor output torque T m directly acts on the motor angular velocity It can be seen that T m has a great influence on the motor rotation angle in the two degrees of freedom of the system. In order to weaken its influence on the observation effect of the observer system, α 3 is set to zero, that is, the corresponding motor rotation angle in the expansion state x 5 is cancelled. , only the parameters of α 1 , α 2 , β 1 , β 2 , β 3 and ε are designed.
当系统中的电机转角传感器出现故障无信号反馈,观测器输入变成齿条位移Xr和电机输出转矩Tm时,将α1、α2和α3设为零,观测器中的反馈项只有齿条位移测量值和估计值之差,需要设计的参数是β1、β2、β3和ε;When the motor rotation angle sensor in the system fails and has no signal feedback, and the observer input becomes the rack displacement X r and the motor output torque T m , set α 1 , α 2 and α 3 to zero, the feedback in the observer The item is only the difference between the measured value and the estimated value of the rack displacement, and the parameters to be designed are β 1 , β 2 , β 3 and ε;
当系统中的齿条位移传感器出现故障无信号反馈,观测器输入变成电机转角θm和电机输出转矩Tm时,将β1、β2和β3设为零,观测器中的反馈项只有电机转角测量值和估计值之差,观测器中需要设计的参数是α1、α2、α3和ε。When the rack displacement sensor in the system fails and has no signal feedback, and the observer input becomes the motor rotation angle θ m and the motor output torque T m , set β 1 , β 2 and β 3 to zero, the feedback in the observer The term is only the difference between the measured value and the estimated value of the motor rotation angle, and the parameters that need to be designed in the observer are α 1 , α 2 , α 3 and ε.
上述应对两种传感器故障的观测器设计只是为了保证出现对应故障情况时仍可以稳定输出广义齿条力的估计值,估计精度均逊色于使用齿条位移差和电机转角差作为反馈的完整观测器。The above observers designed to deal with the two sensor faults are only designed to ensure that the estimated value of the generalized rack force can be stably output when the corresponding fault occurs, and the estimation accuracy is inferior to that of the complete observer using the rack displacement difference and the motor angle difference as feedback. .
本发明利用多传感器的测量信息,即转向执行电机转角、齿条位移和电机输出转矩,结合表达式(3)即可实现对广义齿条力的估计,并提供了故障容错方法,提高了齿条力估计的精度,并且可以对电机转角、转速和齿条位移、速度信号进行估计。The invention utilizes the measurement information of multi-sensors, that is, the rotation angle of the steering execution motor, the displacement of the rack and the output torque of the motor, and combines the expression (3) to realize the estimation of the generalized rack force, and provides a fault tolerance method, which improves the The accuracy of rack force estimation, and can estimate the motor rotation angle, rotational speed and rack displacement and speed signals.
观测器使用齿条位移差和电机转角差作为反馈信号,然而电机转角传感器和齿条位移传感器可能出现故障影响观测器的观测效果:The observer uses the rack displacement difference and the motor rotation angle difference as feedback signals, however, the motor rotation angle sensor and the rack displacement sensor may fail to affect the observation effect of the observer:
电机转角传感器一般使用光电编码器或旋转变压器:光电编码器受环境影响大,因机械震动、温度、湿度大会发生误发脉冲或停止工作等问题,主控单元可以通过算法判断是否发生故障;旋转变压器的故障主要包括线路断路、电压信号异常等,出现故障时解码芯片会向主控单元报告。The motor angle sensor generally uses a photoelectric encoder or a resolver: the photoelectric encoder is greatly affected by the environment, due to mechanical vibration, temperature, humidity, and other problems such as false pulses or stop working, the main control unit can judge whether there is a fault through an algorithm; rotation; The faults of the transformer mainly include circuit breakage, abnormal voltage signal, etc. When a fault occurs, the decoding chip will report to the main control unit.
齿条位移传感器一般使用线位移传感器,线位移传感器可能出现线拉出后不回位导致输出数据无变化的问题或者线路断路导致无数据输出的问题,当车辆进行转向操作时检测到输出数据长时间不更新说明该传感器出现了故障。Rack displacement sensors generally use line displacement sensors. The line displacement sensor may have the problem that the output data does not change after the line is pulled out, or the line is disconnected, resulting in no data output. When the vehicle is steering, it detects that the output data is long. If the time does not update, the sensor is faulty.
为了减小电机转角传感器和齿条位移传感器出现故障时对广义齿条力估计的影响,设计齿条力容错估计方法:In order to reduce the influence on the generalized rack force estimation when the motor rotation angle sensor and the rack displacement sensor fail, a fault-tolerant estimation method for the rack force is designed:
当系统正常运行时,输入为所述电机转角θm、所述齿条位移Xr和所述电机输出转矩Tm,观测器中需要设计的参数是α1、α2、β1、β2、β3和ε,将α3设为零;当系统中的电机转角传感器出现故障时,观测器输入变成所述齿条位移Xr和所述电机输出转矩Tm,将α1、α2和α3设为零,观测器中需要设计的参数是β1、β2、β3和ε;当系统中的齿条位移传感器出现故障时,观测器输入变成所述电机转角θm和所述电机输出转矩Tm,将β1、β2和β3设为零,观测器中需要设计的参数是α1、α2、α3和ε。When the system is running normally, the input is the motor rotation angle θ m , the rack displacement X r and the motor output torque T m , and the parameters to be designed in the observer are α 1 , α 2 , β 1 , β 2 , β 3 and ε, set α 3 to zero; when the motor rotation angle sensor in the system fails, the observer input becomes the rack displacement X r and the motor output torque T m , set α 1 , α 2 and α 3 are set to zero, and the parameters to be designed in the observer are β 1 , β 2 , β 3 and ε; when the rack displacement sensor in the system fails, the observer input becomes the motor rotation angle θ m and the motor output torque T m , β 1 , β 2 and β 3 are set to zero, and the parameters to be designed in the observer are α 1 , α 2 , α 3 and ε.
实施例1:Example 1:
根据转向执行机构的设计要求并结合预期的仿真运行结果,设计仿真运行参数以及观测器的反馈增益。According to the design requirements of the steering actuator and combined with the expected simulation results, the simulation parameters and the feedback gain of the observer are designed.
设计的仿真运行相关参数如下:The designed simulation run related parameters are as follows:
Jm=0.001kg·m2,Bm=0.008N·m·s/rad,Km=132N·m/radJ m =0.001kg·m 2 , B m =0.008N·m·s/rad, K m =132N·m/rad
Gm=10,rp=6.11mm,mr=4.125kg,Br=4000N·s/m。G m =10, rp =6.11 mm, m r = 4.125 kg, and B r =4000 N·s/m.
电机转角-齿条位移观测器中的反馈增益:Feedback gain in motor angle-rack displacement observer:
α1=1,α2=10,β1=1,β2=10,β3=5,ε=0.001。α 1 =1, α 2 =10, β 1 =1, β 2 =10, β 3 =5, ε = 0.001.
齿条位移观测器中的反馈增益:Feedback gain in rack displacement observer:
β1=1,β2=10,β3=0.5,ε=0.001。β 1 =1, β 2 =10, β 3 =0.5, ε = 0.001.
电机转角观测器中的反馈增益:Feedback gain in the motor angle observer:
α1=1,α2=10,α3=1,ε=0.001。α 1 =1, α 2 =10, α 3 =1, ε = 0.001.
本实施例采用转向盘转角阶跃输入和双移线性路线输入验证本发明的估计效果。In this embodiment, the steering wheel angle step input and the double-shift linear route input are used to verify the estimation effect of the present invention.
图5为实施例提及的转向盘输入转角阶跃信号时,电机转角-齿条位移观测器、电机转角观测器、齿条位移观测器对给定输入广义齿条力的估计效果;图6为实施例提及的双移线性路线输入下,电机转角-齿条位移观测器、电机转角观测器、齿条位移观测器对给定输入广义齿条力的估计效果。Fig. 5 is the estimation effect of the motor angle-rack displacement observer, the motor angle observer, and the rack displacement observer to the given input generalized rack force when the steering wheel input angle step signal mentioned in the embodiment; Fig. 6 Under the input of the double-shift linear route mentioned in the embodiment, the estimated effect of the motor rotation angle-rack displacement observer, the motor rotation angle observer, and the rack displacement observer for a given input generalized rack force.
电机转角-齿条位移观测器在输入为转角阶跃信号时均方根误差为15.17,在输入为双移线性路线时均方根误差为38.91;电机转角观测器在输入为转角阶跃信号时均方根误差为15.26,在输入为双移线性路线时均方根误差为39.42;齿条位移观测器在输入为转角阶跃信号时均方根误差为62.67,在输入为双移线性路线时均方根误差为54.11。The root mean square error of the motor angle-rack displacement observer is 15.17 when the input is the angle step signal, and the root mean square error is 38.91 when the input is the double-shift linear route; the motor angle observer when the input is the angle step signal The root mean square error is 15.26, and the root mean square error is 39.42 when the input is a double-shift linear route; the root mean square error of the rack displacement observer is 62.67 when the input is a corner step signal, and when the input is a double-shift linear route The root mean square error is 54.11.
根据图4、图5曲线和均方根误差的结果可知:本实施例所设计的齿条力容错估计策略在正常运行时对齿条力的估计精度高、实时性好;在齿条位移传感器故障下使用单一电机转角信号进行反馈时,齿条力估计效果较好,实时性好,但在动态过程中有小幅度振荡;在电机转角传感器故障下使用单一齿条位移信号进行反馈时,齿条力估计结果有一定延迟。在出现传感器故障的情况下,容错估计的要求是可以维持转向系统的稳定,保证齿条力估计值的持续输出,因此对齿条力估计精度的要求放宽。综上,本发明提出的齿条力容错估计策略是有意义的。According to the curves of Fig. 4 and Fig. 5 and the results of the root mean square error, it can be seen that the rack force fault-tolerant estimation strategy designed in this embodiment has high estimation accuracy and real-time performance of rack force during normal operation; When a single motor angle signal is used for feedback under fault, the rack force estimation effect is good and the real-time performance is good, but there is a small amplitude oscillation in the dynamic process; when a single rack displacement signal is used for feedback under the fault of the motor angle sensor, the There is a certain delay in the bar force estimation results. In the case of sensor failure, the requirement of fault-tolerant estimation is to maintain the stability of the steering system and ensure the continuous output of the estimated value of the rack force, so the requirements for the accuracy of the rack force estimation are relaxed. In conclusion, the rack force fault-tolerant estimation strategy proposed by the present invention is meaningful.
当转向执行电机的转角传感器和齿条的位移传感器正常工作时,给出一种以电机转角差和齿条位移差为反馈信号的观测器;当转角传感器故障时,在正常系统观测器基础上屏蔽转角差信号,只使用齿条位移差构建反馈回路,并改变原观测器的反馈增益形成新的观测器;当位移传感器故障时,在正常系统观测器基础上屏蔽位移差信号,只使用电机转角差构建反馈回路,并改变原观测器的反馈增益形成新的观测器。When the rotation angle sensor of the steering actuator and the displacement sensor of the rack work normally, an observer is given which takes the motor rotation angle difference and the rack displacement difference as feedback signals; when the rotation angle sensor fails, based on the normal system observer Shield the angle difference signal, only use the rack displacement difference to build a feedback loop, and change the feedback gain of the original observer to form a new observer; when the displacement sensor fails, shield the displacement difference signal on the basis of the normal system observer, and only use the motor The angle difference builds a feedback loop and changes the feedback gain of the original observer to form a new observer.
本发明提供了一种理论成熟、精度高、可靠性强的齿条力容错估计方法,主要用于解决齿条力估计精读不足和在工程实现中可靠性差的问题。The invention provides a rack force fault-tolerant estimation method with mature theory, high precision and strong reliability, which is mainly used to solve the problems of insufficient precision reading of rack force estimation and poor reliability in engineering implementation.
对于本领域技术人员而言,显然本发明不限于上述示范性实施例的细节,而且在不背离本发明的精神或基本特征的情况下,能够以其他的形式实现本发明。因此,无论从哪一点来看,均应将实施例看作是示范性的,而且是非限制性的,本发明的范围由所附权利要求而不是上述说明限定,因此旨在将落在权利要求的等同条件的含义和范围内的所有变化囊括在本发明内。不应将权利要求中的任何附图标记视为限制所涉及的权利要求。It will be apparent to those skilled in the art that the present invention is not limited to the details of the above-described exemplary embodiments, but that the present invention may be embodied in other forms without departing from the spirit or essential characteristics of the invention. Therefore, the embodiments are to be regarded in all respects as illustrative and not restrictive, and the scope of the invention is to be defined by the appended claims rather than the foregoing description, which are therefore intended to fall within the scope of the claims. All changes within the meaning and range of the equivalents of , are embraced within the invention. Any reference signs in the claims shall not be construed as limiting the involved claim.
此外,应当理解,虽然本说明书按照实施方式加以描述,但并非每个实施方式仅包含一个独立的技术方案,说明书的这种叙述方式仅仅是为清楚起见,本领域技术人员应当将说明书作为一个整体,各实施例中的技术方案也可以经适当组合,形成本领域技术人员可以理解的其他实施方式。In addition, it should be understood that although this specification is described in terms of embodiments, not each embodiment only includes an independent technical solution, and this description in the specification is only for the sake of clarity, and those skilled in the art should take the specification as a whole , the technical solutions in each embodiment can also be appropriately combined to form other implementations that can be understood by those skilled in the art.
Claims (3)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110485757.4A CN113086000B (en) | 2021-04-30 | 2021-04-30 | A fault-tolerant estimation method for rack force of steer-by-wire system |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110485757.4A CN113086000B (en) | 2021-04-30 | 2021-04-30 | A fault-tolerant estimation method for rack force of steer-by-wire system |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113086000A CN113086000A (en) | 2021-07-09 |
CN113086000B true CN113086000B (en) | 2022-04-08 |
Family
ID=76681196
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110485757.4A Active CN113086000B (en) | 2021-04-30 | 2021-04-30 | A fault-tolerant estimation method for rack force of steer-by-wire system |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113086000B (en) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113998001B (en) * | 2021-11-05 | 2024-01-16 | 合肥工业大学 | Fault-tolerant controller for steering-by-wire of unmanned vehicle and design method thereof |
CN113815720B (en) * | 2021-11-05 | 2023-09-22 | 安徽奇米智能科技有限公司 | Design method of fault observer of steering-by-wire system of unmanned automobile |
CN113830168B (en) * | 2021-11-05 | 2023-09-22 | 安徽奇米智能科技有限公司 | Fault-tolerant control method and system for front wheel steering angle of vehicle based on fault estimation |
CN115042858B (en) * | 2022-05-05 | 2024-03-19 | 博世华域转向系统有限公司 | Steering system driver road feel feedback adjustment method based on dynamic rack force |
CN115285213B (en) * | 2022-08-18 | 2023-04-25 | 浙江极氪智能科技有限公司 | Road sense simulation method, system, equipment and storage medium |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8150582B2 (en) * | 2009-04-20 | 2012-04-03 | Ford Global Technologies, Llc | Systems and methods for decoupling steering rack force disturbances in electric steering |
CN101691124B (en) * | 2009-10-16 | 2012-06-27 | 重庆大学 | Method for controlling electronic power steering system of vehicle without sensor |
DE102017105370A1 (en) * | 2017-03-14 | 2018-09-20 | Thyssenkrupp Ag | Estimating rack power in a steer-by-wire system |
CN107140012B (en) * | 2017-05-10 | 2023-04-04 | 南京航空航天大学 | Steer-by-wire system based on Kalman filter capable of restraining divergence and control method |
US11046359B2 (en) * | 2017-09-25 | 2021-06-29 | Mando Corporation | Steer-by-wire system and control method thereof |
US12054204B2 (en) * | 2018-07-12 | 2024-08-06 | Steering Solutions Ip Holding Corporation | Rack force estimation for steering systems |
CN109733464B (en) * | 2018-12-18 | 2023-04-25 | 南京航空航天大学 | Active Fault Tolerance and Fault Mitigation System Based on Steering by Wire Dual Motors and Its Control Method |
CN110304135B (en) * | 2019-07-10 | 2021-08-06 | 上海交通大学 | A Rack Force Estimation Method for Steering-by-Wire System Based on Extended Disturbance Observer |
-
2021
- 2021-04-30 CN CN202110485757.4A patent/CN113086000B/en active Active
Also Published As
Publication number | Publication date |
---|---|
CN113086000A (en) | 2021-07-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113086000B (en) | A fault-tolerant estimation method for rack force of steer-by-wire system | |
CN109606378B (en) | A Vehicle Driving State Estimation Method for Non-Gaussian Noise Environment | |
CN105242676B (en) | A kind of finite time convergence control time-varying Sliding Mode Attitude control method | |
Hang et al. | Robust control for four-wheel-independent-steering electric vehicle with steer-by-wire system | |
CN103488092B (en) | Diagnose and fault tolerant control method based on the satellite failure of T-S fuzzy model with study observer | |
CN103363993B (en) | A kind of aircraft angle rate signal reconstructing method based on Unscented kalman filtering | |
CN104932510B (en) | A kind of Flexible Spacecraft control system for flywheel low speed friction and method | |
CN105196294B (en) | Reconfigurable mechanical arm decentralized control system and control method adopting position measuring | |
CN102506860B (en) | Inertial stabilization device based on acceleration feedback and feedforward and control method thereof | |
CN109204458B (en) | Steering angle tracking method for steering wheel of automatic driving automobile with unknown EPS (electric power steering) characteristics | |
Zou et al. | Fault diagnosis and fault-tolerant compensation strategy for wheel angle sensor of steer-by-wire vehicle via extended Kalman filter | |
CN108545081A (en) | Slip angle estimation method and system based on robust Unscented kalman filtering | |
CN110116409B (en) | Four-channel teleoperation bilateral control method based on disturbance observer | |
Hwang et al. | Practical synchronous steering angle control of a dual-motor driving steer-by-wire system | |
CN114030526B (en) | Vehicle active steering control method and system | |
CN105467996B (en) | Four-wheel steering automobile Trajectory Tracking Control method based on differential flat and active disturbance rejection | |
CN109426150B (en) | Load simulator backstepping control method based on extended state observer | |
CN103116275A (en) | Robust neural network control system for micro-electro-mechanical system (MEMS) gyroscope based on sliding mode compensation and control method of control system | |
CN110884499A (en) | Method and system for determining vehicle mass center slip angle | |
CN110441027B (en) | Correction method for controlling zero drift of probe automatic tracking system | |
Xu et al. | Vehicle stability and synchronization control of dual-motor steer-by-wire system considering multiple uncertainties | |
CN107450323A (en) | Hypersonic aircraft reentry stage neutral net Hybrid Learning control method | |
CN101624063A (en) | Vehicle electric power-assisted steering system of non-torque sensor | |
CN113859589A (en) | Spacecraft attitude control method based on model predictive control and sliding mode control | |
CN113998001B (en) | Fault-tolerant controller for steering-by-wire of unmanned vehicle and design method thereof |
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 |