Backstepping sliding mode control method for heavy forklift pump-controlled lifting system based on nonlinear observer

Through the reverse step sliding mode control method based on nonlinear observer, the accuracy problems caused by hydraulic nonlinear and load changes in the heavy forklift pump control lifting system are solved, and the high-precision tracking performance of the system is realized, reducing the load sudden change to the system The impact of

CN118545646BActive Publication Date: 2024-11-12HUAQIAO UNIVERSITY
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411002309.4
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-07-25
Publication Date
2024-11-12
Estimated Expiration
2044-07-25

AI Technical Summary

Technical Problem

Due to the hydraulic nonlinearity of the hydraulic pressure, severe load changes, uncertain parameter and uncertain nonlinearity, the position servo accuracy is difficult to ensure. The existing control algorithm cannot consider these factors at the same time and cannot achieve absolute tracking accuracy. and security.

Method used

Using the reverse step sliding mode control method based on nonlinear observers, by obtaining the cylinder signal, designing the nonlinear interference observer and gain adjustment module, calling the pre-trained reverse step sliding mode controller, establishing a closed pump-controlled steering nonlinear system Model, perform interference compensation to realize the asymptotic tracking steady-state performance of the system.

Benefits of technology

Accurate observation of the load of the lifting system is achieved, which greatly reduces the impact of large load mutations on the system, improves high-precision control and tracking performance, and the simulation results verify its effectiveness.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118545646B_ABST
    Figure CN118545646B_ABST
Patent Text Reader

Abstract

The present invention provides a backstepping sliding mode control method for a heavy-duty forklift pump-controlled lifting system based on a nonlinear observer, and relates to the technical field of electro-hydraulic servo control. The method is based on the idea of ​​backstepping and designs a nonlinear robust sliding mode position servo controller with interference compensation. Aiming at the problem of difficult position accuracy control of heavy-duty forklift pump-controlled lifting, the present invention observes the load accurately, considers nonlinearity and parameter uncertainty, and uses sliding mode terms to process nonlinear uncertainty, thereby reducing the impact of load drastic changes, external interference, and unmodeled dynamics on control accuracy, and achieving high-precision tracking performance.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the technical field of electro-hydraulic servo control, and in particular to a back-stepping sliding mode control method for a heavy forklift pump-controlled lifting system based on a nonlinear observer. Background Art

[0002] Precision forklift is one of the most important functions required for efficient operation of heavy forklifts. Under the background of dual carbon, distributed pump-controlled lifting systems will gradually replace high-energy-consuming centralized valve-controlled lifting systems due to the elimination of energy-saving losses. However, due to the strong nonlinearity of hydraulic pressure, drastic load changes, leakage and other parameter uncertainties and uncertain nonlinearities, the position servo accuracy of the pump control system is difficult to guarantee.

[0003] At present, domestic and foreign scholars mainly divide the position servo of the pump-controlled lifting system of heavy forklifts into classic model-free control algorithms, model-based control algorithms and intelligent control algorithms. PID control is a classic model-free control method. The PID design is simple, but it cannot guarantee the tracking accuracy when facing parameter changes and external interference; the model-based articulated steering path tracking control methods mainly include pure tracking algorithms, feedback linearization, LQR, MPC, etc. The above algorithms can achieve a certain tracking effect, but rarely consider the effects of hydraulic system nonlinearity, parameter uncertainty and uncertain nonlinear interference at the same time. Intelligent control methods mainly include fuzzy logic control strategy, neural network control, reinforcement learning control, etc. Intelligent control methods have good adaptability and robustness. However, a large number of training data sets are required, the calculation is complex and there is uncertainty, which cannot fully guarantee the absolute accuracy and safety of the forklift loading of heavy forklifts. Therefore, how to ensure the absolute tracking accuracy of the pump-controlled lifting system of heavy forklifts in the context of energy saving, with strong nonlinearity, large load inertia changes and long-time varying interference under operation is crucial.

[0004] In view of this, this application is filed. Summary of the invention

