Abstract
To enhance the optimization performance of matched filter and further improve line of sight (LOS) stability of platform in inertial space, the proposed matched filter algorithm is conducted by adjusting matched filter coefficients of first-order low pass filter utilizing the regional search method based on invariance principle. The coefficients of the fraction molecule and denominator of proposed regional search algorithm are altered instead of denominator coefficients only being modified. Simulations are performed to verify the validity of inside factors performed with stabilization control model and quartz rate sensor (QRS) mathematical model. The stable angular error is sharply alleviated, so the decoupling accuracy of airborne semistrapdown inertially stabilized platform is largely promoted. The optimization matched filter can effectively increase stability of LOS in inertial space.
1. Introduction
Photoelectric sensor is a device of great importance for detecting and tracking targets in semistrapdown stabilized platform [1]. LOS of the photoelectric sensor is affected when flying body attitude changes because the photoelectric sensor is directly connected with flying body in [2], which leads to unstable optical axis and nonideal tracking effect. The noise of sensor is attenuated using matched filter in general. The rate gyro sensor can measure azimuth and pitch angular velocity. While the angular velocity is directly fed back to actuator and makes LOS reversely deflect so as to achieve stabilization, the attitude information is fed back to the closed loop according to space coordinate transformation when the information is measured by inertia devices of flying bodies, which make frames reduce vibration by flying bodies disturbance.
Scholars put forward some opinions on increasing stability. In 1993, strapdown platform model was investigated and decoupling results of QRS and FOG sensor were obtained in [3]. In recent years, a controller was established based on offline initialization to get the optimal controller and modeling errors were solved by optimization filters in [4]. The stability of parasitic loop induced by disturbance rejection effect (DRE) of a semistrapdown homing seeker (SSHS) was employed in [5]. The sensors’ dynamic errors of strapdown detector and rate gyro based on guidance system were addressed in [6]. The matching of rate gyro and dynamics were researched utilizing constraining nonlinear minimization optimization method in [7]. A newly continuously differentiable friction model and filtered regression estimation parameter were introduced; the stability of the proposed methods was proved in [8]. The matched filter was expressed in order to suppress and compensate the imperfect influence of nonlinear friction force factors in [9–11], for instance, the static friction force of the frame and motor dead zone phenomenon.
Previous matched filter researches are just mostly focused on the change of the denominator coefficient, while the molecular coefficient of the first-order low-pass filter is a fixed parameter. However, to further improve the optimization performance, the proposed regional search algorithm dynamically limits the search area and reduces the search complexity of the algorithm in time and space, so the operation efficiency of the algorithm is greatly improved.
The overall paper is organized as follows: Section 1 addresses the research purpose; Section 2 presents the control model of semistrapdown stabilization; Section 3 develops matched filter optimization algorithms; Section 4 proves the efficiency of the proposed matched filter optimization algorithm; and Section 5 summarizes theoretical and practical engineering significance of the study.
2. Semistrapdown Stabilization Control Model
2.1. Stabilization Principle
The two-axis and two-frame miniature semistrapdown stabilization platform has its advantages, which makes it become a great tool for the integration of investigation and combat. In [12], the mathematical model of semistrapdown stabilization control is shown in Figure 1.
In this system, is angular velocity instruction, is angular velocity of stabilized platform under inertial axis, flying bodies attitude disturbance angular velocity is , denotes measurement noise, is disturbance torque, is control object transfer function, is transfer function of speed loop controller in [13], represents transfer function of measurement rate link, and represents gyro transfer function. The control model of semistrapdown platform is shown in Figure 1. The angular velocity of semistrapdown stabilized platform control model under inertial axis is extracted aswhere , is body disturbance frequency, and denotes the maximum amplitude of the angular velocity of the flying bodies.
When , , and are ignored, we have
The disturbance of body to the LOS is eliminated when from (2), which is ideally equivalent to the complete decoupling of semistrapdown stabilization.
2.2. Simplified Control Model
The closed-loop structure of stable rate is simplified as shown in Figure 2.
3. The Optimization of Matched Filter Algorithm
In order to make , matched filter algorithm is proposed in engineering, as shown in (2), where is conducted under the matched filter according to invariance principle. The transfer function of matched filter is assumed to be
The related data of the QRS model of matched filter algorithm is based on [3], as reflected in Table 1.
3.1. Algorithm 1
represents the transfer function before matched filter (matched filter is not used), which can be expressed as
The transfer function after matched filter is
The objective function can be established by the nonlinear constrained optimization algorithm of mechanical optimization design scheme [14]: where the constraint condition is . At last, is obtained by simulation.
3.2. Algorithm 2
The flowchart of Algorithm 2 is indicated in Figure 3.
(i) The First Step. In order to compare with Algorithm 1, the interval is regarded as research subject. The interval is divided into 10 equal parts; there are eleven numbers from 0, 0.001 to 0.01. Let ; 10 kinds of situations are displayed in line two of Figure 4 when is greater than . The optimal matching of every situation is acquired by simulation. Then, the best decoupling characteristics are regarded as a new group; then, 10 groups are reflected in line 3 of Figure 4. Followed by analogy, the better of two groups is shown in Figure 4.
The better simulation effect of and is obtained from Figure 4; then, the better result is searched from and .
(ii) The Second Step. The interval is divided into 10 equal parts; there are eleven numbers from 0, 0.0001 to 0.001. Let . Similarly, the interval is divided into 10 equal parts, where there are eleven numbers from 0.003, 0.0031 to 0.004. Let ; thus, eleven kinds of situations are illustrated in line two of Figure 5 when . The optimal matching of every situation is gained by simulation. Then, the best decoupling characteristics are regarded as a new group, and 11 groups are reflected in line 3 of Figure 5. Followed by analogy, the best group is shown in Figure 5.
The last result of Figure 5 is completely consistent with the result of Algorithm 1 by simulink. However, we hope to find a better result by search method.
(iii) The Third Step. Let and . Ten kinds of situations are shown in line 2 of Figure 6. Then, four groups of the better decoupling characteristics are selected; they are reflected in line 3 of Figure 6. Followed by analogy, the best group is shown in Figure 6. The last result of Figure 6 is a perfect result by simulink.
4. Validation Test and Simulation Analysis
In order to better explain the validity of the algorithm, taking the closed-loop stability control system into consideration, the simulation model in [15] is shown in Figure 7.
4.1. Simulation Experiment Validations
4.1.1. The Step Simulation Experiments
Considering the speed of reaching the steady state of the system, the step response is presented in Figure 8.
(a)
(b)
(c)
The time of reaching the steady state is very principal for engineering application. It is clear that the and are excellent among ten group coefficients of the first step in Figure 8(a); the result of simulation experiments is consistent with the result of Algorithm 1, and the time of and when arriving at the steady state is shorter than others. The step response is indicated in Figure 8(b); the reaching speed of the steady state about the coefficient is faster than others. The coefficient of is the best among ten coefficients, and it can be confirmed based on Figure 8(c).
4.1.2. Bode Diagram Simulation Experiments
The matching effect of the matched filter plays an indispensable role in engineering. It is helpful even if there is a little improvement, as is shown in Figure 9.
(a)
(b)
(c)
The coefficients and of Figure 8(a) are very prominent. The coefficient of the second step is indicated in Figure 8(b), where it is shown that the optimization result is in accordance with the result of Algorithm 1. The coefficients , , , and are better from Bode diagram of the closed-loop control simulation. But the coefficient is the best. Figure 8(c) can be illustrated by this truth. Meanwhile, the coefficient has a relatively higher decoupling accuracy, and the noise also can be decreased, so is the best matched filter.
4.2. Stable Error before Matched Filter and after Matched Filter
4.2.1. The Rate Comparison of Platform before and after Matched Filter
The related data of flying bodies angular velocity motion is given based on [3], which is used as the verification test when the input signal is the unit step signal, as shown in Table 2.
As shown in Figure 10, the rate of stable platform before matched filter and after matched filter is as follows.
Simulation results from Figure 10 show that the angular rate of the platform is declined by , so the optimization results are very good.
4.2.2. The Comparison of Stable Angle Error under Different Matched Filter
The stable angle errors of the four groups’ matched filter of Figure 8 are compared utilizing search method, and their differences are revealed in Figure 11.
Stable angle error is obviously distinct using dissimilar matched filter from Figure 11; the solid line stands for the best matched filter; its error of the stable angle is smaller.
4.3. Effect on the Stable Error of Sensor Measurement Noise
The angular velocity of the semistrapdown stabilized platform is obtained by rate gyroscope and related calculation from Figure 1 and (1). The measurement noise of the sensor has influence on stabilization of semistrapdown stabilized platform. The amplification factor of the measurement rate can be enlarged, but not without limitation. The matched filter algorithm is proposed in order to reduce the noise in engineering.
In Figure 12, the measurement noise of the sensor has a great effect on the stability of the angle error, and the stability of the angle error is diminished by nearly after matched filter.
5. Conclusions
(1)Measurement rate is matched by first-order low pass filter based on invariance principle. Simulations show that the angular rate of the platform is lessened by after matched filter. Not only can we get the result of Algorithm 1, but also we can obtain the optimal matching, which can promote decoupling accuracy as far as possible.(2)The measurement noise of sensor has huge influence on the stable error. The stability of the angle error is decreased by nearly after matched filter.(3)The stability of LOS can be strengthened based on the above simulation results. So it provides theoretical foundations for designing and optimization of the microstable platform, which has a strong guiding significance in engineering.
Competing Interests
The authors declare that there is no conflict of interests regarding the publication of this paper.