The invention relates to the field of vehicle safety control, and in particular to a static output feedback control method for forklift stability control and a storage medium.
In the field of active safety technology for forklifts, although the anti-rollover system is becoming increasingly perfect, fault-tolerant control technology for sensor failures in the anti-rollover system of counterbalanced forklifts has not yet been applied. If a sensor failure occurs in the forklift anti-rollover system, the system cannot normally receive the required forklift operating information, and the system will lose its operating state during operation. At the same time, the safety and stability of the forklift during driving cannot be guaranteed. Therefore, fault-tolerant control of the forklift anti-rollover system is essential.
The present invention proposes a static output feedback control method for forklift stability control and a storage medium, which can solve the above technical disadvantages.
In order to achieve the above objects, the present invention provides the following technical solutions:
A static output feedback control method for forklift stability control, comprising the following steps:
Further, the singular observer is used to simultaneously estimate the system state {circumflex over (
wherein in formula (1-2), v(t)∈Rn+p is an auxiliary state vector of the observer; {circumflex over (
Further, formula (1-3) is used to construct the generalized observer H(t)∈L2, and a norm of L2 is defined as:
Further, formula (1-4) is used to construct a residual generator rd(t).
Further, formula (1-5) is used to design a control law of the reconfigured static output feedback controller:
In formula (1-5), Ki is an output feedback gain to be determined; yc(t) is a compensation output; ĥ(t) is an estimated system output; l=[0 IP].
In another aspect, the present invention also discloses a computer readable storage medium storing a computer program, when the computer program is executed by a processor, the processor performs the steps of the method.
It can be seen from the above technical solutions that the static output feedback control method for forklift stability control and the storage medium of the present invention are expected to improve the fault tolerance of the counterbalanced forklift anti-rollover system, thereby ensuring the stability of the forklift anti-rollover system and improving the active safety of forklifts. Specifically, when a sensor fails, the proposed state observer can estimate the sensor output signal and fault state, and the fault signal can be accurately received, and the output signal can be compensated and output in time according to the static output feedback control method. Then the system is minimally affected by sensor failure, ensuring the effectiveness of most functions of the controller.
Compared with the prior art, the beneficial effects of the present invention are:
To make the purpose, technical solutions and advantages of the embodiments of the present invention clearer, the technical solutions in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are only some of the embodiments of the present invention, rather than all the embodiments.
The static output feedback control method for forklift stability control described in this embodiment is shown in
The following are detailed descriptions respectively, and the continuous-time fuzzy system model is designed according to the following steps:
In the formula, αf and αr are the side slip angles of the front and rear tires of the forklift, respectively. In addition, for the parameters Di, Li, Gi and Vi(i=f,r) in the above formula, their values are influenced by many factors, the key ones include traveling speed, wheel adhesion, and wheel force characteristics.
If |αf| belong to M2, then:
In formulas (2-3) and (2-4), Cfi(i=1, 2) and Cri(i=1, 2) are the cornering stiffness of the front and rear tires, respectively, and their values are affected by many factors, including tire width, load mass, wheel adhesion and vehicle speed.
In formula (2-5), λi(|αf|)(i=1, 2) is a weighting function about variables |αf═, this weighting function satisfies the following properties: 0≤λi(|αf|)≤1 and Σi=12λi(∥αf|)=1.
In formula (2-6) xc(t)=[β {dot over (β)} ω φ]T, u(t)=F(t), w(t)=[δr φb]T and z(t)=[LTR] are the state, control input, interference input and control output of the above system model, respectively. The correlation matrix is as follows:
Step 15. An extended description system can be constructed for the counterbalanced forklift anti-rollover sensor failure system:
In the counterbalanced forklift anti-rollover fault system, the normal operation of the controller is crucial. Sensor failure will cause the sensor input signal of the controller to deviate, and in severe cases, there may even be no signal input. Therefore, if the sensor fails and its fault signal can be accurately received and an output compensation is performed in time to the output signal according to the controller, the controller will not be affected by the sensor failure and the normal operation of the controller is ensured.
In a specific embodiment, in order to estimate the state and fault of the system at the same time, a singular observer structure is designed as follows:
In formula (1-2), v(t)∈Rn+p is an auxiliary state vector of the singular observer of the system, {circumflex over (
Sensor failure and unknown interference are assumed in the system model. In order to study the fault estimation and state estimation of the forklift anti-rollover sensor failure system model under continuous time, various general situations will be analyzed.
In a specific embodiment, there is a generalized observer H(t)∈L2, a norm of L2 is defined as:
In the above situation, the design task of the generalized observer is to generate a residual signal that is as sensitive to faults as possible and insensitive to disturbances, thereby making fault diagnosis robust. In fact, the problem caused by residuals can be studied by L2 control (extending the control problem H∞ to nonlinear situations.)
In a specific embodiment, the residual signal generator is designed as follows:
To this end, the following theorem is proposed:
Theorem 1: If there exist positive definite symmetric matrices P11, P12, Pi2, and matrix N1, N2 and positive scalar η, then the state observer (1-2) can estimate the system state and sensor fault, and under the following LMI constraints (see (2-8)) the scalar γ is minimized.
In formula (2-9), two free matrices Ω∈Rn·p and ∈Rp·p can be used to obtain a non-singular matrix E:
Assuming Df has a complete column rank, a sensor estimated value can be obtained through the above method, while ensuring the integrity of the fault estimated value.
In order to achieve fault-tolerant control for the forklift anti-rollover sensor fault-tolerant system, a static output feedback controller is designed for sensor faults and external interference. As shown in
In a specific embodiment, the static output feedback controller is designed as following steps:
In formula (2-13) Ki is an output feedback gain to be determined in the i-th local model, and yc(t) represents a compensation output, which is defined as:
The goal of static output feedback is to control dynamic systems using only knowledge of measurable signals. Therefore, the decision variables are required to depend only on the control input signal u(t), actual output signal y(t), and ultimately rely on measurable state variables. In the case of unmeasurable premise variables, it is still possible to design a stable static output feedback controller. In the structural calculation of the fault-tolerant control law below, both the state derived in the observer and the sensor fault signal estimation are considered.
Step 52. analyzing the stability of the closed-loop system, wherein the system state estimation error e(t)=
By substituting the static output feedback control law (2-13) into the above formula, a conclusion can be drawn as follows:
Adding and subtracting (
In formula (2-18) Fij=Sj+(
The entire model is rewritten in a state space representation using the following formula:
An augmented state vector is defined:
The following closed loop system is obtained:
Lemma 1: Considering two real matrices of appropriate dimensions X, Y as well as F(t), for any scalar δ, the following inequality is proved:
Lemma 2: If there is a symmetric positive definite matrix P11, P12, P2i, matrix Q1, Q2 and positive scalar ψ, and δi, i=1, . . . , 7 satisfy the following conditions for i, j=1, 2, . . . , r and i≠j, the fault-tolerant control system of the forklift anti-rollover sensor based on the singular observer is asymptotically stable.
min ψ (2-23)
W
ii<0 (2-24)
wherein
Then through the above formula (2-9) Ω and the following formula , the observer gain is obtained.
To obtain non-conservative conditions, the following non-quadratic Lyapunov function is used:
In the above formula Λi=diag[P1 P2i], wherein P1, P2i are symmetric positive definite matrices. A closed-loop system with fault-tolerant control is stable, and if {dot over (V)}(xa(t))+eT(t)e(t)−η2dT(t)d(t)<0, η can limit the gain L2 from d(t) to e(t). The derivative of Lyapunov function V(xa(t)) is expressed as:
This condition is negative definite, if
wherein
In formula (2-36);
Using the lemma 1 proposed above, there is a positive scalar δi, i=1, . . . , 7
let:
In formula (2-38);
Applying Schur's complement on BMI items Ξij11, Ξij22 and Ξij33, wherein the sufficient linear matrix inequality condition proposed in Theorem 2 is established.
For the forklift anti-rollover sensor fault-tolerant system, the above-mentioned effective control strategy is designed so that the forklift anti-rollover system can still ensure a stability of the entire system in case of sensor failure. In this section, numerical simulations are performed to demonstrate the effectiveness and applicability of the proposed method to a forklift anti-rollover sensor fault-tolerant system. The T-S model constructed in the previous article is used to construct an observer, which represents a forklift anti-rollover sensor fault-tolerant system with premise variables that depend on unmeasurable state variables. In the design, the complete vehicle parameters of the forklift considered are shown in the table 1.
The output behavior of the system affected by fault signals f(t)=(fa(t),fb(t))T is considered and described as follows:
For the forklift anti-rollover system, a gyro sensor is used. The gyro sensor can only measure the yaw angular velocity of the forklift. The proposed observer is used to estimate the lateral speed to solve the optimization problem under the linear matrix inequality constraints in the above theorem (2), resulting in the observer and controller gain matrices for the following nominal attenuation levels ψ=0.843.
As an embodiment of the present invention,
For the case of using the static output feedback fault-tolerant control strategy, it can be noted that when the system sensor fails, despite the system failure and external interference, the forklift anti-rollover system still remains stable. When a fault occurs, the maximum fluctuation of the side slip angle and the yaw angular velocity remains no more than 3% of the maximum angle value without using the static output feedback fault-tolerant control strategy. Therefore, it is shown that the static output feedback fault-tolerant control strategy proposed in this application is effective.
In another aspect, the present invention also discloses a computer readable storage medium storing a computer program, when the computer program is executed by a processor, the processor performs the steps of any of the above methods.
In another aspect, the present invention also discloses a computer device, comprising a memory and a processor, wherein the memory stores a computer program, and when the computer program is executed by the processor, the processor performs the steps of any of the above methods.
In yet another embodiment of this application, a computer program product containing instructions is also provided, when it runs on a computer, the computer performs the steps of any of the methods in the above embodiments.
It can be understood that the system provided by the embodiments of the present invention corresponds to the method provided by the embodiments of the present invention. For explanations, examples and beneficial effects of relevant content, reference can be made to the corresponding parts of the above method.
Those of ordinary skill in the art can understand that all or part of the processes in the methods of the above embodiments can be implemented by instructing relevant hardware through computer programs. The programs can be stored in a non-volatile computer-readable storage medium, when the program is executed, it may include the processes of the embodiments of the above-mentioned method. Any reference to memory, storage, database or other media used in the embodiments of this application may include non-volatile and/or volatile memory. Non-volatile memory may include read-only memory (ROM), programmable ROM (PROM), electrically programmable ROM (EPROM), electrically erasable programmable ROM (EEPROM), or flash memory. Volatile memory may include random access memory (RAM) or external cache memory. By way of illustration and not limitation, RAM is available in many forms, such as static RAM (SRAM), dynamic RAM (DRAM), synchronous DRAM (SDRAM), double data rate SDRAM (DDRSDRAM), enhanced SDRAM (ESDRAM), synchronous chain (Synchlink), DRAM (SLDRAM), memory bus (Rambus), direct RAM (RDRAM), direct memory bus dynamic RAM (DRDRAM), and memory bus dynamic RAM (RDRAM), etc.
The above embodiments are only used to illustrate the technical solutions of the present invention, but not to limit them. Although the present invention has been described in detail with reference to the foregoing embodiments, those of ordinary skill in the art should understand that they can still modify the technical solutions described in the foregoing embodiments, or make equivalent substitutions for some of the technical features. However, these modifications or substitutions do not cause the essence of the corresponding technical solutions to deviate from the spirit and scope of the technical solutions of the respective embodiments of the present invention.
Number | Date | Country | Kind |
---|---|---|---|
202210652559.7 | Jun 2022 | CN | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/CN2023/096459 | 5/26/2023 | WO |