A Vibration Isolation Method for Precision Equipment Based on Feedforward-Feedback Composite Control
By using a feedforward-feedback composite control method, changing the sensor position and setting the filter and gain coefficient matrix, active vibration isolation of a multi-degree-of-freedom system is achieved, which solves the shortcomings of passive vibration isolation systems in suppressing high-frequency and low-frequency interference and improves system stability and vibration isolation effect.
Patent Information
- Application Number
- CN202410240485.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-03-04
- Publication Date
- 2026-11-17
- Estimated Expiration
- 2044-03-04
AI Technical Summary
Existing passive vibration isolation systems are inadequate in suppressing ground vibrations and direct interference, especially soft-mounted systems which have poor attenuation characteristics at high frequencies and cannot meet the vibration isolation requirements of high-precision equipment.
By adopting a feedforward-feedback composite control method, active vibration isolation of a multi-degree-of-freedom system is achieved by changing the sensor position, setting feedback and feedforward control loops, filters, gain coefficient matrices, and control forces.
It effectively suppresses high-frequency noise and low-frequency interference, avoids vibration amplification at resonance peaks, improves system stability and vibration isolation effect, and is suitable for low-to-mid-range vibration control applications.
Smart Images

Figure CN118113081B_ABST
Abstract
Description
Technical Field
[0001] This invention relates to the technical field of vibration isolation platforms, and specifically provides a vibration isolation method for precision equipment based on feedforward feedback composite control. Background Technology
[0002] Vibration isolation systems are widely used in high-precision equipment to protect internal precision instruments from external interference. Typically, these systems must isolate two types of interference: ground vibrations that enter the precision instruments through the isolation system, and interference forces that act directly on the instruments. In passive systems, interference suppression characteristics strongly depend on the stiffness of the passive isolators. Systems with lower stiffness, known as soft mountings, generally suppress floor vibrations well but are less effective at suppressing direct interference. Systems with high stiffness (hard mountings) typically eliminate direct interference well, but their suppression of ground vibrations is significantly reduced.
[0003] For soft-mounted vibration isolation platforms, due to their low natural frequency and good high-frequency attenuation characteristics at higher natural frequencies, as long as the natural frequency of the isolator itself is low enough, it can achieve strong suppression of disturbances over a wide bandwidth through its passive vibration isolation characteristics. Therefore, often only an active damping controller with a feedback structure is needed to compensate for the low damping deficiency of the isolator itself to achieve good vibration isolation. However, to ensure the support stiffness of the system, the natural frequency of the passive vibration isolation system is relatively high and has low damping. Near the natural frequency, the amplification factor of disturbances can reach 50dB, far exceeding the broadband disturbance suppression index of typical vibration isolators. Neither feedback nor feedforward controllers alone can meet the vibration isolation requirements of the system. Summary of the Invention
[0004] To address the aforementioned problems, this invention provides a vibration isolation method for precision equipment based on feedforward feedback composite control.
[0005] This invention provides a vibration isolation method for precision equipment based on feedforward-feedback composite control, comprising: S1: Transform the motor and sensor in a single direction, changing the location of the acceleration of the feedforward sensor and the feedback sensor to the location of the motor; S2: Set the feedback control loop and preset the gain coefficient matrix of speed feedback and acceleration feedback; S3: Set a notch filter to remove the influence of resonance peaks generated by coupling in other directions of the vibration isolation platform; S4: Set a feedback high-pass filter to suppress interference from high-frequency noise; set a low-pass filter to filter low-frequency acceleration signals to avoid drift problems; add the feedback high-pass filter, the feedback low-pass filter, and the notch filter to the feedback control loop; S5: Obtain the feedback control force of each motor; S6: Determine the proportional feedback coefficient and integral feedback coefficient in the feedback and acceleration feedback gain coefficients; S7: Set up a feedforward control loop to perform low-pass and high-pass filtering on the output analog signal of the feedforward accelerometer installed on the ground to prevent interference from low-frequency integral drift and high-frequency noise from the sensor. Add the notch filter to remove the influence of resonance peaks generated by coupling in other directions of the vibration isolation platform. S8: Obtain the feedforward control force of each motor; S9: Set the feedforward control law and adjust the gain coefficient of the feedforward controller; S10: Obtain the control force of each of the motors.
[0006] Preferably, S1 includes: Determine the motor position and the direction of the motor's output force; Two acceleration sensors are installed near each of the motors, and the two acceleration sensors include a feedback sensor and a feedforward sensor. The feedback sensor is mounted on the load, and the feedforward sensor is mounted on the platform. The direction of the acceleration it measures is consistent with the direction of the motor output force.
[0007] Preferably, S1 further includes: The pre-set vibration isolation platform includes four sets of vibration isolators, and each set of vibration isolators includes two motors. Therefore, the eight output forces of the eight motors are as follows: ; The coordinates of the position points of each motor are: ; The accelerations measured by the four groups of eight feedback sensors are as follows: ; The position coordinates of each point of the feedback sensor are as follows: ; The accelerations measured by the four groups of eight feedforward sensors are as follows: ; The position coordinates of each point of the feedforward sensor are as follows: .
[0008] The preset transformation matrix from the feedback sensor to the motor is as follows: The transformation matrix from the feedforward sensor to the motor is: ; The feedback signal measured by the feedback sensor at the motor position on the load is ,but ; The feedforward signal measured by the feedforward sensor at the motor position on the platform is ,but .
[0009] Preferably, S2 includes: The feedback signal corresponds one-to-one with the feedback control force of the motor; The feedback control loop is as follows: ; ; Among them, the acceleration feedback gain coefficient K vi Used to improve the ability to suppress high-frequency direct interference; Skyhook damping was added to improve the suppression of interference frequencies close to the suspension frequency; acceleration feedback gain. K ai It can shift the system's resonance peak, providing a soft vibration isolation effect for the system; i Represents joint number ; set up and This represents the gain coefficient matrix for the velocity and acceleration feedback of each joint.
[0010] Preferably, S3 includes: Set the notch filter transfer function as follows: ; in f n The second resonant frequency of the system The molecular damping ratio of the notch filter. This is the damping ratio in the denominator of the notch filter.
[0011] Preferably, S4 includes: Set the feedback high-pass filter to ; in, The cutoff frequency of the feedback high-pass filter is used to suppress interference caused by low-frequency noise. Set the feedback low-pass filter to ; in, This is the cutoff frequency of the feedback low-pass filter, used to suppress interference from high-frequency noise. The feedback high-pass filter, the feedback low-pass filter, and the notch filter are added to the feedback control loop. Therefore... .
[0012] Preferably, S5 includes: The feedback control force of each motor is ; Represented as .
[0013] Preferably, step S6 includes: determining the acceleration proportional feedback coefficient. K a Its calculation formula is ,in f 1 represents the first natural frequency of a single-degree-of-freedom system. f 2 represents the system's natural frequency after the resonant peak is moved; Determine the integral feedback coefficient of acceleration Its calculation formula is To achieve the optimal damping ratio.
[0014] Preferably, S7 includes: The feedforward signal corresponds one-to-one with the feedforward control force output by the motor; The preset feedforward control loop is: ; Set the feedback high-pass filter as follows: ; in, This is the cutoff frequency of the feedforward high-pass filter, used to suppress noise caused by acceleration below 2Hz; Set the feedforward low-pass filter to .
[0015] in, This is the cutoff frequency of the feedforward low-pass filter, used to suppress interference generated by high-frequency noise; set up and This represents the gain coefficient matrix for displacement feedforward and velocity feedforward at each joint. Therefore, the feedforward force of each of the joints can be expressed as: .
[0016] Preferably, S8 includes: The feedforward control force of each of the motors is ; Represented as .
[0017] Preferably, step S10 includes: the control force of each motor is... .
[0018] Compared with the prior art, the present invention can achieve the following beneficial effects: The vibration isolation method for precision equipment based on feedforward and feedback composite control of this application includes: S1 transforming the motor and sensor in a single direction, transforming the acceleration position of the feedforward sensor and the feedback sensor to the position of the motor; S2 setting a feedback control loop, and preset the gain coefficient matrix of the velocity feedback and acceleration feedback; S3 setting a notch filter to remove the influence of resonance peaks generated by coupling in other directions of the vibration isolation platform; S4 setting a feedback high-pass filter to suppress interference generated by high-frequency noise; setting a low-pass filter to filter low-frequency acceleration signals to avoid drift problems; and combining the feedback high-pass filter and the feedback low-pass filter... The notch filter is added to the feedback control loop; S5 obtains the feedback control force of each motor; S6 determines the acceleration proportional feedback coefficient and acceleration integral feedback coefficient in the feedback and acceleration feedback gain coefficients; S7 sets up a feedforward control loop, performs low-pass filtering and high-pass filtering on the output analog signal of the feedforward acceleration sensor installed on the ground to prevent interference from low-frequency integral drift and high-frequency noise from the sensor, and adds the notch filter to remove the influence of resonance peaks generated by coupling in other directions of the vibration isolation platform; S8 obtains the feedforward control force of each motor; S9 sets the feedforward control law and adjusts the gain coefficient of the feedforward controller; S10 obtains the control force of each motor. This application uses a vibration control strategy that combines absolute acceleration proportional and integral feedback with suboptimal feedforward control, adopts joint space control, and uses coordinate transformation to achieve suboptimal decoupling of the multi-degree-of-freedom system, transforming it into an active vibration isolation system in joint space for active vibration isolation control strategy. This design avoids the vibration amplification problem at the resonance peak caused by rigid installation. Active damping is artificially added to the system to reduce the peak value at the resonance peak. Bandpass and notch filters are used to prevent high-frequency noise and low-frequency DC components from affecting the active damping controller, thus improving system stability. The designed active vibration isolation algorithm is simple and easy to implement, exhibits good system stability and excellent vibration isolation effect, requires no system model identification or adjustable parameters, has wide applicability, and is beneficial for engineering applications. It has significant application prospects in the low-to-mid-range vibration control field. Attached Figure Description
[0019] Figure 1 This is a flowchart of a precision equipment vibration isolation method based on feedforward feedback composite control according to Embodiment 1 of the present invention; Figure 2 This is a schematic diagram of the active vibration isolation system provided in Embodiment 1 of the present invention; Figure 3 This is a block diagram of a multidimensional active vibration isolation system provided in Embodiment 1 of the present invention; Figure 4 This is the equivalent dynamic model of the multidimensional vibration isolation system provided in Embodiment 1 of the present invention; Figure 5This is a Bode plot of a notch filter system provided in Embodiment 1 of the present invention. Detailed Implementation
[0020] In the following description, embodiments of the invention will be described with reference to the accompanying drawings. In the description below, the same modules are denoted by the same reference numerals. Where the same reference numerals are used, their names and functions are also the same. Therefore, their detailed description will not be repeated.
[0021] To make the objectives, technical solutions, and advantages of this invention clearer, the invention will be further described in detail below with reference to the accompanying drawings and specific embodiments. It should be understood that the specific embodiments described herein are merely illustrative of the invention and do not constitute a limitation thereof.
[0022] Example 1 S1: Transform the motor and sensor in a single direction, changing the location of the acceleration of the feedforward sensor and the feedback sensor to the location of the motor; S2: Set the feedback control loop and preset the gain coefficient matrix of speed feedback and acceleration feedback; S3: Set a notch filter to remove the influence of resonance peaks generated by coupling in other directions of the vibration isolation platform; S4: Set a feedback high-pass filter to suppress interference from high-frequency noise; set a low-pass filter to filter low-frequency acceleration signals to avoid drift problems; add the feedback high-pass filter, the feedback low-pass filter, and the notch filter to the feedback control loop; S5: Obtain the feedback control force of each motor; S6: Determine the proportional feedback coefficient and integral feedback coefficient in the feedback and acceleration feedback gain coefficients; S7: Set up a feedforward control loop to perform low-pass and high-pass filtering on the output analog signal of the feedforward accelerometer installed on the ground to prevent interference from low-frequency integral drift and high-frequency noise from the sensor. Add the notch filter to remove the influence of resonance peaks generated by coupling in other directions of the vibration isolation platform. S8: Obtain the feedforward control force of each motor; S9: Set the feedforward control law and adjust the gain coefficient of the feedforward controller; S10: Obtain the control force of each of the motors.
[0023] The above, such as Figure 1 As shown, this application employs a vibration control strategy that combines proportional and integral feedback of absolute acceleration with feedforward suboptimal control, and utilizes joint space control, such as... Figure 2As shown, suboptimal decoupling of a multi-degree-of-freedom system is achieved through coordinate transformation, which transforms it into an active vibration isolation system in joint space for active vibration isolation control strategy.
[0024] Feedback control is used to suppress direct disturbances and minimize sensor noise to amplify and ensure robust stability. It avoids the problem of vibration amplification at resonance peaks caused during hard mounting, and improves system stability by using bandpass and notch filters to prevent the influence of high-frequency noise and low-frequency DC components on the active damping controller.
[0025] The feedforward control method adopted utilizes the acceleration of the motor mounting foundation position as the feedforward signal. Compared with the optimal feedforward method, which requires precise model identification and parameter tuning, and the huge computational load of the adaptive feedforward algorithm, the designed active vibration isolation algorithm has a simple structure that is easy to implement, good system stability, and excellent vibration isolation effect. It does not require identification of system models and adjustable parameters, has a wide range of applications, and is conducive to engineering applications. It has great application prospects in the field of low-to-mid-range vibration control.
[0026] In this embodiment, S1 includes: Determine the motor position and the direction of the motor's output force; Two acceleration sensors are installed near each of the motors, and the two acceleration sensors include a feedback sensor and a feedforward sensor. The feedback sensor is mounted on the load, and the feedforward sensor is mounted on the platform. The direction of the acceleration it measures is consistent with the direction of the motor output force.
[0027] In this embodiment, S1 further includes: In a specific embodiment, the preset vibration isolation platform includes four sets of vibration isolators, and each set of vibration isolators includes two motors. Therefore, the eight output forces of the eight motors are as follows: ; The coordinates of the position points of each motor are: ; The accelerations measured by the four groups of eight feedback sensors are as follows: ; The position coordinates of each point of the feedback sensor are as follows: ; The accelerations measured by the four groups of eight feedforward sensors are as follows: ; The position coordinates of each point of the feedforward sensor are as follows: ; The preset transformation matrix from the feedback sensor to the motor is as follows: The transformation matrix from the feedforward sensor to the motor is: ; The feedback signal measured by the feedback sensor at the motor position on the load is ,but ; The feedforward signal measured by the feedforward sensor at the motor position on the platform is ,but .
[0028] To understand the relationship between the disturbance force and acceleration of the force measuring platform, a dynamic model of the vibration isolation platform was constructed, and a multi-dimensional active vibration isolation system was established. The system is assumed to have i motors, i feedback accelerometers, and i feedforward accelerometers. The equivalent dynamic model of the system is shown below. Figure 4 As shown.
[0029] Multidimensional active vibration isolation system, such as Figure 3 As shown, its structure mainly consists of a platform (base frame), four active vibration isolation units, and a load. External devices include an embedded controller, a vibration data acquisition unit, and a host computer. The acceleration distribution on the platform and load is shown below. Figure 2 As shown in the diagram, the acceleration directions measured by the four sets of feedback sensors on the four active vibration isolation units on the load are XZ, YZ, XZ, and YZ directions in the geodetic coordinate system, respectively. The acceleration directions measured by the four sets of feedforward sensors are XZ, YZ, XZ, and YZ directions in the geodetic coordinate system, respectively. The output force directions of the four sets of motors are XZ, YZ, XZ, and YZ directions in the geodetic coordinate system, respectively. Then, based on the positions of the acceleration sensors and motors, the multi-dimensional active vibration isolation system includes determining the relative positions of the feedforward and feedback sensors of the active vibration isolation equipment and the directions of the acceleration measured in the geodetic coordinate system, as well as determining the positions of the motors and the directions of the motor output forces.
[0030] In one specific embodiment, the preset vibration isolation platform includes four sets of vibration isolators, and each set of vibration isolators includes two motors.
[0031] In this embodiment, S2 includes: The feedback signal corresponds one-to-one with the feedback control force of the motor; The feedback control loop is as follows: ; ; Among them, the acceleration feedback gain coefficient K viUsed to improve the ability to suppress high-frequency direct interference; Skyhook damping was added to improve the suppression of interference frequencies close to the suspension frequency; acceleration feedback gain. K ai It can shift the system's resonance peak, providing a soft vibration isolation effect for the system; i Represents joint number ; set up and This represents the gain coefficient matrix for the velocity and acceleration feedback of each joint.
[0032] The above describes the setup of feedback controllers for each joint of the multi-dimensional active vibration isolation system. The basic design incorporates proportional and integral gain, with the feedback signal being an acceleration sensor placed on the load. Active damping is artificially added to the system to reduce the peak value at the resonance point. The controller structure is simple. The feedback controller used is a distributed control within the joint space, i.e., the first... i The feedback sensor is the first i The feedback controller input to the motor and the sensor feedback signals correspond one-to-one with the motor feedback control force. Specifically, the feedback controller is: ; .
[0033] In this embodiment, S3 includes: Set the notch filter transfer function as follows: ; in f n This is the second-order resonant frequency of the system. The molecular damping ratio of the notch filter. This is the damping ratio in the denominator of the notch filter.
[0034] As mentioned above, since the control system is a simplified representation of the vibration path in the system's joint space, coupling may occur at high frequencies during actual control. Therefore, notch filters need to be added at the second-order and subsequent resonance peaks to ensure the system's vibration isolation effect. Figure 5 As shown, the vertical axis represents the noise level (magnitude (dB)) and phase (deg), while the corresponding horizontal axis represents the Bode diagram and frequency distribution (frequency (rad / s)). When the second resonance peak is 94 Hz, the notch filter is determined... The molecular damping ratio of the notch filter is 0.01. If the damping ratio of the notch filter is 0.6, then the sensor signal attenuates by a factor of 60 at the resonance peak.
[0035] In this embodiment, S4 includes: Set the feedback high-pass filter to ; in, The cutoff frequency of the feedback high-pass filter is used to suppress interference caused by low-frequency noise. Set the feedback low-pass filter to ; in, This is the cutoff frequency of the feedback low-pass filter, used to suppress interference from high-frequency noise. The feedback high-pass filter, the feedback low-pass filter, and the notch filter are added to the feedback control loop. Therefore... .
[0036] The above-mentioned low-frequency leveling filter This improves system leveling and filters low-frequency acceleration signals to avoid drift issues. It also overcomes the inaccuracy of low-frequency measurements by piezoelectric accelerometers.
[0037] In this embodiment, S5 includes: The feedback control force of each motor is ; Represented as .
[0038] In this embodiment, step S6 includes: determining the acceleration proportional feedback coefficient. K a Its calculation formula is ,in f 1 represents the first natural frequency of a single-degree-of-freedom system. f 2 represents the system's natural frequency after the resonant peak is moved; Determine the integral feedback coefficient of acceleration Its calculation formula is To achieve the optimal damping ratio.
[0039] A specific example is as follows: =26Hz is the first natural frequency of the i-th joint. =18Hz is the system's natural frequency after the moving resonance peak, and the proportional feedback coefficient is determined as follows: =((26 / 18)^2-1)*13=14.1.
[0040] After determining the proportional acceleration feedback coefficient, determine the integral acceleration feedback coefficient. Its calculation formula is , =1.4*13*(2*3.14*18)=2057.3, which can achieve the optimal damping ratio effect.
[0041] In this embodiment, S7 includes: The feedforward signal corresponds one-to-one with the feedforward control force output by the motor; The preset feedforward control loop is: ; Set the feedback high-pass filter as follows: ; in, This is the cutoff frequency of the feedforward high-pass filter, used to suppress noise from acceleration below 2 Hz (Hertz); Set the feedforward low-pass filter to ; in, This is the cutoff frequency of the feedforward low-pass filter, used to suppress interference generated by high-frequency noise; set up and This represents the gain coefficient matrix for displacement feedforward and velocity feedforward at each joint. Therefore, the feedforward force of each of the joints can be expressed as: .
[0042] The feedforward controller described above is a distributed control system within the joint space, meaning the i-th feedforward sensor serves as the input to the feedback controller of the i-th motor, and the feedforward sensor signal corresponds one-to-one with the motor's output feedforward control force. Feedforward controllers are configured for each joint. .
[0043] Specifically, the principle behind the proposed feedforward control within the joint space achieving vibration isolation is as follows: Assuming the system dynamics model is as follows Figure 4 As shown in the figure. The load platform is connected to the foundation via air springs, each air spring being equivalent to a single-degree-of-freedom spring-damped structure in three directions. For simplified analysis, the figure shows: ; ; ; ; ; ; When three-axis motor forces (X, Y, and Z) are simultaneously applied, and X and Z motor forces are applied at points e and g, and Y and Z motor forces are applied at points f and h, then: The motor force at point e is: ; The motor force at point g is: ; in, , .
[0044] Assumption , According to the formula , Applying the motor force at point e to the load's center of mass o, the force at point o is: ; in, .
[0045] Similarly, According to the formula , Applying the motor force at point g to the load's center of mass o, the force at point o is: ; in, .
[0046] The motor force at point f is: ; The motor force at point h is: ; in, , .
[0047] Assumption , .
[0048] After equivalence ; in, .
[0049] Similarly , .
[0050] After equivalence ; in, .
[0051] Therefore, the resultant force at the center of mass o of the load is: ; in,
[0052]
[0053] Therefore, when motor force is present, the complete dynamic equation is: ,Right now: ; in,
[0054]
[0055] The above control process shows that feedforward control affects the system stiffness matrix and damping matrix on the main path. By reducing the values of these matrices, the vibration of the load caused by the ground is reduced. The gain matrix in the control can be changed to a non-diagonal matrix, which can affect all terms of the system stiffness and damping matrix on the main path, achieving better cancellation.
[0056] Preferably, S8 includes: The feedforward control force of each of the motors is ; Represented as .
[0057] In this embodiment, step S10 includes: the control force of each motor is... .
[0058] This application adopts a vibration control strategy that combines absolute acceleration proportional and integral feedback with feedforward suboptimal control. It uses joint space control and coordinate transformation to achieve suboptimal decoupling of the multi-degree-of-freedom system, transforming it into an active vibration isolation system in joint space for active vibration isolation control strategy design.
[0059] Feedback control is used to suppress direct disturbance forces, minimize sensor noise amplification, and ensure robust stability. This invention avoids the problem of vibration amplification at the resonance peak caused by hard mounting. Active damping is artificially added to the system to reduce the peak value at the resonance peak. The controller structure is simple, and the influence of high-frequency noise and low-frequency DC components on the active damping controller is avoided by setting bandpass and notch filters, thus improving system stability.
[0060] The feedforward control method used in this application utilizes the acceleration at the motor mounting foundation position as the feedforward signal, and modifies the stiffness matrix of the closed-loop transmission system. and damping matrix By reducing the values of certain terms in the above terms, the impact of ground vibration can be reduced. The feedforward controller of this invention has only two parameters: the stiffness feedforward coefficient of each joint. and damping gain coefficient It is easy to achieve good adjustment of feedforward control parameters. Compared with the optimal feedforward which requires accurate model identification and parameter tuning, and the huge amount of computation of the adaptive feedforward algorithm, the designed active vibration isolation algorithm has a simple structure that is easy to implement, good system stability, and excellent vibration isolation effect. It does not require identification of system model and adjustable parameters, has a wide range of applications, and is conducive to engineering applications. It has great application prospects in the field of low-to-mid-range vibration control.
[0061] Although embodiments of the present invention have been shown and described above, it is to be understood that the above embodiments are exemplary and should not be construed as limiting the present invention. Those skilled in the art can make changes, modifications, substitutions, and variations to the above embodiments within the scope of the present invention.
[0062] The specific embodiments of the present invention described above do not constitute a limitation on the scope of protection of the present invention. Any other corresponding changes and modifications made in accordance with the technical concept of the present invention should be included within the scope of protection of the claims of the present invention.
Claims
1. A vibration isolation method for precision equipment based on feedforward-feedback composite control, characterized in that: The vibration isolation method for precision equipment based on feedforward feedback composite control includes: S1: Transform the motor and sensor in a single direction, changing the location of the acceleration of the feedforward sensor and the feedback sensor to the location of the motor; S2: Set the feedback control loop and preset the gain coefficient matrix of speed feedback and acceleration feedback; S3: Set a notch filter to remove the influence of resonance peaks generated by coupling in other directions of the vibration isolation platform; S3 includes: Set the notch filter transfer function as follows: ; in f n This is the second-order resonant frequency of the system. The molecular damping ratio of the notch filter. The damping ratio of the denominator of the notch filter; S4: Set a feedback high-pass filter to suppress interference from high-frequency noise; set a low-pass filter to filter low-frequency acceleration signals to avoid drift problems; add the feedback high-pass filter, feedback low-pass filter, and notch filter to the feedback control loop. S4 includes: Set the feedback high-pass filter to ; in, The cutoff frequency of the feedback high-pass filter is used to suppress interference caused by low-frequency noise. Set the feedback low-pass filter to ; in, This is the cutoff frequency of the feedback low-pass filter, used to suppress interference from high-frequency noise. The feedback high-pass filter, the feedback low-pass filter, and the notch filter are added to the feedback control loop. Therefore... ,in This refers to the feedback signal measured by the feedback sensor at the motor position on the load; S5: Obtain the feedback control force of each motor; S6: Determine the proportional feedback coefficient and integral feedback coefficient of acceleration; S7: Set up a feedforward control loop to perform low-pass and high-pass filtering on the output analog signal of the feedforward sensor installed on the ground to prevent interference from low-frequency integral drift and high-frequency noise from the sensor. Add the notch filter to remove the influence of resonance peaks generated by coupling in other directions of the vibration isolation platform. S7 includes: The feedforward signal corresponds one-to-one with the feedforward control force output by the motor; The preset feedforward control loop is: ; Set the feedback high-pass filter as follows: ; in, This is the cutoff frequency of the feedforward high-pass filter, used to suppress noise caused by acceleration below 2Hz; Set the feedforward low-pass filter to ; in, This is the cutoff frequency of the feedforward low-pass filter, used to suppress interference generated by high-frequency noise; set up and This represents the gain coefficient matrix for displacement feedforward and velocity feedforward at each joint. Therefore, the feedforward force of each of the joints can be expressed as: ; The accelerations measured by the four pre-set groups of eight feedforward sensors are as follows: ; The position coordinates of each point of the feedforward sensor are: ; The feedforward signal measured by the feedforward sensor at the motor position on the platform is ,but ; S8: Obtain the feedforward control force of each motor; S9: Set the feedforward control law and adjust the gain coefficient of the feedforward controller; S10: Obtain the control force of each motor; the control force of each motor is: ; in, Indicates the motor control force. Indicates feedforward control force. This indicates feedback control.
2. The vibration isolation method for precision equipment based on feedforward feedback composite control as described in claim 1, characterized in that: S1 includes: Determine the motor position and the direction of the motor's output force; Two acceleration sensors are installed near each of the motors, and the two acceleration sensors include a feedback sensor and a feedforward sensor. The feedback sensor is mounted on the load, and the feedforward sensor is mounted on the platform. The direction of the acceleration it measures is consistent with the direction of the motor output force.
3. The vibration isolation method for precision equipment based on feedforward feedback composite control as described in claim 2, characterized in that: S1 further includes: The pre-set vibration isolation platform includes four sets of vibration isolators, and each set of vibration isolators includes two motors. Therefore, the eight output forces of the eight motors are as follows: ; The coordinates of the position points of each motor are as follows: ; The accelerations measured by the four groups of eight feedback sensors are as follows: ; The position coordinates of each point of the feedback sensor are as follows: ; The preset transformation matrix from the feedback sensor to the motor is as follows: The transformation matrix from the feedforward sensor to the motor is: ,but .
4. The vibration isolation method for precision equipment based on feedforward feedback composite control as described in claim 3, characterized in that: S2 includes: The feedback signal corresponds one-to-one with the feedback control force of the motor; The feedback control loop is as follows: ; ; Among them, the acceleration feedback gain coefficient K vi Used to improve the ability to suppress high-frequency direct interference; Skyhook damping was added to improve the suppression of interference frequencies close to the suspension frequency; acceleration feedback gain. K ai It can shift the system's resonance peak, providing a soft vibration isolation effect for the system; i Represents joint number ; set up and This represents the gain coefficient matrix for the velocity and acceleration feedback of each joint.
5. The vibration isolation method for precision equipment based on feedforward feedback composite control as described in claim 4, characterized in that: S5 includes: The feedback control force of each motor is ; Represented as .
6. The vibration isolation method for precision equipment based on feedforward feedback composite control as described in claim 5, characterized in that: S6 includes: determining the acceleration proportional feedback coefficient. K a Its calculation formula is ,in f 1 represents the first natural frequency of a single-degree-of-freedom system. f 2 represents the system's natural frequency after the resonant peak is moved; Determine the integral feedback coefficient of acceleration Its calculation formula is To achieve the optimal damping ratio.
7. The vibration isolation method for precision equipment based on feedforward feedback composite control as described in claim 6, characterized in that: S8 includes: The feedforward control force of each of the motors is ; Represented as .
Citation Information
Patent Citations
Unbalance identification and vibration suppression control system for magnetic suspension rotating machinery
CN103425051A
Active vibration removing apparatus
JP2012041983A
