Design method for active-disturbance-rejection feedback controller of ultra-low-frequency air flotation vibration isolation system
By designing a state space observer and proportional differential controller in an ultra-low frequency air-floating vibration isolation system, the problem of insufficient vibration and anti-interference ability at the natural frequency of the system is solved, and stronger anti-interference ability and flexibility are achieved, which simplifies the Controller design.
Patent Information
- Application Number
- CN202411061774.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-05
- Publication Date
- 2024-12-06
- Estimated Expiration
- 2044-08-05
AI Technical Summary
The prior art lacks an effective self-immunity feedback controller design in ultra-low frequency vibration isolation systems, and cannot effectively suppress vibration and insufficient anti-interference ability at the natural frequency of the system.
A self-immune feedback controller for ultra-low frequency air-floating vibration isolation system was designed. By establishing dynamic equations, deriving state space equations, designing state space observers and representing them as linearly extended state observers, combining proportional differential controllers with Compensate system disturbances to realize real-time estimation and compensation of total disturbances.
It significantly improves the flexibility, robustness and anti-interference ability of the feedback control algorithm, enhances the system's anti-interference ability, simplifies the controller design, is suitable for ultra-low frequency air-floating vibration isolation systems, and achieves stronger vibration suppression effect. .
Smart Images

Figure CN119087779A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to a design method of an automatic disturbance rejection feedback controller, and belongs to the technical field of air-floating isolation micro-vibration systems. Background Art
[0002] Traditional feedback controllers are widely used in feedback control of vibration isolation systems because of their simple design, simple implementation, and independence from system models. However, traditional feedback controllers lack flexibility, good robustness, and anti-interference ability in design, and require certain engineering experience and a large number of debugging times to achieve the desired effect. LADRC can estimate the total disturbance through the extended state observer, thereby compensating for the total disturbance, so it has good anti-interference ability and greater flexibility. As a model-independent control algorithm, LADRC inherits the advantages of PID control, and the controller structure is simple and easy to implement. The existing research LADRC method is not directly used in ultra-low frequency vibration isolation systems, and no observer is designed for external and internal disturbances of the system to compensate for the disturbance, so as to improve the vibration suppression effect and anti-interference ability of feedback control at the natural frequency of the system.
[0003] Therefore, it is urgent to propose a design method for an ultra-low frequency air floating vibration isolation system's self-disturbance rejection feedback controller to solve the above technical problems. Summary of the invention
[0004] In order to solve the above problems, a method for designing an anti-disturbance feedback controller for an ultra-low frequency air floating vibration isolation system is provided. A brief overview of the invention is given below to provide a basic understanding of certain aspects of the invention. It should be understood that this overview is not an exhaustive overview of the invention. It is not intended to identify the key or important parts of the invention, nor is it intended to limit the scope of the invention.
[0005] The technical solution of the present invention:
[0006] A method for designing an auto-disturbance rejection feedback controller for an ultra-low frequency air floating vibration isolation system comprises the following steps:
[0007] Step 1: Establish the dynamic equation of the ultra-low frequency air floating vibration isolation system;
[0008] Step 2: Based on the dynamic equation, derive the state space equation of the vibration isolation system;
[0009] Step 3: Design a state space observer for the ultra-low frequency vibration isolation system;
[0010] Step 4: Represent the state space observer as a linear extended state observer;
[0011] Step 5: Design a proportional-derivative controller for the model after linear extended state observer compensation.
[0012] Optimum: Based on the knowledge of rigid body dynamics, the dynamic equation of the vibration isolation system is established as follows:
[0013]
[0014] In the expression, M1, C1, and K1 are the mass, damping, and stiffness of the vibration isolation system, respectively; q0 and q1 are the displacement of the base frame and the vibration isolation platform, respectively; and F is the output of the actuator of the vibration isolation system;
[0015] The dynamic equation of the vibration isolation system is rewritten as follows:
[0016]
[0017] In the expression, a=C1 / M1, b=K1 / M1, u represents the control variable, and f is called generalized disturbance or disturbance because it includes the unknown internal dynamics of the active vibration isolation system. and external disturbance w;
[0018] c is an unknown quantity, and c0 is a known constant set by oneself. Its function is to represent all the unknown quantities in the formula with f and hand them over to the state observer for prediction. In this way, only the known constant c0 is left before the control quantity u.
[0019] Preferably, in step 2, the state space equation of the vibration isolation system is written in the following form:
[0020]
[0021] In the expression x1=q1, x3=f is added as an augmented state, As an unknown disturbance.
[0022] Preferably: In step 3, a state observer based on state space is used to estimate the total disturbance f, and the state observer is written in the following form:
[0023]
[0024] y=Cz
[0025] in
[0026]
[0027] x is the state variable, which contains x1, x2, and x3; A is the system matrix, B is the control matrix, C is the observation matrix, and E is the disturbance matrix; z is the observation vector, specifically x predicted by the observer, and z is the prediction of x.
[0028] Preferably, in step 4, the state space observer in step 3 is represented as a linear extended state observer, which is constructed as follows:
[0029]
[0030] In the expression, L is the observer gain vector
[0031] T is the symbol of the matrix transpose, w0 is the bandwidth of the observer;
[0032] With a properly designed observer, the controller can be given by:
[0033]
[0034] Ignoring the estimation error in z3, the model can be simplified to a unity-gain double integrator:
[0035]
[0036] The z3 observer is an estimate of x3, which is also an estimate of f. Since the model needs to be simplified into a unit-gain double integrator, u needs to be rewritten in a form without f and only the control quantity remains. Therefore, u0 is also a control quantity, but it has a conversion relationship with u.
[0037] Preferably: in step 5, the proportional differential controller can be given by the following formula:
[0038] u0=k p (r-z1)-k d z2
[0039] In the expression, r is the reference signal, k d =2ξω c ,ω c and ξ are the closed-loop natural frequency and damping ratio of the desired system, ξ is chosen to avoid any oscillations, the z1 observer is an estimate of x1, and the z2 observer is an estimate of x2.
[0040] Preferred: Design method of linear auto-disturbance rejection feedback controller for ultra-low frequency air-floating vibration isolation system.
[0041] The present invention has the following beneficial effects:
[0042] 1. The method described in the present invention systematically and comprehensively introduces the design method of the linear anti-disturbance feedback controller of the ultra-low frequency air floating vibration isolation system, designs the linear extended state observer of the ultra-low frequency vibration isolation system, can compensate for the disturbance and uncertainty in the system in real time, and greatly enhances the flexibility, robustness and anti-disturbance ability of the feedback control algorithm;
[0043] 2. The control method of the present invention is independent of the model, simple in design and easy to implement. BRIEF DESCRIPTION OF THE DRAWINGS
[0044] Figure 1 It is a flow chart of the design method of the self-disturbance rejection feedback controller of the ultra-low frequency air floating vibration isolation system;
[0045] Figure 2 is a schematic diagram of the vibration isolation system;
[0046] Figure 3 This is a diagram of an ultra-low frequency air-floating vibration isolation unit;
[0047] Figure 4 It is a low frequency vibration isolation system test bench.
[0048] In the figure, k is the system stiffness, c is the system damping, 1 is the vibration isolation system load, 2 is the ultra-low frequency air floating vibration isolation unit, 3 is the vibration isolation unit expansion cylinder, 4 is the vibration isolation unit base, 5 is the vibration isolation system basic frame, and 6 is the vibration isolation system air floating guide device. DETAILED DESCRIPTION
[0049] In order to make the purpose, technical scheme and advantages of the present invention clearer, the present invention is described below by the specific embodiments shown in the accompanying drawings. However, it should be understood that these descriptions are only exemplary and are not intended to limit the scope of the present invention. In addition, in the following description, the description of well-known structures and technologies is omitted to avoid unnecessary confusion of the concept of the present invention.
[0050] Specific implementation method 1: Combination Figure 1-4 The present embodiment is described. The present embodiment is a method for designing an auto-disturbance rejection feedback controller for an ultra-low frequency air floating vibration isolation system, and is applied to a method for designing a linear auto-disturbance rejection feedback controller for an ultra-low frequency air floating vibration isolation system, and includes the following steps:
[0051] Step 1: Establish the dynamic equation of the ultra-low frequency air floating vibration isolation system;
[0052] In step 1, the ultra-low frequency air-floating vibration isolation system (abbreviated as vibration isolation system) is modeled to obtain a mathematical description of its dynamic behavior, that is, Newton's second law and mass, spring stiffness, and damping coefficient are used to construct a state space model of the system, providing a basis for subsequent modeling and analysis;
[0053] According to the knowledge of rigid body dynamics, the dynamic equation of the vibration isolation system is established as follows:
[0054]
[0055] In the expression, M1, C1, and K1 are the mass, damping, and stiffness of the vibration isolation system, respectively; q0 and q1 are the displacements of the base frame (base frame 5 of the vibration isolation system) and the vibration isolation platform (load 1 of the vibration isolation system), respectively; and F is the output of the actuator of the vibration isolation system (the motor of the ultra-low frequency air floating vibration isolation unit 2);
[0056] The dynamic equation of the vibration isolation system is rewritten as follows:
[0057]
[0058] In the expression, a=C1 / M1, b=K1 / M1, u represents the control variable, and f is called generalized disturbance or disturbance because it includes the unknown internal dynamics of the active vibration isolation system. and external disturbance w;
[0059] Step 2: Based on the dynamic equation, derive the state space equation of the vibration isolation system;
[0060] In step 2, the state space equation of the vibration isolation system can be obtained by converting the dynamic equation into the state space form, which usually includes defining the state variables of the vibration isolation system and substituting them into the original dynamic equation to form a set of linear differential equations, converting the physical model into a mathematical model for computer processing and simulation;
[0061] The state space equation of the vibration isolation system is written as follows:
[0062]
[0063] In the expression x1=q1, x3=f is added as an augmented state, As an unknown disturbance;
[0064] Step 3: Design a state space observer for the ultra-low frequency vibration isolation system;
[0065] In step 3, for the ultra-low frequency vibration isolation system, an extended state observer (ESO) or a linear extended state observer (LESO) can be used. These observers can handle unknown interference (disturbance) and parameter uncertainty and provide fast and accurate state estimation. Real-time estimation of the system state ensures the accuracy of feedback control.
[0066] The total disturbance f is estimated using a state observer based on state space, and the state observer is written as follows:
[0067]
[0068] y=Cz
[0069] in
[0070]
[0071] Step 4: Represent the state space observer as a linear extended state observer;
[0072] In step 4, by adjusting parameters and introducing additional observation gains, the above observer can be transformed into a linear extended state observer (LESO) to improve the observation accuracy and robustness and adapt to the needs of complex systems;
[0073] The state space observer in step 3 is expressed as a linear extended state observer, which is constructed as follows:
[0074]
[0075] In the expression, L is the observer gain vector L = [-3ω0 -3ω0 2 -ω0 3 ] T .
[0076] With a properly designed observer, the controller can be given by:
[0077]
[0078] Ignoring the estimation error in z3, the model can be simplified to a unity-gain double integrator:
[0079]
[0080] Step 5: Design a proportional-derivative controller for the model after linear extended state observer compensation;
[0081] In step 5, after obtaining the output of the linear extended state observer, the PID controller (proportional differential controller) calculates the control signal according to the current error and its rate of change, and adjusts the vibration isolation system behavior to achieve the desired goal based on the estimated state information;
[0082] The proportional-derivative controller can be given by:
[0083] u0=k p (r-z1)-k d z2
[0084] In the expression, r is the reference signal, k p =ω c 2 , k d =2ξω c ,ω c and ξ are the closed-loop natural frequency and damping ratio of the desired system, ξ is chosen to avoid any oscillation;
[0085] This method does not rely on accurate system parameters because it has a linear extended state observer, which has stronger anti-interference ability. At the same time, this method is simple and easy to use, and effectively improves the vibration isolation effect of the ultra-low frequency air floating vibration isolation system.
[0086] In terms of robust control, the model dependence is low: LADRC (Linear Active Disturbance Rejection Control) does not rely on the precise mathematical model of the controlled object, and its extended state observer (LESO) can estimate the disturbance and uncertainty of the system in real time, making the system more adaptable to model errors and unknown disturbances;
[0087] In terms of anti-interference ability, LADRC has strong anti-interference ability: LADRC effectively enhances the anti-interference ability of the system by estimating and compensating disturbances in real time; compared with traditional robust control methods (such as H∞ control, sliding mode control, etc.), LADRC can suppress disturbances in a wider frequency range, significantly improving the robustness of the system;
[0088] In terms of design and adjustment, it is simpler: the controller design of LADRC is relatively simple, and usually only a small number of parameters need to be adjusted (such as the bandwidth of the leso and the bandwidth of the controller), without the need for complex parameter design and optimization like traditional robust control; therefore, the present invention is easier to implement and debug in engineering;
[0089] In terms of dynamic performance, it has good dynamic performance: LADRC can effectively handle the uncertainty and external disturbance of the system, and excels in achieving fast response and small overshoot of the system; this makes the present invention outstanding in control scenarios that require fast response and precise tracking;
[0090] In terms of versatility, LADRC is applicable to various types of control systems, including linear systems, nonlinear systems, multiple-input multiple-output (MIMO) systems, etc., and is applied to vibration isolation systems, which makes the present invention highly versatile.
[0091] It should be noted that in the above embodiments, as long as the technical solutions are not contradictory, they can be arranged and combined, and those skilled in the art can exhaust all possibilities based on the mathematical knowledge of arrangement and combination. Therefore, the present invention will no longer describe the technical solutions after arrangement and combination one by one, but it should be understood that the technical solutions after arrangement and combination have been disclosed by the present invention.
[0092] The above description is only a preferred embodiment of the present invention and is not intended to limit the present invention. For those skilled in the art, the present invention may have various modifications and variations. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present invention shall be included in the protection scope of the present invention.
Claims
1. A design method for an auto-disturbance rejection feedback controller for an ultra-low frequency air-floating vibration isolation system. Features: The following steps are involved: Step 1: Establish the dynamic equation of the ultra-low frequency air floating vibration isolation system; Step 2: Based on the dynamic equation, derive the state space equation of the vibration isolation system; Step 3: Design a state space observer for the ultra-low frequency vibration isolation system; Step 4: Represent the state space observer as a linear extended state observer; Step 5: Design a proportional-derivative controller for the model after linear extended state observer compensation.
2. According to the design method of the automatic disturbance rejection feedback controller of the ultra-low frequency air floating vibration isolation system in claim 1, Features: In step 1, the dynamic equation of the vibration isolation system is established based on the knowledge of rigid body dynamics as follows: In the expression M 1 , C 1 , K 1 are the mass, damping and stiffness of the vibration isolation system respectively; q 0 ,q 1 are the displacement of the base frame and the displacement of the vibration isolation platform, respectively, and F is the output of the actuator of the vibration isolation system; The dynamic equation of the vibration isolation system is rewritten as follows: In the expression a=C 1 / M 1 ,b=K 1 / M 1 , u represents the control variable, and f is called generalized disturbance or disturbance because it includes the unknown internal dynamics of the active vibration isolation system. and an external disturbance w.
3. According to the design method of the automatic disturbance rejection feedback controller of the ultra-low frequency air floating vibration isolation system in claim 2, Features: In step 2, the state space equation of the vibration isolation system is written as follows: In the expression x 1 =q 1 , x 3 =f is added as an augmented state, As an unknown disturbance.
4. According to the method for designing an auto-disturbance rejection feedback controller for an ultra-low frequency air floating vibration isolation system as described in claim 3, Features: In step 3, the total disturbance f is estimated using a state observer based on state space. The state observer is written as follows: y=Cz in 5. According to the method for designing an auto-disturbance rejection feedback controller for an ultra-low frequency air floating vibration isolation system as described in claim 4, Features: In step 4, the state space observer in step 3 is expressed as a linear extended state observer, which is constructed as follows: In the expression, L is the observer gain vector L = [-3ω 0 -3ω 0 2 -ω 0 3 ] T ; The controller can be given by: Ignore z 3 The estimated error in , the model can be simplified to a unity gain double integrator:
6. According to the method for designing an auto-disturbance rejection feedback controller for an ultra-low frequency air floating vibration isolation system in claim 5, Features: In step 5, the proportional-derivative controller can be given by: u 0 =k p (r-z 1 )-k d z 2 In the expression, r is the reference signal, k d =2ξω c ,ω c and ξ are the closed-loop natural frequency and damping ratio of the desired system, ξ is chosen to avoid any oscillations.
7. A method for designing an auto-disturbance rejection feedback controller for an ultra-low frequency air floating vibration isolation system according to any one of claims 1 to 6, Features: Design method of linear active disturbance rejection feedback controller for ultra-low frequency air-floating vibration isolation system.
Citation Information
Patent Citations
Design method of auto disturbance rejection controller with anti-integral compensation function
CN108490765A
Power-free feedback vibration isolation control method and system for electric Stewart structure
CN110259879A
Rapid active disturbance rejection method for air cavity pressure based on extended state observer
CN111413872A
Design method and device of fractional order active disturbance rejection controller
CN117311230A
Active disturbance rejection control method and system based on error compensation expansion state observer
WO2024131238A1