[0005] The present invention provides a backstepping sliding mode control method for a heavy forklift pump-controlled lifting system based on a nonlinear observer, which can at least partially improve the above-mentioned problems.

[0006] To achieve the above object, the present invention adopts the following technical solutions:

[0007] A backstepping sliding mode control method for a heavy forklift pump-controlled lifting system based on a nonlinear observer, comprising:

[0008] Acquire a shift control target signal and a cylinder signal collected by a nonlinear disturbance observer, wherein the cylinder signal includes a cylinder displacement signal, a cylinder speed signal, and a cylinder two-chamber pressure signal;

[0009] Sending the output of the nonlinear disturbance observer to the gain adjustment module to convert the observed disturbance into the control amount of the corresponding input channel;

[0010] The pre-trained backstepping sliding mode controller is called to pre-process the shift control target signal and the control amount of the input channel to obtain the rotation angular velocity of the bidirectional quantitative pump actually controlled, and the formula is:

[0011]

[0012] in, is the total volume of the two chambers of the hydraulic cylinder, in m 3 , is the bulk elastic modulus, in Pa, is the displacement of the bidirectional fixed displacement pump, in m 3 / rad, is the effective area of ​​the hydraulic cylinder piston, in m 2 , is the leakage coefficient of the hydraulic cylinder, in units of (m 3 / s) / Pa, is the total mass of the piston and the load converted to the piston, in kg, and the state variable x0=[x1, x2, x3] T , T is the matrix transpose symbol, Virtual control law The higher-order derivatives of and is the sliding surface, is the sliding mode gain adjustment coefficient.

[0013] In summary, the backstepping sliding mode control method for the pump-controlled lifting system of a heavy-duty forklift based on a nonlinear observer aims to establish a mathematical model of a closed pump-controlled steering nonlinear system, and at the same time, considering the large parameter uncertainty, uncertain nonlinearity and unknown interference in the steering system, design a backstepping sliding mode controller based on a nonlinear observer, so that the system can obtain asymptotic tracking steady-state performance and achieve high-efficiency and high-precision lifting of heavy-duty forklifts. Compared with the prior art, the significant advantages of the present invention are: (1) accurate observation of the load of the lifting system is achieved; (2) a backstepping sliding mode controller is designed by performing interference compensation, which greatly reduces the impact of large load mutations on the lifting system and achieves high-precision control tracking performance. The simulation results verify its effectiveness. BRIEF DESCRIPTION OF THE DRAWINGS

[0014] Figure 1 It is a flow chart of a back-stepping sliding mode control method for a heavy forklift pump-controlled lifting system based on a nonlinear observer provided by an embodiment of the present invention;

[0015] Figure 2It is a schematic diagram of the backstepping sliding mode control principle of a pump-controlled lifting system based on a nonlinear observer provided in an embodiment of the present invention;

[0016] Figure 3 It is a schematic diagram of the principle of a heavy-duty forklift pump-controlled lifting system provided by an embodiment of the present invention;

[0017] Figure 4 is a control input curve diagram of the system under the backstepping sliding mode control provided by an embodiment of the present invention;

[0018] Figure 5 It is a comparison curve diagram of the tracking error of the system under the backstepping sliding mode control based on the nonlinear observer, the backstepping sliding mode control without the observer, and the PID control provided by the embodiment of the present invention;

[0019] Figure 6 It is a load observation curve provided by an embodiment of the present invention. DETAILED DESCRIPTION

[0020] In order to make the purpose, technical solution and advantages of the present invention more clearly understood, the present invention is further described in detail below in conjunction with embodiments. It should be understood that the specific embodiments described herein are only used to explain the present invention and are not used to limit the present invention.

[0021] refer to Figures 1 to 6 As shown, the first embodiment of the present invention discloses a backstepping sliding mode control method for a heavy-duty forklift pump-controlled lifting system based on a nonlinear observer, which can be executed by a backstepping sliding mode control device for a heavy-duty forklift pump-controlled lifting system based on a nonlinear observer (hereinafter referred to as a control device), and in particular, executed by one or more processors in the control device to implement the following method:

