A method for stabilizing an optoelectronic guidance platform based on nonlinear filtering correction
By using a nonlinear filtering correction method, the problem of insufficient stability in traditional photoelectric guidance platforms was solved, achieving high-precision attitude stabilization control and strong anti-interference capability.
Patent Information
- Application Number
- CN202211463612.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-11-22
- Publication Date
- 2024-11-15
- Estimated Expiration
- 2042-11-22
AI Technical Summary
Traditional photoelectric guidance stabilization platforms, which employ linear transfer function theory, struggle to handle the nonlinearity and unmodeled interference inherent in the system itself, resulting in insufficient platform stability and anti-interference capabilities.
A nonlinear filtering correction method is adopted, which involves steps such as inertial lag filtering, nonlinear calculation and integral filtering to achieve nonlinear filtering and integration of the line-of-sight angle and platform angular velocity, forming a unified nonlinear filter corrector for attitude stabilization control.
This improved the stability and anti-interference capability of the photoelectric guidance platform, enabling high-precision attitude stabilization control.
Smart Images

Figure CN115823950B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of stabilization of a precision-guided optoelectronic platform, and in particular to a method for stabilizing an optoelectronic guidance platform based on nonlinear filtering correction. Background Art
[0002] The photoelectric guidance stabilization platform is an indispensable and important equipment for photoelectric imaging and guidance equipment, and is also the carrier of photoelectric imaging equipment. Its stability and stability quality will be closely related to the quality of imaging. If the stability quality is not high, such as flutter, the photoelectric imaging will appear virtual or double images, which will greatly affect the accuracy of photoelectric guidance measurement. The traditional photoelectric guidance stabilization platform is designed by using the linear transfer function theory plus filtering compensation and other ideas. Due to the limitations of linear theory, it is difficult to deal with the model nonlinearity and unmodeled interference parts that must exist in the system itself. The rich dynamic characteristics of the nonlinear system can provide more options for the control system, and it has a unique advantage in dealing with nonlinear interference problems. Based on the above background reasons, the present invention adopts the idea of nonlinear filtering correction to perform attitude stabilization control on the photoelectric guidance stabilization platform. Through the nonlinear filtering corrector with unified structure, the nonlinear filtering compensation terms of attitude and attitude angular velocity are solved, so that the present invention has the advantages of unified and simple internal and external loops of the scheme, and high control accuracy and strong anti-interference ability, which also makes the present invention have high theoretical and engineering value.
[0003] It should be noted that the information disclosed in the above background technology section is only used to enhance the understanding of the background of the present invention, and therefore may include information that does not constitute prior art known to ordinary technicians in the field. Summary of the invention
[0004] The purpose of the present invention is to provide a method for stabilizing an optoelectronic guidance platform based on nonlinear filtering correction, thereby overcoming the problems of poor platform stability and anti-interference ability caused by limitations and defects of related technologies.
[0005] According to one aspect of the present invention, a method for stabilizing an optoelectronic guidance platform based on nonlinear filtering correction is provided, comprising the following steps:
[0006] Step S10, install a rate gyro on the precision-guided photoelectric guidance platform to measure the pitch angular velocity signal of the photoelectric guidance platform, denoted as ω1; at the same time, install a rate gyro on the base of the photoelectric guidance platform to measure the pitch angular velocity signal of the platform base, denoted as ω b ; Use IRFPA infrared camera to take pictures and measure, and then process the data to get the sight angle signal of the optoelectronic guidance platform, denoted as q.
[0007] Step S20, according to the sight angle signal, first perform inertial lag filtering processing to obtain a sight angle lag signal; then use the sight angle lag signal to compare with the sight angle signal to solve the sight angle first-order difference signal; then perform inertial lag filtering processing to obtain the sight angle first-order difference lag signal; compare with the sight angle first-order difference signal to obtain the sight angle second-order difference signal; finally, obtain the sight angle second-order nonlinear filtering signal through nonlinear operation.
[0008] Step S30, performing a nonlinear integral filtering operation on the sight angle second-order nonlinear filtering signal to obtain a sight angle first-order nonlinear filtering signal; then performing a nonlinear integral filtering operation on the sight angle first-order nonlinear filtering signal to obtain a sight angle zero-order filtering signal; then combining the sight angle zero-order filtering signal, the sight angle first-order filtering signal and the sight angle second-order filtering signal to obtain a sight angle combination signal; then performing a nonlinear integral filtering operation on the sight angle combination signal to obtain a sight angle combination nonlinear integral signal; then superimposing the sight angle signal, the photoelectric guidance platform pitch angular velocity signal and the platform base pitch angular velocity signal to obtain a sight angle sliding mode signal, and performing a softening transformation to obtain an expected photoelectric guidance platform angular velocity signal.
[0009] Step S40, according to the expected angular velocity signal of the photoelectric guidance platform, the angular velocity signal of the photoelectric guidance platform is compared to obtain a platform angular velocity error signal; then an inertial lag filtering process is performed to obtain a platform angular velocity error lag signal; then the platform angular velocity error lag signal is compared with the platform angular velocity error signal to obtain a first-order differential signal of the platform angular velocity error; then an inertial lag filtering process is performed to obtain a first-order differential lag signal of the platform angular velocity error; then the signal is compared with the first-order differential signal of the platform angular velocity error to obtain a second-order differential signal of the platform angular velocity error; finally, a second-order nonlinear filtering signal of the platform angular velocity error is obtained through nonlinear operation.
[0010] Step S50, performing a nonlinear integral filtering operation on the second-order nonlinear filtering signal of the platform angular velocity error to obtain a first-order nonlinear filtering signal of the platform angular velocity error; then performing a nonlinear integral filtering operation on the first-order nonlinear filtering signal of the platform angular velocity error to obtain a zero-order filtering signal of the platform angular velocity error; then combining the zero-order filtering signal of the platform angular velocity error, the first-order filtering signal of the platform angular velocity error and the second-order filtering signal of the platform angular velocity error by the platform angular velocity error signal to obtain a combined signal of the platform angular velocity error; then performing a nonlinear integral filtering operation on the combined signal of the platform angular velocity error to obtain a combined nonlinear integral signal of the platform angular velocity error; then superimposing the platform angular velocity error signal, the sight angle signal of the photoelectric guidance platform and the pitch angular velocity signal of the platform base to obtain a final total signal of platform stability control, which is transmitted to the torque motor to drive the photoelectric guidance platform and its load to achieve attitude stability control of the photoelectric guidance platform.
[0011] In an exemplary embodiment of the present invention, according to the sight angle signal, firstly, an inertial lag filtering process is performed to obtain a sight angle lag signal; then, the sight angle lag signal is compared with the sight angle signal to obtain a first-order difference signal of the sight angle; then, the sight angle first-order difference lag signal is obtained by inertial lag filtering process; then, the sight angle second-order difference signal is obtained by comparing it with the first-order difference signal of the sight angle; finally, the sight angle second-order nonlinear filtering signal is obtained by nonlinear operation, including:
[0012]
[0013] q1=(qq 1a ) / a1;
[0014]
[0015] q2=(q1-q 2a ) / a2;
[0016]
[0017] Where a1 and a2 are constant time parameters of the inertial lag filter, s is the transfer function of the inertial lag filter, and q 1a is the sight angle lag signal; q1 is the sight angle first-order difference signal; q 2a is the first-order differential lag signal of the sight angle; q2 is the second-order differential signal of the sight angle; q d2 is the second-order nonlinear filtering signal of the sight angle; T1, T2, T3, T4 are the constant time parameters of the second-order nonlinear filter; q d1 With q d The definition and calculation of is shown in the next step.
[0018] In an exemplary embodiment of the present invention, a nonlinear integral filtering operation is performed according to the second-order nonlinear filtering signal of the sight angle to obtain a first-order nonlinear filtering signal of the sight angle; a nonlinear integral filtering operation is then performed according to the first-order nonlinear filtering signal of the sight angle to obtain a zero-order filtering signal of the sight angle; a sight angle zero-order filtering signal, a sight angle first-order filtering signal and a sight angle second-order filtering signal are combined by the sight angle signal to obtain a sight angle combination signal; a nonlinear integral filtering operation is then performed on the sight angle combination signal to obtain a sight angle combination nonlinear integral signal; the sight angle signal, the photoelectric guidance platform pitch angular velocity signal and the platform base pitch angular velocity signal are superimposed to obtain a sight angle sliding mode signal, and a softening transformation is performed to obtain an expected signal of the photoelectric guidance platform angular velocity, which includes:
[0019]
[0020]
[0021] q dw =c1q+c2q d +c3q d1 +c4q d2 ;
[0022]
[0023] s a =k1q+k2ω1+k3s1+k4ω b ;
[0024]
[0025] Where T is the constant time parameter of the nonlinear filter integral, ε0, ε1, ε2, ε3 are the constant parameters of the nonlinear filter integral; q d1 is the first-order nonlinear filtering signal of the sight angle; q d is the zero-order filtering signal of the sight angle; c1, c2, c3, c4 are constant parameters of the combined signal, q dw is the sight angle combined signal; s1 is the sight angle combined nonlinear integral signal; k1, k2, k3, k4 are the constant parameters of the sliding surface, s a is the line of sight angle sliding mode signal, ω d is the expected signal of angular velocity of the photoelectric guidance platform, and c5 is a constant control parameter.
[0026] In an exemplary embodiment of the present invention, the desired angular velocity signal of the photoelectric guidance platform is compared with the angular velocity signal of the photoelectric guidance platform to obtain a platform angular velocity error signal; then an inertial hysteresis filtering process is performed to obtain a platform angular velocity error hysteresis signal; then the platform angular velocity error hysteresis signal is compared with the platform angular velocity error signal to obtain a first-order differential signal of the platform angular velocity error; then an inertial hysteresis filtering process is performed to obtain a first-order differential hysteresis signal of the platform angular velocity error; then the first-order differential hysteresis signal of the platform angular velocity error is compared with the first-order differential signal of the platform angular velocity error to obtain a second-order differential signal of the platform angular velocity error; finally, a second-order nonlinear filtering signal of the platform angular velocity error is obtained by nonlinear operation, including:
[0027]
[0028]
[0029] e1=(ee 1a ) / a1;
[0030]
[0031] e2=(e1-e 2a ) / a2;
[0032]
[0033] Where e is the platform angular velocity error signal; e 1a is the hysteresis signal of the platform angular velocity error; e1 is the first-order differential signal of the platform angular velocity error; e 2a is the first-order differential hysteresis signal of the platform angular velocity error; e2 is the second-order differential signal of the platform angular velocity error; e d2 is the second-order nonlinear filtering signal of the platform angular velocity error; e d1 With e d The definition and calculation of is shown in the next step.
[0034] In an exemplary embodiment of the present invention, a nonlinear integral filtering operation is performed on the second-order nonlinear filtering signal of the platform angular velocity error to obtain a first-order nonlinear filtering signal of the platform angular velocity error; a nonlinear integral filtering operation is then performed on the first-order nonlinear filtering signal of the platform angular velocity error to obtain a zero-order filtering signal of the platform angular velocity error; the platform angular velocity error signal is combined with the zero-order filtering signal of the platform angular velocity error, the first-order filtering signal of the platform angular velocity error and the second-order filtering signal of the platform angular velocity error to obtain a combined signal of the platform angular velocity error; a nonlinear integral filtering operation is then performed on the combined signal of the platform angular velocity error to obtain a combined nonlinear integral signal of the platform angular velocity error; and the platform angular velocity error signal, the sight angle signal of the photoelectric guidance platform, and the pitch angular velocity signal of the platform base are superimposed to obtain a final platform stability control total signal, which includes:
[0035]
[0036]
[0037] e dw =c a1 e+c a2 e d +c a3 e d1 +c a4 e d2 ;
[0038]
[0039] u=c a6 e+c a7 q+c a8 s2+c a9 ω b ;
[0040] where e d1 is the first-order nonlinear filtering signal of the platform angular velocity error; ε a1 , ε a2 , εa3 is the constant parameter of nonlinear integral filtering; e d is the zero-order filtered signal of the platform angular velocity error; e dw is the combined signal of platform angular velocity error; c a1 、c a2 、c a3 、c a4 is the constant parameter of the combined signal, s2 is the nonlinear integral signal of the platform angular velocity error combination; c a6 、c a7 、c a8 、c a9 is a constant control parameter, and u is the final total signal of platform stability control.
[0041] Beneficial Effects
[0042] The present invention is a photoelectric guidance platform stabilization method based on nonlinear filtering correction, and its main innovations are as follows: first, a nonlinear filtering corrector is proposed, which can realize three functions of nonlinear filtering, nonlinear integration and nonlinear differentiation through signal combination and integration, thereby improving the damping and integrator for the stability of the platform, so that the entire stable control has high precision and strong stability and anti-interference ability. Second, a unified mode of nonlinear filtering correction is adopted in both angle and angular velocity loops, so that the entire control scheme is relatively simple and easy to implement.
[0043] It is to be understood that the foregoing general description and the following detailed description are exemplary and explanatory only and are not restrictive of the invention. BRIEF DESCRIPTION OF THE DRAWINGS
[0044] The accompanying drawings herein are incorporated into and constitute a part of the specification, illustrate embodiments consistent with the present invention, and together with the specification are used to explain the principles of the present invention. Obviously, the accompanying drawings described below are only some embodiments of the present invention, and for those of ordinary skill in the art, other accompanying drawings can be obtained based on these accompanying drawings without creative work.
[0045] Figure 1 The present invention provides a flow chart of a method for stabilizing a photoelectric guidance platform based on nonlinear filtering correction.
[0046] Figure 2 is a pitch angular velocity signal curve (radians / second) of the photoelectric guidance platform of the method provided in the embodiment of the present invention;
[0047] Figure 3 is a pitch angular velocity signal curve (radians / second) of the platform base of the method provided in the embodiment of the present invention;
[0048] Figure 4is a line of sight angle signal curve (degrees) of the photoelectric guidance platform of the method provided in the embodiment of the present invention;
[0049] Figure 5 is a line of sight angle second-order nonlinear filtering signal curve (unitless) of the method provided in the embodiment of the present invention;
[0050] Figure 6 is the expected signal curve of the angular velocity of the photoelectric guidance platform of the method provided in the embodiment of the present invention (without unit);
[0051] Figure 7 is a second-order nonlinear filtering signal curve of the platform angular velocity error of the method provided in the embodiment of the present invention (without unit);
[0052] Figure 8 is the platform angular velocity error combined nonlinear integral signal (unitless) of the method provided in the embodiment of the present invention;
[0053] Fig. 9 is the total signal curve of platform stability control of the method provided in the embodiment of the present invention (without unit);
[0054] Fig.10 It is a pitch angle signal curve (radian) of the platform base of the method provided in the embodiment of the present invention. DETAILED DESCRIPTION
[0055] Example embodiments will now be described more fully with reference to the accompanying drawings. However, example embodiments can be implemented in a variety of forms and should not be construed as being limited to the examples set forth herein; on the contrary, these embodiments are provided so that the present invention will be more comprehensive and complete, and the concept of the example embodiments will be fully conveyed to those skilled in the art. The described features, structures, or characteristics may be combined in one or more embodiments in any suitable manner. In the following description, many specific details are provided to provide a full understanding of the embodiments of the present invention. However, those skilled in the art will appreciate that the technical solutions of the present invention may be practiced while omitting one or more of the specific details, or other methods, components, devices, steps, etc. may be adopted. In other cases, known technical solutions are not shown or described in detail to avoid blurring out various aspects of the present invention.
[0056] The invention provides a photoelectric guidance platform stabilization method based on nonlinear filtering correction, which performs inertial lag filtering processing on a sight angle signal to obtain a first-order difference signal and a second-order difference signal of the sight angle; then obtains a second-order nonlinear filtering signal of the sight angle through nonlinear operation, obtains a sight angle combined nonlinear integral signal through two nonlinear filtering integrals and a nonlinear combined integral, then superimposes the sight angle signal to form a sliding mode signal, obtains a platform angular velocity expected signal after softening transformation; then obtains an angular velocity error signal by comparing with the platform angular velocity; then obtains a platform angular velocity error combined nonlinear integral signal after the angular velocity error signal is subjected to two inertial lags, second-order nonlinear filtering differentials and three nonlinear filtering integral operations, and superimposes the angular velocity error signal to form a final platform stabilization control signal, thereby realizing attitude stabilization control of the photoelectric guidance platform.
[0057] Next, a method for stabilizing an optoelectronic guidance platform based on nonlinear filtering correction according to the present invention will be further explained and illustrated in conjunction with the accompanying drawings. Figure 1 As shown, the photoelectric guidance platform stabilization method based on nonlinear filtering correction may include the following steps:
[0058] Step S10, install a rate gyro on the precision-guided photoelectric guidance platform to measure the pitch angular velocity signal of the photoelectric guidance platform, denoted as ω1; at the same time, install a rate gyro on the base of the photoelectric guidance platform to measure the pitch angular velocity signal of the platform base, denoted as ω b ; Use IRFPA infrared camera to take pictures and measure, and then process the data to get the sight angle signal of the optoelectronic guidance platform, denoted as q.
[0059] Step S20, according to the sight angle signal, first perform inertial lag filtering processing to obtain a sight angle lag signal; then use the sight angle lag signal to compare with the sight angle signal to solve the sight angle first-order difference signal; then perform inertial lag filtering processing to obtain the sight angle first-order difference lag signal; then compare with the sight angle first-order difference signal to obtain the sight angle second-order difference signal; finally, obtain the sight angle second-order nonlinear filtering signal through nonlinear operation.
[0060] Specifically, it can be decomposed into the following five steps. The first step is to perform inertial lag filtering processing on the sight angle signal to obtain the sight angle lag signal as follows:
[0061]
[0062] Where a1 is the constant time parameter of the inertial lag filter, s is the transfer function of the inertial lag filter, q 1a It is the sight angle lag signal.
[0063] In the second step, the sight angle lag signal is compared with the sight angle signal to solve the first-order difference signal of the sight angle as follows:
[0064] q1=(qq 1a ) / a1;
[0065] Where q1 is the first-order difference signal of the sight angle.
[0066] The third step is to process the first-order difference signal of the sight angle through inertial lag filtering to obtain the first-order difference lag signal of the sight angle as follows:
[0067]
[0068] Where a2 is the constant time parameter of the inertial lag filter, q 2a is the first-order difference lag signal of the sight angle.
[0069] The fourth step is to compare the first-order differential lag signal of the sight angle with the first-order differential signal of the sight angle to obtain the second-order differential signal of the sight angle as follows:
[0070] q2=(q1-q 2a ) / a2;
[0071] Where q2 is the second-order difference signal of the sight angle.
[0072] Step 5: Based on the above data, the second-order nonlinear filtering signal of the sight angle is obtained through nonlinear operation as follows:
[0073]
[0074] where q d2 is the second-order nonlinear filtering signal of the sight angle; T1, T2, T3, T4 are the constant time parameters of the second-order nonlinear filter; q d1 With q d The definition and calculation of is shown in the next step.
[0075] Step S30, performing a nonlinear integral filtering operation on the sight angle second-order nonlinear filtering signal to obtain a sight angle first-order nonlinear filtering signal; then performing a nonlinear integral filtering operation on the sight angle first-order nonlinear filtering signal to obtain a sight angle zero-order filtering signal; then combining the sight angle zero-order filtering signal, the sight angle first-order filtering signal and the sight angle second-order filtering signal to obtain a sight angle combination signal; then performing a nonlinear integral filtering operation on the sight angle combination signal to obtain a sight angle combination nonlinear integral signal; then superimposing the sight angle signal, the photoelectric guidance platform pitch angular velocity signal and the platform base pitch angular velocity signal to obtain a sight angle sliding mode signal, and performing a softening transformation to obtain an expected photoelectric guidance platform angular velocity signal.
[0076] Specifically, it can be divided into the following six steps. The first step is to perform nonlinear integral filtering operation according to the second-order nonlinear filtering signal of the sight angle to obtain the first-order nonlinear filtering signal of the sight angle as follows:
[0077]
[0078] Where T is the constant time parameter of the nonlinear filter integral, ε0 and ε2 are the constant parameters of the nonlinear filter integral; q d1 is the first-order nonlinear filtering signal of the sight angle.
[0079] In the second step, a nonlinear integral filtering operation is performed on the first-order nonlinear filtering signal of the sight angle to obtain the zero-order filtering signal of the sight angle as follows:
[0080]
[0081] Where ε3 is a constant parameter of the nonlinear filter integral; q d is the zero-order filtered signal of the line of sight angle.
[0082] In the third step, the sight angle zero-order filter signal, the sight angle first-order filter signal and the sight angle second-order filter signal are combined through the sight angle signal to obtain the sight angle combination signal as follows:
[0083] q dw =c1q+c2q d +c3q d1 +c4q d2 ;
[0084] Among them, c1, c2, c3, c4 are constant parameters of the combined signal, q dw It is the sight angle combined signal.
[0085] The fourth step is to perform nonlinear integral filtering on the sight angle combination signal to obtain the sight angle combination nonlinear integral signal as follows:
[0086]
[0087] Where s1 is the sight angle combined nonlinear integral signal; ε1 is the constant parameter of the nonlinear filter integral.
[0088] The fifth step is to use the sight angle combined nonlinear integral signal to superimpose the sight angle signal, the photoelectric guidance platform pitch angular velocity signal, and the platform base pitch angular velocity signal to obtain the sight angle sliding mode signal as follows:
[0089] s a =k1q+k2ω1+k3s1+k4ω b ;
[0090] Among them, k1, k2, k3, k4 are constant parameters of the sliding surface, sa is the line of sight angle sliding mode signal.
[0091] In the sixth step, the line of sight angle sliding mode signal is used for softening transformation and superimposed on the line of sight angle sliding mode signal to obtain the expected angular velocity signal of the photoelectric guidance platform as follows:
[0092]
[0093] where ω d is the expected signal of angular velocity of the photoelectric guidance platform, and c5 is a constant control parameter.
[0094] Step S40, according to the expected angular velocity signal of the photoelectric guidance platform, the angular velocity signal of the photoelectric guidance platform is compared to obtain a platform angular velocity error signal; then an inertial lag filtering process is performed to obtain a platform angular velocity error lag signal; then the platform angular velocity error lag signal is compared with the platform angular velocity error signal to obtain a first-order differential signal of the platform angular velocity error; then an inertial lag filtering process is performed to obtain a first-order differential lag signal of the platform angular velocity error; then the signal is compared with the first-order differential signal of the platform angular velocity error to obtain a second-order differential signal of the platform angular velocity error; finally, a second-order nonlinear filtering signal of the platform angular velocity error is obtained through nonlinear operation.
[0095] Specifically, it can be decomposed into the following six steps. The first step is to compare the expected angular velocity signal of the photoelectric guidance platform with the angular velocity signal of the photoelectric guidance platform to obtain the platform angular velocity error signal as follows:
[0096]
[0097] Where e is the platform angular velocity error signal.
[0098] In the second step, the inertial hysteresis filtering is performed on the platform angular velocity error signal to obtain the platform angular velocity error hysteresis signal as follows:
[0099]
[0100] where e 1a is the platform angular velocity error hysteresis signal.
[0101] The third step is to compare the platform angular velocity error hysteresis signal with the platform angular velocity error signal to obtain the first-order differential signal of the platform angular velocity error as follows:
[0102] e1=(ee 1a ) / a1;
[0103] Where e1 is the first-order differential signal of the platform angular velocity error.
[0104] The fourth step is to process the first-order differential signal of the platform angular velocity error through inertial lag filtering to obtain the first-order differential lag signal of the platform angular velocity error as follows:
[0105]
[0106] where e 2a It is the first-order differential lag signal of the platform angular velocity error.
[0107] The fifth step is to compare the first-order differential hysteresis signal of the platform angular velocity error with the first-order differential signal of the platform angular velocity error to obtain the second-order differential signal of the platform angular velocity error as follows:
[0108] e2=(e1-e 2a ) / a2;
[0109] Where e2 is the second-order differential signal of the platform angular velocity error.
[0110] Step 6: The above signal is subjected to nonlinear operation to obtain the second-order nonlinear filtering signal of the platform angular velocity error as follows:
[0111]
[0112] where e d2 is the second-order nonlinear filtering signal of the platform angular velocity error; e d1 With e d The definition and calculation of is shown in the next step.
[0113] Step S50, performing a nonlinear integral filtering operation on the second-order nonlinear filtering signal of the platform angular velocity error to obtain a first-order nonlinear filtering signal of the platform angular velocity error; then performing a nonlinear integral filtering operation on the first-order nonlinear filtering signal of the platform angular velocity error to obtain a zero-order filtering signal of the platform angular velocity error; then combining the zero-order filtering signal of the platform angular velocity error, the first-order filtering signal of the platform angular velocity error and the second-order filtering signal of the platform angular velocity error by the platform angular velocity error signal to obtain a combined signal of the platform angular velocity error; then performing a nonlinear integral filtering operation on the combined signal of the platform angular velocity error to obtain a combined nonlinear integral signal of the platform angular velocity error; then superimposing the platform angular velocity error signal, the sight angle signal of the photoelectric guidance platform and the pitch angular velocity signal of the platform base to obtain a final total signal of platform stability control, which is transmitted to the torque motor to drive the photoelectric guidance platform and its load to achieve attitude stability control of the photoelectric guidance platform.
[0114] Specifically, it can be decomposed into the following five steps. The first step is to perform nonlinear integral filtering operation on the second-order nonlinear filtering signal of the platform angular velocity error to obtain the first-order nonlinear filtering signal of the platform angular velocity error as follows:
[0115]
[0116] where e d1 is the first-order nonlinear filtering signal of the platform angular velocity error; ε a2 is a constant parameter of the nonlinear integral filter.
[0117] In the second step, a nonlinear integral filtering operation is performed on the first-order nonlinear filtering signal of the platform angular velocity error to obtain the zero-order filtering signal of the platform angular velocity error as follows:
[0118]
[0119] where e d is the zero-order filtered signal of the platform angular velocity error, ε a3 is a constant parameter of the nonlinear integral filter.
[0120] In the third step, the platform angular velocity error signal is combined with the platform angular velocity error zero-order filter signal, the platform angular velocity error first-order filter signal and the platform angular velocity error second-order filter signal to obtain the platform angular velocity error combined signal as follows:
[0121] e 知 =c a1 e+c a2 e d +c a3 e d1 +c a4 e d2 ;
[0122] where e dw is the combined signal of platform angular velocity error; c a1 、c a2 、c a3 、c a4 is a constant parameter of the combined signal.
[0123] The fourth step is to perform nonlinear integral filtering on the platform angular velocity error combination signal to obtain the platform angular velocity error combination nonlinear integral signal as follows:
[0124]
[0125] Where s2 is the nonlinear integral signal of the platform angular velocity error combination; ε a1 is a constant parameter of the nonlinear integral filter.
[0126] In the fifth step, the platform angular velocity error combination nonlinear integral signal is used to superimpose the platform angular velocity error signal, the line of sight angle signal of the photoelectric guidance platform, and the platform base pitch angular velocity signal to obtain the final platform stability control total signal as follows:
[0127] u=ca6 e+c a7 q+c a8 s2+c a9 ω b ;
[0128] where c a6 、c a7 、c a8 、c a9 is a constant control parameter, and u is the final total signal of platform stability control.
[0129] Case implementation and computer simulation results analysis
[0130] In step S10, a rate gyro is installed on the precision-guided photoelectric guidance platform to measure the pitch angular velocity signal of the photoelectric guidance platform. Figure 2 As shown, the amplitude is sinusoidal swing at about 0.18; at the same time, a rate gyro is installed on the base of the photoelectric guidance platform to measure the pitch angular velocity signal of the platform base as shown in Figure 3 As shown, the amplitude swings around 8; the IRFPA infrared camera is used to take pictures and measure, and the data is processed to obtain the sight angle signal of the photoelectric guidance platform as shown in Figure 4 As shown, the amplitude swings around 0.005.
[0131] In step S20, a1=0.9, a2=0.75, T1=0.15, T2=0.05, T3=0.004, T4=0.05 are selected to obtain the sight angle second-order nonlinear filtering signal as follows: Figure 5 shown.
[0132] In step S30, ε0=1.2, ε1=1.6, ε2=1.3, ε3=1.5 are selected to obtain the expected angular velocity signal of the photoelectric guidance platform as follows: Figure 6 shown.
[0133] In step S40, the second-order nonlinear filtering signal of the platform angular velocity error is obtained as follows: Figure 7 shown.
[0134] In step S50, select ε a1 =0.4,ε a2 =0.6,ε a3 = 0.8, and the platform angular velocity error combined nonlinear integral signal is obtained as Figure 8 As shown, the final platform stability control total signal is as follows Fig. 9 As shown, the platform base pitch angle signal is as follows Fig.10 As shown, the amplitude fluctuates around 0.52. Fig.10 and Figure 4 By comparison, we can see that despite the shaking of the platform base, Figure 4It can be seen that the shaking amplitude of the sight angle is only about 1% of the platform base. Figure 3 and Figure 2 It can be seen from the comparison that the shaking amplitude of the platform base angular velocity is about 44.5 times that of the line of sight angular velocity. The final experimental results show that although the platform base shakes violently at high frequency, the shaking amplitude of the line of sight angle and the shaking of the line of sight angular velocity are very small, so that the entire photoelectric guidance platform effectively isolates the shaking of the platform base, which also shows that the present invention has a high engineering application value.
Claims
1. A method for stabilizing an optoelectronic guidance platform based on nonlinear filtering correction. Features Follow these steps: Step S10, installing a rate gyro on the precision-guided photoelectric guidance platform to measure the pitch angular velocity signal of the photoelectric guidance platform, denoted as ω 1 ; At the same time, a rate gyro is installed on the base of the photoelectric guidance platform to measure the pitch angular velocity signal of the platform base, recorded as ω b ; Use IRFPA infrared camera to take pictures and measure, and process the data to get the sight angle signal of the photoelectric guidance platform, recorded as q; Step S20, according to the sight angle signal, firstly perform inertial hysteresis filtering processing to obtain a sight angle hysteresis signal; then use the sight angle hysteresis signal to compare with the sight angle signal to solve the sight angle first-order difference signal; then perform inertial hysteresis filtering processing to obtain the sight angle first-order difference hysteresis signal; then compare it with the sight angle first-order difference signal to obtain the sight angle second-order difference signal; finally, obtain the sight angle second-order nonlinear filtering signal through nonlinear operation as follows: q 1 =(q-q 1a ) / a 1 ; q 2 =(q 1 -q 2a ) / a 2 ; where a 1 、a 2 is the constant time parameter of the inertia lag filter, s is the transfer function of the inertia lag filter, q 1a is the sight angle lag signal; q 1 is the first-order difference signal of the sight angle; q 2a is the first-order differential lag signal of the sight angle; q 2 is the second-order difference signal of the sight angle; q d2 is the second-order nonlinear filtering signal of the sight angle; T 1 、T 2 、T 3 、T 4 is the constant time parameter of the second-order nonlinear filter; q d1 With q d The definition and calculation of is shown in the next step; Step S30, performing a nonlinear integral filtering operation on the sight angle second-order nonlinear filtering signal to obtain a sight angle first-order nonlinear filtering signal; then performing a nonlinear integral filtering operation on the sight angle first-order nonlinear filtering signal to obtain a sight angle zero-order filtering signal; then combining the sight angle zero-order filtering signal, the sight angle first-order filtering signal and the sight angle second-order filtering signal through the sight angle signal to obtain a sight angle combination signal; then performing a nonlinear integral filtering operation on the sight angle combination signal to obtain a sight angle combination nonlinear integral signal; then superimposing the sight angle signal, the photoelectric guidance platform pitch angular velocity signal, and the platform base pitch angular velocity signal to obtain a sight angle sliding mode signal, and performing a softening transformation to obtain an expected signal of the photoelectric guidance platform angular velocity as follows: q dw =c 1 q+c 2 q d +c 3 q d1 +c 4 q d2 ; s a =k 1 q+k 2 oh 1 +k 3 s 1 +k 4 oh b ; Where T is the constant time parameter of the nonlinear filter integral, ε 0 , ε 1 , ε 2 , ε 3 is a constant parameter of the nonlinear filter integral; q d1 is the first-order nonlinear filtering signal of the sight angle; q d is the zero-order filtered signal of the sight angle; c 1 、c 2 、c 3 、c 4 is the constant parameter of the combined signal, q dw is the sight angle combined signal; s 1 k is the combined nonlinear integral signal of the sight angle; 1 , k 2 , k 3 , k 4 is the constant parameter of the sliding surface, s a is the line of sight angle sliding mode signal, ω d is the expected angular velocity signal of the photoelectric guidance platform, c 5 is a constant control parameter; Step S40, according to the photoelectric guidance platform angular velocity expected signal and the photoelectric guidance platform angular velocity signal, a platform angular velocity error signal is obtained; then an inertial hysteresis filtering process is performed to obtain a platform angular velocity error hysteresis signal; then the platform angular velocity error hysteresis signal is compared with the platform angular velocity error signal to obtain a first-order differential signal of the platform angular velocity error; then an inertial hysteresis filtering process is performed to obtain a first-order differential hysteresis signal of the platform angular velocity error; then the first-order differential hysteresis signal of the platform angular velocity error is compared with the first-order differential signal of the platform angular velocity error to obtain a second-order differential signal of the platform angular velocity error; finally, a second-order nonlinear filtering signal of the platform angular velocity error is obtained by nonlinear operation as follows: And 1 =(and 1a ) / to 1 ; And 2 =(and 1 -And 2a ) / to 2 ; Where e is the platform angular velocity error signal; e 1a is the platform angular velocity error hysteresis signal; e 1 is the first-order differential signal of the platform angular velocity error; e 2a is the first-order differential lag signal of the platform angular velocity error; e 2 is the second-order differential signal of the platform angular velocity error; e d2 is the second-order nonlinear filtering signal of the platform angular velocity error; e d1 With e d The definition and calculation of is shown in the next step; Step S50, performing a nonlinear integral filtering operation on the second-order nonlinear filtering signal of the platform angular velocity error to obtain a first-order nonlinear filtering signal of the platform angular velocity error; and then performing a nonlinear integral filtering operation on the first-order nonlinear filtering signal of the platform angular velocity error to obtain a zero-order filtering signal of the platform angular velocity error; Then, the platform angular velocity error signal is combined with the platform angular velocity error zero-order filter signal, the platform angular velocity error first-order filter signal and the platform angular velocity error second-order filter signal to obtain the platform angular velocity error combination signal; the platform angular velocity error combination signal is subjected to nonlinear integral filtering operation to obtain the platform angular velocity error combination nonlinear integral signal; the platform angular velocity error signal, the line of sight angle signal of the photoelectric guidance platform and the platform base pitch angular velocity signal are superimposed to obtain the final platform stability control total signal, which is transmitted to the torque motor to drive the photoelectric guidance platform and its load to realize the attitude stability control of the photoelectric guidance platform as follows: And dw =c a1 e+c a2 And d +c a3 And d1 +c a4 And d2 ; u=c a6 e+c a7 q+c a8 s 2 +c a9 ω b ; where e d1 is the first-order nonlinear filtering signal of the platform angular velocity error; ε a1 , ε a2 , ε a3 is the constant parameter of nonlinear integral filtering; e d is the zero-order filtered signal of the platform angular velocity error; e dw is the combined signal of platform angular velocity error; c a1 、c a2 、c a3 、c a4 is the constant parameter of the combined signal, s 2 c is the combined nonlinear integral signal of the platform angular velocity error; a6 、c a7 、c a8 、c a9 is a constant control parameter, and u is the final total signal of platform stability control.
