Photoelectric stabilized platform dimension reduction active disturbance rejection control method based on feedforward and filtering
By using the feedforward compensation of Kalman filter, minimum jerk constraint tracking differential and LuGre friction model in the photoelectric stabilization platform servo control system, the trade-off problem of linear self-immune control method in bandwidth adjustment is solved, and the control accuracy is improved and immunity performance, achieving smooth transition and efficient immunity of the system.
Patent Information
- Application Number
- CN202411137895.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-19
- Publication Date
- 2024-11-22
AI Technical Summary
When the photoelectric stable platform servo control system faces nonlinear friction and sensor uncertainty, the linear self-immune control method has the problem of bandwidth adjustment, resulting in convergence delay of system observations and noise pollution.
Using the dimensionality reduction self-immunity control method based on feedforward and filtering, friction feedforward compensation is performed through Kalman filter denoising, tracking differentializer with minimal jerk constraints and LuGre friction model to reduce the complexity and noise resistance of the controller. .
The servo control accuracy and immunity performance are improved, delay is reduced, and the smooth transition of the system is achieved through the minimum Jerk motion trajectory, which significantly improves the control accuracy and immunity.
Smart Images

Figure CN119002279A_ABST
Abstract
Description
Technical Field
[0001] The present invention belongs to the technical field of servo control of an optoelectronic stabilized platform, and in particular relates to a dimensionality reduction self-disturbance rejection control method of an optoelectronic stabilized platform based on feedforward and filtering, which can be used for servo control of an optoelectronic stabilized platform. Background Art
[0002] The servo performance of the optoelectronic stabilized platform is affected by many environmental factors. Highly nonlinear friction and sensor uncertainty are two of the major factors. In order to improve the steady-state tracking accuracy and disturbance resistance of the servo control system of the optoelectronic stabilized platform, many high-precision control algorithms have been proposed. Since the precise mathematical model of the optoelectronic stabilized platform is not easy to obtain, some control algorithms with low model dependence are more commonly used. Among them, the linear anti-disturbance control method is widely used.
[0003] The linear ADRC method is an improvement on the traditional ADRC method. The traditional ADRC structure is relatively complex and is rarely used in engineering practice. The linear ADRC method uses the bandwidth adjustment method to simplify it, greatly reducing its complexity. It is widely used in actual engineering due to its simple implementation and high control accuracy. However, the linear ADRC method faces the following trade-offs: when the controller bandwidth is low, the system observation value cannot converge to the true value quickly, resulting in delays and errors; when the controller bandwidth is high, the controller will inevitably be contaminated by the high-frequency noise in the system. Summary of the invention
[0004] In order to solve the above technical problems, the present invention provides a dimensionality reduction self-disturbance rejection control method for an optoelectronic stable platform based on feedforward and filtering, which is executed by a servo control system and includes: Step 1: Measure the current pointing angle of the optoelectronic stabilization platform in the servo control system through the encoder in the servo control system , and use the difference method to obtain the current angular velocity based on the photoelectric stabilized platform coordinate system . Given a reference position ,definition , specify the transition process time ; Step 2: Use the Kalman filter in the servo control system to filter and denoise the current pointing angle data of the optoelectronic stabilized platform measured by the encoder to obtain the true value of the current pointing angle of the optoelectronic stabilized platform; Step 3: Through the tracking differentiator in the dimension reduction ADRC in the servo control system, the obtained in step 1 and , arranging a transition process for a servo control system, wherein the tracking differentiator is a tracking differentiator based on a minimum jerk constraint; Step 4: Based on the output of the Kalman filter in each cycle obtained in step 2, an estimate of the current angular velocity and total interference of the optoelectronic stabilized platform is established; Step 5: Perform friction feed-forward compensation based on the angular velocity estimation obtained in step 4, and the friction feed-forward compensation is performed using the LuGre friction model; Step 6: Calculate the output of the controller in the servo control system using the friction feedforward calculated by the LuGre friction model and the angular velocity estimate after friction feedforward compensation.
[0005] Beneficial effects: The present invention is used for high-precision control of the servo control system of the optoelectronic stabilization platform, alleviating the impact of the linear anti-disturbance control performance trade-off on the system, improving the servo control accuracy, enhancing the anti-disturbance performance, and reducing the servo delay. At the same time, the minimum jerk motion trajectory is used as the servo reference trajectory to achieve a smooth transition of the servo system. BRIEF DESCRIPTION OF THE DRAWINGS
[0006] Figure 1 A typical structural diagram of the servo control system referred to in the present invention; Figure 2 It is an application block diagram of the feedforward and filtering-based dimensionality reduction self-disturbance rejection control method of the optoelectronic stabilization platform of the present invention; Figure 3 The performance comparison between the minimum jerk motion trajectory tracking differentiator adopted by the present invention and the traditional tracking differentiator in linear active disturbance rejection control at the same transition time is shown; Figure 4 This is a comparison chart of the implementation effect under low bandwidth gain. Figure 4 (a) shows the trajectory and error curves of the algorithm using the integrated dimensionality reduction auto-disturbance rejection controller and Kalman filter (referred to as "RADRC+KF" in the figure, the same below) and the linear auto-disturbance rejection control method (referred to as "LADRC" in the figure, the same below) when tracking low-frequency sinusoidal signals; (b) shows the trajectory and error curves of the above two methods when tracking high-frequency sinusoidal signals; (c) shows the trajectory and error curves of the above two methods when tracking step signals and resisting external disturbances; (d) shows the trajectory and error curves of the algorithm using the integrated dimensionality reduction auto-disturbance rejection controller and Kalman filter with or without LuGre friction feedforward when tracking low-frequency sinusoidal signals; (e) shows the trajectory and error curves of the algorithm using the integrated dimensionality reduction auto-disturbance rejection controller and Kalman filter with or without LuGre friction feedforward when tracking high-frequency sinusoidal signals.
[0007] Figure 5 This is a comparison chart of the implementation effect under high bandwidth gain. Figure 5(a) shows the trajectory and error curves of the dimensionality reduction auto-disturbance rejection controller, Kalman filter algorithm and linear auto-disturbance rejection control method when tracking low-frequency sinusoidal signals; (b) shows the trajectory and error curves of the above two methods when tracking high-frequency sinusoidal signals; (c) shows the trajectory and error curves of the above two methods when tracking step signals and resisting external disturbances; (d) shows the trajectory and error curve of the algorithm integrating the dimensionality reduction auto-disturbance rejection controller and Kalman filter with or without LuGre friction feedforward when tracking low-frequency sinusoidal signals; (e) shows the trajectory and error curve of the algorithm integrating the dimensionality reduction auto-disturbance rejection controller and Kalman filter with or without LuGre friction feedforward when tracking high-frequency sinusoidal signals. DETAILED DESCRIPTION
[0008] The exemplary embodiments of the present disclosure will be described in more detail below with reference to the accompanying drawings. Although the exemplary embodiments of the present disclosure are shown in the accompanying drawings, it should be understood that the present disclosure can be implemented in various forms, and the present disclosure should not be limited by the embodiments described herein. On the contrary, these embodiments are provided to enable a more thorough understanding of the present disclosure and to fully convey the scope of the present disclosure to those skilled in the art.
[0009] The present invention provides a dimensionality reduction auto-disturbance rejection control method for an optoelectronic stabilized platform based on feedforward and filtering, which can be used for steady-state tracking control and anti-disturbance control of an optoelectronic stabilized platform. Compared with the common linear auto-disturbance rejection control method, the present method has higher control accuracy and better anti-disturbance performance.
[0010] Figure 1 The figure shows a typical servo control system structure of the present invention. As shown in the figure, the complete servo control system consists of a controller, a driver, a motor (only the pitch axis motor is shown), and an encoder (only the pitch axis encoder is shown). The motor and the encoder are fixed on the optoelectronic stabilization platform. The inertial measurement unit on the side of the optoelectronic stabilization platform is used for feedforward when the optoelectronic stabilization platform is fixed on a non-ground-based carrier (such as an aircraft) and is not necessary (therefore, Figure 2 not shown). Figure 1 The controller in the embodiment executes the dimensionality reduction self-disturbance rejection control method of the optoelectronic stabilization platform based on feedforward and filtering proposed by the present invention.
[0011] like Figure 2 As shown, the entire servo control system (the servo control system corresponds to Figure 2 The input of the controller (the sum of the controlled object and the feedback loop) is the desired position of the optoelectronic stabilized platform, also known as the reference position. The input is first passed through Figure 2The tracking differentiator in the reduced-dimensionality ADRC shown in , the output of the tracking differentiator is the arranged reference angle input and reference angular velocity input. The reference angle input and reference angular velocity input are used for friction feedforward and system state reconstruction. The output of the LuGre friction feedforward link, the total disturbance output estimated by the reduced-dimensionality linear extended state observer and the output constructed by the linear state error feedback control law together constitute the controller (i.e. Figure 1 The output of the controller shown in Figure 1 is the output of the turntable system driver (i.e. Figure 1 The output of the entire servo control system is the angle of rotation of the optoelectronic stabilization platform, which is measured by a high-precision encoder and filtered by a Kalman filter. The above-mentioned dimensionality reduction self-disturbance rejection controller, LuGre friction feedforward link, dimensionality reduction linear expansion state observer, etc., as well as Kalman filter and linear state error feedback control law are all Figure 1 The module in the controller. This method models the friction torque and performs feedforward compensation, which improves the inherent delay of feedback control. At the same time, this method requires fewer reconstructed variable dimensions than the traditional linear ADRC, and converges faster than the traditional linear ADRC, which alleviates the inherent trade-off between convergence speed and noise resistance and can achieve higher accuracy.
[0012] The above-mentioned dimensionality reduction self-disturbance rejection control method of the optoelectronic stabilization platform based on feedforward and filtering specifically includes the following steps: Step 1: Measure the current pointing angle of the optoelectronic stabilization platform in the servo control system through the encoder in the servo control system , and use the difference method to obtain the current angular velocity based on the photoelectric stabilized platform coordinate system . Given a reference position ,definition . Also specify the transition time , which means the expected time for the specified system to transfer from the initial state to the final state.
[0013] Step 2: Use the Kalman filter in the servo control system to calculate the current pointing angle of the optoelectronic stabilized platform measured by the encoder. Perform filtering and denoising to obtain the optimal estimate of the current pointing angle of the optoelectronic stabilization platform. This step is performed because: the current pointing angle of the optoelectronic stabilization platform obtained in step 1 Contains noise, which is the superposition of the current true pointing angle of the optoelectronic stabilized platform and random noise. The so-called optimal estimate means that the absolute value of the difference between it and the current true pointing angle of the optoelectronic stabilized platform is the smallest. The optimal estimate is the posterior estimate obtained by the Kalman filter based on formulas (1) and (2) by performing "prediction" and "correction".
[0014] The state transfer equation and output equation of the Kalman filter involved in this step are: (1) (2) In the formula, are the pointing angle and angular velocity of the optoelectronic stabilization platform at the kth step, is the pointing angle of the optoelectronic stabilization platform at the k+1th step. is the output of the system measured by the encoder at the kth step, Figure 2 as shown in . is the sampling interval, They are the modeling noise and observation noise of the servo control system respectively. In practical engineering applications, they are generally assumed to be Gaussian white noise.
[0015] In each cycle of the algorithm, the Kalman filter performs a complete "prediction" and "correction". The above only shows the state transfer equation and the output equation. Since the present invention does not change the execution process of the Kalman filter, and the process of the Kalman filter performing prediction and correction and other equations contained in the process are contents that can be obtained by those skilled in the art from the disclosed technology, this application does not describe this aspect in detail.
[0016] Step 3: Based on the results obtained in step 1 and , arrange the reference motion trajectory and reference angular velocity for the optoelectronic stabilized platform. This step is completed by the tracking differentiator in the dimension reduction self-disturbance rejection controller. The tracking differentiator is a tracking differentiator based on the minimum jerk constraint. In kinematics, jerk refers to the first-order derivative of the acceleration of an object's motion. Based on the minimum jerk constraint, it means that the motion trajectory and velocity curve planned by the tracking differentiator are based on minimizing the jerk of the planned motion trajectory, thereby obtaining the smoothest motion trajectory. The trajectory based on the minimum jerk constraint is introduced below. Assume a process variable ,in , (3) In the formula and are the final state moment and the initial state moment of the photoelectric stabilization platform, respectively, and t is the time of the photoelectric stabilization platform. Then the tracking differentiator arranges the minimum jerk reference motion trajectory for the photoelectric stabilization platform and the reference angular velocity They are: (4) (5) In the formula, , , (6) (7) (8) (9) in, are the initial velocity and initial acceleration of the optoelectronic stabilized platform. In steady-state tracking control, they can be considered to be 0. Figure 3 The performance comparison of the tracking differentiator used and the tracking differentiator in the traditional linear anti-disturbance control algorithm when the same transition time is specified is shown. It can be seen that under the same transition time, the tracking differentiator based on the minimum jerk constraint has a smoother angle trajectory, a lower maximum angular velocity, and a lower maximum angular acceleration as can be seen from the tangent slope of the angular velocity curve (not shown in the figure). Given that the maximum angular acceleration is an important safety indicator in engineering, the tracking differentiator based on the minimum jerk constraint has a larger safety margin at the same transition time, and has the ability to arrange a shorter transition process under the same maximum allowable angular acceleration.
[0017] Step 4: According to the optimal estimate given by the Kalman filter in each cycle obtained in step 2, an estimate of the current angular velocity and total disturbance of the optoelectronic stabilized platform is established. This step is completed by the reduced-dimensional linear extended state observer in the reduced-dimensional ADRC.
[0018] Firstly, the current pointing angle and angular velocity of the optoelectronic stabilized platform are selected as state variables, and an additional one-dimensional state variable is added as an estimation of the total interference to establish the state space equation of the optoelectronic stabilized platform.
[0019] (10) in, is the state variable of the optoelectronic stabilization platform, It is the input of the driver in the servo control system, that is, the output of the controller in the servo control system. is the derivative of the total disturbance acting on the optoelectronic stabilization platform, It is the output of the optoelectronic stabilized platform, that is, the current pointing angle of the optoelectronic stabilized platform. , , , , . They are respectively the current pointing angle and current angular velocity of the optoelectronic stabilized platform. is the total disturbance acting on the optoelectronic stabilization platform. It is the virtual input gain provided to the optoelectronic stabilization platform.
[0020] Current pointing angle of the servo control system As the output of the servo control system can be obtained directly, there is no need to estimate and reconstruct it, but only the current angular velocity and total disturbance need to be estimated. The estimation equation is as follows: (11) in, They are the current angular velocity and total interference The estimate, , are their derivatives respectively, is the observation gain, is the derivative of the output of the optoelectronic stabilized platform.
[0021] In addition, in practical applications, the gain-bandwidth method is used to configure the poles of the dimension-reduced linear expansion state observer to obtain the desired performance. Assume that the desired observation bandwidth is According to the estimation equation (11) of the reduced-dimensional linear extended state observer system, the characteristic polynomial of the reduced-dimensional linear extended state observer can be written as: (12) Among them, the left side of the equal sign in equation 12 is the representation of the characteristic polynomial, and s is the complex frequency domain parameter. According to the pole configuration theory, the desired closed-loop dominant pole can be configured by observing the bandwidth, that is, the characteristic polynomial (12) has the following form: (13) in, is the expected observation bandwidth.
[0022] It can be obtained that the observation bandwidth and observation gain have the following relationship: , .
[0023] Step 5: Estimate the angular velocity based on the one obtained in step 4 Friction feedforward compensation is performed. The friction feedforward compensation is performed using the LuGre friction model in order to estimate the friction force separately rather than including it in the total disturbance. The LuGre friction model is currently a relatively accurate model for describing friction force, and can reasonably describe the static and dynamic performance of nonlinear friction at low and high speeds. Its expression is as follows: (14) In the formula, is the relative angular velocity between the contact surfaces of the servo control system motor shaft, is the Stribeck angular velocity, is the Stribeck effect description function, is the static friction torque of the servo control system motor drive shaft, Its Coulomb friction torque is, is the internal state of the LuGre friction model, is its derivative. are the stiffness coefficient, damping coefficient and viscous friction coefficient of the friction torque respectively. is the calculated feedforward friction torque value.
[0024] In each cycle of the algorithm execution, when the angular velocity estimate After being updated, the feedforward friction torque value can be obtained according to the above formula, and the feedforward friction torque value is also called the friction feedforward amount.
[0025] After the friction feedforward amount is calculated, the angular velocity estimate obtained in step 4 is subjected to friction feedforward compensation to obtain the angular velocity estimate after friction feedforward compensation, that is, equation (11) becomes (15) Step 6: Calculate the output of the controller in the servo control system by using the friction feedforward and the estimated angular velocity after friction feedforward compensation, as well as the reference motion trajectory and reference angular velocity of the optoelectronic stabilized platform calculated in step 3. This step is obtained by the linear state error feedback control law (LSEF) in the system. The input of the optoelectronic stabilized platform driver is shown in the following equation.
[0026] (16) In the formula, It is the output of the servo control system controller, which is also the input of the servo control system driver. To provide virtual input to the driver in the servo control system, The calculation process is derived.
[0027] Substituting equation (16) into equation (10), we get the following relationship between the output of the optoelectronic stabilization platform and the virtual input of the driver: (17) in, is the second-order derivative of the output of the optoelectronic stabilization platform. When the algorithm is running in steady state, the estimated value of the total interference can converge to its true value. Therefore, in steady state, the first term on the right side of equation (17) is Almost 0.
[0028] It can be seen from equation (17) that this algorithm actually compensates the servo control system into an approximate double-integral system. An approximate double-integral system means that when the system is running continuously, the first term on the right side of equation (17) is approximately 0, so equation (17) becomes an equation containing a second-order derivative. This means that the output of the optoelectronic stabilization platform is obtained by integrating the virtual input of the driver twice. Therefore, the linear combination of the two integration results and the reference input error is selected as the feedback control law, that is: (18) In the formula, To track the reference motion trajectory and reference angular velocity arranged by the differentiator, is the control gain of the servo control system.
[0029] The pole configuration method is also used in engineering design. Assume that the desired control bandwidth of the servo control system is , then there is the following relationship between its control gain and control bandwidth: , , in, is the damping ratio. It is usually chosen as 1.
[0030] The above implementation is described below with an example. Take an optoelectronic stabilization platform as an example. and reference position .definition , and use the difference method to obtain the current angular velocity based on the photoelectric stabilized platform coordinate system . Specify the system execution frequency as 2KHz. At the same time, specify the step signal transition process time Then the Kalman filter is used to filter the current pointing angle data. The sampling interval can be obtained from the execution frequency , the modeling noise and observation noise covariances are specified as and . The relevant parameters of the servo system are applied, and experiments are carried out on an actual optoelectronic stabilization platform. In order to independently illustrate the effectiveness of each part of the present invention, the following two groups of experiments are carried out: 1) Only the dimensionality reduction self-disturbance rejection controller and the Kalman filter algorithm are used to compare the control performance with the linear self-disturbance rejection control method; 2) On the basis of the dimensionality reduction self-disturbance rejection control and the Kalman filter algorithm, the LuGre friction feedforward is added to carry out a control performance comparison experiment. In addition, experiments are also carried out under low bandwidth conditions (25Hz) and high bandwidth conditions (50Hz).
[0031] Figure 4 This is a comparison chart of the implementation effects under low bandwidth gain. Figure 4(a) shows the trajectory and error curves of the algorithm of the integrated reduced-order active disturbance rejection control (RADRC) and Kalman filter (Kalman filter) proposed in the present invention (represented by "RADRC+KF" in the legend, the same below) and the linear active disturbance rejection control method (LADRC) (represented by "LADRC" in the legend, the same below) when tracking low-frequency sinusoidal signals; (b) shows the trajectory and error curves of the above two methods when tracking high-frequency sinusoidal signals; (c) shows the trajectory and error curves of the above two methods when tracking step signals and resisting external disturbances; (d) shows the trajectory and error curve of the algorithm of the integrated reduced-order active disturbance rejection control (RADRC) and Kalman filter proposed in the present invention when tracking low-frequency sinusoidal signals with or without LuGre friction feedforward; (e) shows the trajectory and error curve of the algorithm of the integrated reduced-order active disturbance rejection control (RADRC) and Kalman filter proposed in the present invention when tracking high-frequency sinusoidal signals with or without LuGre friction feedforward. Figure 5 The following is a comparison chart of the implementation effect under high bandwidth gain. Except for the change in bandwidth conditions, all other parameters remain the same as those under low bandwidth conditions. Figure 5 The meaning of each sub-graph is Figure 4 Be consistent.
[0032] from Figure 4 and Figure 5 It can be seen that the control performance of the present invention under the same high and low bandwidth conditions is significantly improved compared with the linear active disturbance rejection control.
[0033] The specific embodiments described above further illustrate the objectives, technical solutions and beneficial effects of the present invention in detail. It should be understood that the above description is only a specific embodiment of the present invention and is not intended to limit the present invention. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principles of the present invention should be included in the scope of protection of the present invention.
Claims
1. A dimensionality reduction self-disturbance rejection control method for an optoelectronic stabilization platform based on feedforward and filtering, executed by a servo control system, characterized in that: include: Step 1: Measure the current pointing angle of the optoelectronic stabilization platform in the servo control system through the encoder in the servo control system , and use the difference method to obtain the current angular velocity based on the photoelectric stabilized platform coordinate system , given a reference position ,definition , specify the transition process time ; Step 2: Using the Kalman filter in the servo control system to filter and de-noise the current pointing angle data of the optoelectronic stabilized platform measured by the encoder, so as to obtain the optimal estimated value of the current pointing angle of the optoelectronic stabilized platform, wherein the optimal estimated value means that the error between the optimal estimated value and the actual current pointing angle of the optoelectronic stabilized platform is the smallest; Step 3: Through the tracking differentiator in the dimension reduction ADRC in the servo control system, the obtained in step 1 and Arranging a reference motion trajectory and a reference angular velocity for an optoelectronic stabilized platform, wherein the tracking differentiator is a tracking differentiator based on a minimum jerk constraint; Step 4: Based on the output of the Kalman filter in each cycle obtained in step 2, an estimate of the current angular velocity and total interference of the optoelectronic stabilized platform is established; Step 5: Perform friction feed-forward compensation based on the angular velocity estimation obtained in step 4, and the friction feed-forward compensation is performed using the LuGre friction model; Step 6: Based on the friction feedforward calculated by the LuGre friction model and the angular velocity estimate after friction feedforward compensation, as well as the reference motion trajectory and reference angular velocity arranged in step 3, the output of the controller in the servo control system is calculated as the input of the driver to drive the optoelectronic stabilized platform to perform the given action.
2. The dimensionality reduction self-disturbance rejection control method of the optoelectronic stabilization platform based on feedforward and filtering according to claim 1 is executed by a servo control system, characterized in that: In step 2, the state transfer equation and output equation of the Kalman filter are: (1) (2) In the formula, are the pointing angle and angular velocity of the optoelectronic stabilization platform at the kth step, is the pointing angle of the optoelectronic stabilization platform at the k+1th step, is the output of the system at step k measured by the encoder, is the sampling interval, are the modeling noise and observation noise of the servo control system respectively.
3. The dimensionality reduction self-disturbance rejection control method of the optoelectronic stabilization platform based on feedforward and filtering according to claim 2 is executed by a servo control system, characterized in that: Arranging the transition process for the servo control system in step 3 includes: Assume a process variable ,in, , .(3) In the formula, and are the final state moment and the initial state moment of the photoelectric stabilization platform, respectively. t is the time of the photoelectric stabilization platform's motion. Then the tracking differentiator arranges the reference motion trajectory for the photoelectric stabilization platform. and the reference angular velocity They are: (4) (5) In the formula, , , (6) (7) (8) (9) in, are the initial velocity and initial acceleration of the optoelectronic stabilized platform.
4. The dimensionality reduction self-disturbance rejection control method of the optoelectronic stabilization platform based on feedforward and filtering according to claim 3 is executed by a servo control system, characterized in that: Step 4 involves establishing the state-space equations for the optoelectronic stabilization platform: (10) in, is the state variable of the optoelectronic stabilization platform, is the input of the driver in the servo control system, is the derivative of the total disturbance acting on the optoelectronic stabilization platform, is the output of the optoelectronic stabilization platform, that is, the current pointing angle of the optoelectronic stabilization platform. , , , , , are the current pointing angle and current angular velocity of the optoelectronic stabilization platform, is the total disturbance acting on the optoelectronic stabilization platform, is the virtual input gain provided to the optoelectronic stabilization platform, The current angular velocity and total disturbance are estimated, and the estimation equation is shown as follows: (11) in, They are the current angular velocity and total interference The estimate, , are their derivatives respectively, is the observation gain, is the derivative of the output of the optoelectronic stabilized platform.
5. The dimensionality reduction self-disturbance rejection control method of the optoelectronic stabilization platform based on feedforward and filtering according to claim 4 is executed by a servo control system, characterized in that: In step 5, the expression of the LuGre friction model is as follows: (14) In the formula, is the relative angular velocity between the contact surfaces of the servo control system motor shaft, is the Stribeck angular velocity, is the Stribeck effect description function, is the static friction torque of the servo control system motor drive shaft, Its Coulomb friction torque is, is the internal state of the LuGre friction model, Its derivative is are the stiffness coefficient, damping coefficient and viscous friction coefficient of the friction torque, is the calculated friction feedforward amount; In each cycle of the algorithm execution, when the angular velocity estimate Get updated, and get the friction feedforward according to the above formula; After the friction feedforward amount is calculated, the angular velocity estimate obtained in step 4 is subjected to friction feedforward compensation to obtain the angular velocity estimate after friction feedforward compensation, that is, equation (11) becomes: (15)。 6. The dimensionality reduction self-disturbance rejection control method of the optoelectronic stabilization platform based on feedforward and filtering according to claim 5 is executed by a servo control system, characterized in that: In step 6, the input of the optoelectronic stabilization platform driver is as follows: (16) In the formula, It is the output of the controller in the servo control system, which is also the input of the optoelectronic stabilization platform driver. is the virtual input of the drive, The calculation process is as follows: Substituting equation (16) into equation (10), we get the following relationship between the output and input of the optoelectronic stabilization platform: (17) in, is the second-order derivative of the output of the optoelectronic stabilization platform; from equation (17), we can see that the servo control system is compensated into an approximate double-integral system, so the linear combination of the two integral results and the reference input error is selected as the feedback control law, that is, (18) In the formula, To track the reference motion trajectory and reference angular velocity arranged by the differentiator, is the control gain of the servo control system; Assume that the desired control bandwidth of the servo control system is , then there is the following relationship between its control gain and control bandwidth: , , in, is the damping ratio.
Citation Information
Cited By
Self-stabilization control photoelectric tracking turntable and method based on rate gyroscope
CN120406581A
Rotary table motion control method based on time-varying interference compensation and predictive control
CN121028560A
Turntable motion control method based on time-varying disturbance compensation and predictive control
CN121028560B