[0022] S101, acquiring a shift control target signal and a cylinder signal collected by a nonlinear disturbance observer, wherein the cylinder signal includes a cylinder displacement signal, a cylinder speed signal, and a cylinder two-chamber pressure signal;

[0023] S102, sending the output of the nonlinear disturbance observer to a gain adjustment module, and converting the observed disturbance into a control amount of a corresponding input channel;

[0024] S103, calling a pre-trained backstepping sliding mode controller to pre-process the shift control target signal and the control amount of the input channel to obtain the rotation angular velocity of the bidirectional quantitative pump actually controlled, the formula is:

[0025]

[0026] in, is the total volume of the two chambers of the hydraulic cylinder, in m 3 , is the bulk elastic modulus, in Pa, is the displacement of the bidirectional fixed displacement pump, in m 3 / rad, is the effective area of ​​the hydraulic cylinder piston, in m 2 , is the leakage coefficient of the hydraulic cylinder, in units of (m 3 / s) / Pa, is the total mass of the piston and the load converted to the piston, in kg, and the state variable x0=[x1, x2, x3] T , T is the matrix transpose symbol, Virtual control law The higher-order derivatives of and is the sliding surface, is the sliding mode gain adjustment coefficient.

[0027] Preferably, before acquiring the cylinder signal collected by the nonlinear disturbance observer, the method further includes:

[0028] Based on the preset conditions, a mathematical model of the pump-controlled lifting system of a heavy forklift is established, wherein the preset conditions are that the hydraulic cylinder has only internal leakage but no external leakage, and the load of the hydraulic cylinder is an inertial load without an elastic load, specifically:

[0029] The flow equation of the bidirectional quantitative pump of the mathematical model is:

[0030]

[0031] in, is the rotational angular velocity of the bidirectional quantitative pump, in rad / s;

[0032] The flow continuity equation of the hydraulic cylinder is:

[0033]

[0034]

[0035] in, and They are the flow rates of the two chambers of the hydraulic cylinder, in m 3 / s, is the piston displacement in m, and are the pressures of the two chambers of the hydraulic cylinder, in Pa. and They are the volumes of the two chambers of the hydraulic cylinder, in m 3 , is the first derivative of the piston displacement, and are the first derivatives of the pressures in the two chambers of the hydraulic cylinder respectively;

[0036] The load pressure is defined as , the load flow is defined as , combining the two formulas of the flow continuity equation of the hydraulic cylinder, we get:

[0037]

[0038] in, is the first derivative of the load pressure;

[0039] According to Newton's second law, the balance equation between the output force and load of the hydraulic cylinder is:

[0040]

[0041] in, is the second-order derivative of the piston displacement, is the viscous damping coefficient of the piston and load, in N / (m / s), Items that are difficult to model accurately include external disturbance forces and unmodeled friction;

[0042] Define state variables x0=[x1, x2, x3] T =[x p , p , p L ] T , from the above formula, the state space equations of the steering system are:

[0043] ;

[0044] Based on the mathematical model, the nonlinear disturbance observer is designed, and the nonlinear disturbance observer is used to estimate the disturbance of the system and compensate for it, specifically:

[0045] The specific formula of the nonlinear disturbance observer is:

[0046]

[0047] in, is the load observation value, is the state of the nonlinear disturbance observer, is the nonlinear function to be designed, is the first-order derivative of the nonlinear disturbance observer state, is the gain of the nonlinear observer, is the viscous damping coefficient of the piston and load;

[0048] Gain of the nonlinear observer Need to meet: ,in, It is the speed signal of the lifting cylinder;

[0049] The observation error of the nonlinear disturbance observer is defined as: ,in, is the first-order derivative of the disturbance value, is the interference value;

[0050] Generally no interference d The differential prior knowledge of , assuming that the disturbance changes slowly relative to the dynamic characteristics of the observer, ;

[0051] The dynamic equation of the observer error system is:

[0052]

[0053] in, is the first-order derivative of the disturbance observation error value, is the interference observation error value, is the first-order derivative of the load observation value;

[0054] From the above formula, we can see that by properly choosing L ( x 1, x 2)>0, the observation error of the observer can converge exponentially.

[0055] choose L ( x 1, x 2)= b , b >0 constant, design , is the observation gain.

[0056] Preferably, the output of the nonlinear disturbance observer is sent to a gain adjustment module to convert the observed disturbance into a control amount of the corresponding input channel, specifically:

[0057]

[0058] The gain is 1 / M ,have to u d = d / M , u d for.

[0059] Preferably, before calling the pre-trained backstepping sliding mode controller to pre-process the shift control target signal and the control amount of the input channel, the mathematical model and the nonlinear disturbance observer are also included to design a backstepping sliding mode observer, specifically:

[0060] Design the first sliding surface s 1= x 1- y d , the second sliding surface s 2= x 2- α 1. The third sliding surface s 3= x 3- α 2, among which, y d is the target signal, α 1 is the first virtual control rate, α 2 is the second virtual control rate;

[0061] For the first sliding surface, take the derivative:

[0062]

[0063] In order to make the first subsystem reach the sliding surface and move on the sliding surface, a virtual control law is designed. α 1, s 2= x 2- α 1, ,in, is the first-order derivative of the first sliding surface, is the first-order derivative of the target signal, is the gain coefficient of the first sliding surface;

[0064] Select the Lyapunov function ,right Taking the derivative, we get , where s is the sliding surface.

[0065] Derivative the second sliding surface:

[0066]

[0067] in, is the interference value function;

[0068] In order to make the second subsystem reach the sliding surface and move on the sliding surface, a virtual control law is designed: , because virtual control will be used in the subsequent design α The higher-order derivative of 1 gives ,in, is the gain coefficient of the second sliding surface, is the error between the observed load value and the actual load value, is the sliding mode term, = , and is a constant, μ2>1, 1>ɛ2>0;

[0069] Take the alternative Lyapunov function ,right Take the derivative:

[0070]

[0071] condition of s 3 s 2, the item will be eliminated in the next step of the design, when the condition is met When the second subsystem is stable, the second subsystem will eventually be bounded stable, and the error of the system is Within the range of .

[0072] Derivative the third sliding surface:

[0073]

[0074] Among them, e is the error, e1 is the first error, e2 is the second error, and e3 is the third error. is the sum of the fuel tank volumes;

[0075] The actual control law is obtained as: .

[0076] Preferably, it also includes:

[0077] The stability of the backstepping sliding mode controller based on nonlinear observation is proved by using Lyapunov stability theory, and the result that the system tracking error is asymptotically stable is obtained, specifically:

[0078] Select the Lyapunov function , take the derivative of V, and satisfy | s 2|> ε 2 / Under the premise of , we can get: , is the difference between the true value and the predicted value.

[0079] In this embodiment, for the system, under the assumption that the conditions are met, a nonlinear disturbance observer and control law are used, and all signals in the closed-loop system are bounded, then the system is bounded and stable. From the above formula, it can be seen that the signals in the closed-loop system are uniformly bounded and sufficient. s 2|> ε 2 / , the closed-loop system is a stable result.

[0080] In this implementation, by adjusting the gain L ( x 1, x 2) k 1、 k 2、 μ2, ɛ2, the nonlinear backstepping sliding mode controller designed for the heavy forklift pump control lifting system can make the system innovatively obtain the result that the tracking error converges to 0. The principle of the backstepping sliding mode position controller based on nonlinear observation is as follows Figure 2 shown.

[0081] In order to evaluate the performance of the designed controller, the physical parameters of the heavy forklift pump-controlled lifting servo system in the simulation are shown in Table 1:

[0082] Table 1 System physical parameters

[0083]

[0084] Given a system expecting instructions to be

[0085] The following controllers are compared in the simulation:

[0086] The backstepping sliding mode controller takes k1=k2=k3=5, μ2=1.5, ɛ2=0.2; the observer parameter takes L=15.

[0087] Set the PID controller parameters to P=15000, I=100, D=0.

[0088] Tracking error, nonlinear observer such as Figure 4 and Figure 5 ,from Figure 5 It can be seen that the maximum error of the backstepping sliding mode position servo control of heavy forklift based on nonlinear observer is 5.21×10-3m, which has higher accuracy and better tracking performance than PID and backstepping sliding mode control without observer.

[0089] The above is a preferred embodiment of the present invention. It should be pointed out that a person skilled in the art can make several improvements and modifications without departing from the principle of the present invention. These improvements and modifications are also considered to be within the scope of protection of the present invention.

Claims

1. A backstepping sliding mode control method for a heavy forklift pump-controlled lifting system based on a nonlinear observer, characterized in that: include: Acquire a shift control target signal and a cylinder signal collected by a nonlinear disturbance observer, wherein the cylinder signal includes a cylinder displacement signal, a cylinder speed signal, and a cylinder two-chamber pressure signal; Sending the output of the nonlinear disturbance observer to the gain adjustment module to convert the observed disturbance into the control amount of the corresponding input channel; The pre-trained backstepping sliding mode controller is called to pre-process the shift control target signal and the control amount of the input channel to obtain the rotation angular velocity of the bidirectional quantitative pump actually controlled, and the formula is: in, is the total volume of the two chambers of the hydraulic cylinder, in m 3 , is the bulk elastic modulus, in Pa, is the displacement of the bidirectional fixed displacement pump, in m 3 / rad, is the effective area of ​​the hydraulic cylinder piston, in m 2 , is the leakage coefficient of the hydraulic cylinder, in units of (m 3 / s) / Pa, is the total mass of the piston and the load converted to the piston, in kg, and the state variable x0=[x1, x2, x3] T , T is the matrix transpose symbol, Virtual control law The higher-order derivatives of and is the sliding surface, is the sliding mode gain adjustment coefficient; The output of the nonlinear disturbance observer is sent to the gain adjustment module to convert the observed disturbance into the control amount of the corresponding input channel, specifically: The gain is 1 / M ,have to u d = d / M , u d For compensation, is the observation gain, is the viscous damping coefficient of the piston and load, is the interference value.

2. The backstepping sliding mode control method for a heavy forklift pump-controlled lifting system based on a nonlinear observer according to claim 1 is characterized in that: Before obtaining the cylinder signal collected by the nonlinear disturbance observer, it also includes: Based on the preset conditions, a mathematical model of the pump-controlled lifting system of a heavy forklift is established, wherein the preset conditions are that the hydraulic cylinder has only internal leakage but no external leakage, and the load of the hydraulic cylinder is an inertial load without an elastic load; Based on the mathematical model, the nonlinear disturbance observer is designed, and the nonlinear disturbance observer is used to estimate the disturbance of the system and compensate for it.

3. The backstepping sliding mode control method for a heavy forklift pump-controlled lifting system based on a nonlinear observer according to claim 2 is characterized in that: Based on the preset conditions, the mathematical model of the pump-controlled lifting system of the heavy forklift is established, specifically: The flow equation of the bidirectional quantitative pump of the mathematical model is: in, is the rotational angular velocity of the bidirectional quantitative pump, in rad / s; The flow continuity equation of the hydraulic cylinder is: in, and They are the flow rates of the two chambers of the hydraulic cylinder, in m 3 / s, is the piston displacement in m, and are the pressures of the two chambers of the hydraulic cylinder, in Pa. and They are the volumes of the two chambers of the hydraulic cylinder, in m 3 , is the first derivative of the piston displacement, and are the first derivatives of the pressures in the two chambers of the hydraulic cylinder respectively; The load pressure is defined as , the load flow is defined as , combining the two formulas of the flow continuity equation of the hydraulic cylinder, we get: in, is the first derivative of the load pressure; According to Newton's second law, the balance equation between the output force and load of the hydraulic cylinder is: in, is the second-order derivative of the piston displacement, is the viscous damping coefficient of the piston and load, in N / (m / s), Items that are difficult to model accurately include external disturbance forces and unmodeled friction; Define state variables x0=[x1, x2, x3] T =[x p , x• p , p L ] T , from the above formula, the state space equations of the steering system are: 。 4. The backstepping sliding mode control method for a heavy forklift pump-controlled lifting system based on a nonlinear observer according to claim 3 is characterized in that: Based on the mathematical model, the nonlinear disturbance observer is designed, specifically: The specific formula of the nonlinear disturbance observer is: in, is the load observation value, is the state of the nonlinear disturbance observer, is the nonlinear function to be designed, is the first-order derivative of the nonlinear disturbance observer state, is the gain of the nonlinear observer; Gain of the nonlinear observer Need to meet: ,in, It is the speed signal of the lifting cylinder; The observation error of the nonlinear disturbance observer is defined as: ,in, is the first-order derivative of the interference value; Assuming that the disturbance changes slowly relative to the observer's dynamic characteristics, ; The dynamic equation of the observer error system is: in, is the first-order derivative of the disturbance observation error value, is the error value of the interference observation, is the first-order derivative of the load observation value; choose L ( x 1 , x 2)= b , b >0 constant, design .

5. The backstepping sliding mode control method for a heavy forklift pump-controlled lifting system based on a nonlinear observer according to claim 2 is characterized in that: Before calling the pre-trained backstepping sliding mode controller to pre-process the shift control target signal and the control amount of the input channel, the mathematical model and the nonlinear disturbance observer are also included to design a backstepping sliding mode observer, specifically: Design the first sliding surface s 1= x 1- y d , the second sliding surface s 2= x 2- α 1. The third sliding surface s 3= x 3- α 2, among which, y d is the target signal, α 1 is the first virtual control rate, α 2 is the second virtual control rate; For the first sliding surface, take the derivative: Design of virtual control law α 1, s 2= x 2- α 1, ,in, is the first-order derivative of the first sliding surface, is the first-order derivative of the target signal, is the gain coefficient of the first sliding surface; Select the Lyapunov function ,right Taking the derivative, we get , where s is the sliding surface.

6. The backstepping sliding mode control method for a heavy forklift pump-controlled lifting system based on a nonlinear observer according to claim 5 is characterized in that: Before calling the pre-trained backstepping sliding mode controller to pre-process the shift control target signal and the control amount of the input channel, the method further includes: Derivative the second sliding surface: in, is the interference value function; Design of virtual control law: ,in, is the gain coefficient of the second sliding surface, is the error between the observed load value and the actual load value, is the sliding mode term, = , and is a constant, μ2>1, 1> ɛ2>0; Take the alternative Lyapunov function ,right To perform the derivation: When the conditions are met When the second subsystem is stable, the system error is Within the range of .

7. The backstepping sliding mode control method for a heavy forklift pump-controlled lifting system based on a nonlinear observer according to claim 6 is characterized in that: Before calling the pre-trained backstepping sliding mode controller to pre-process the shift control target signal and the control amount of the input channel, the method further includes: Derivative the third sliding surface: Among them, e is the error, e1 is the first error, e2 is the second error, and e3 is the third error. is the sum of the fuel tank volumes; The actual control law is obtained as: .

8. The backstepping sliding mode control method for a heavy forklift pump-controlled lifting system based on a nonlinear observer according to claim 7 is characterized in that: Also includes: The stability of the backstepping sliding mode controller based on nonlinear observation is proved by using Lyapunov stability theory, and the result that the system tracking error is asymptotically stable is obtained.

9. The backstepping sliding mode control method for a heavy forklift pump-controlled lifting system based on a nonlinear observer according to claim 8 is characterized in that: The stability of the backstepping sliding mode controller based on nonlinear observation is proved by using Lyapunov stability theory, specifically: Select the Lyapunov function , take the derivative of V, and satisfy | s 2|> ε 2 / Under the premise of , we can get: , is the difference between the true value and the predicted value.