Tingting Sun 1, 2 and Hairong Chu 1 and Baiqiang Zhang 1, 2 and Hongguang Jia 1 and Lihong Guo 1 and Yue Zhang 1 and Mingyue Zhang 1
Academic Editor:Oscar Reinoso
1, Changchun Institute of Optics, Fine Mechanics and Physics, Chinese Academy of Sciences, Changchun, Jilin 130033, China
2, University of Chinese Academy of Sciences, Beijing 100039, China
Received 10 March 2015; Revised 18 June 2015; Accepted 18 June 2015; 5 August 2015
This is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.
1. Introduction
Optical imaging seekers have been widely used in military fields due to the high precision, such as the three-mode cooled imaging seekers of JAVELIN missile and the uncooled infrared strapdown seeker Direct Attack Munition Affordable Seeker (DAMASK) of JDAM missile. With the rapid development of large area-array complementary metal oxide semiconductor (CMOS) image sensors, automatic target recognition, and high-performance image trackers, the application of strapdown imaging seeker to guidance system has become an important research topic, such as the excellent application of the SPIKE missile in the United States. Strapdown imaging seeker which mounted to missile body rigidly has some advantages [1], such as compact structure, high reliability, unlimited LOS rate tracking capability, and instant field of view (FOV) equal to total FOV. However, only BLOS angle information can be measured directly; thus the LOS angles will couple with body attitude motion which finally leads to strong nonlinearity. The strong nonlinearity makes it very difficult to distill the LOS rate which is essential to the proportional guidance law. Therefore, how to estimate the LOS rate in real time to meet the accuracy requirement of guidance system is a key issue for strapdown guidance technology and application.
Researchers have studied LOS rate estimation of strapdown seeker in recent years. An "additional rate compensation + differential network" method was adopted to reconstruct the single-channel LOS rate in [2] and then offered the signal to guidance system after it passed through a low-pass filter. LOS rate generated by a self-adaptive jitter filter and differential network method [3] was only applicable for low maneuvering guided weapons. Disturbance observer was used to estimate the LOS rate in single channel [4]. The relative relationship and frame transformation between missile and target were employed to derive the relationship among the LOS rate, BLOS rate, and attitude angles, where the BLOS rate can be obtained by a differential network [5]. Extended Kalman filter (EKF) was utilized to estimate the inertial LOS rate [6]. The target motion was negligible with respect to the missile in [7, 8], the relative distance, velocity, and acceleration were assumed to be zero, and then LOS rate was estimated using UKF and Particle Filter (PF), separately. α -β filter [9] was employed to estimate BLOS rate, and then the LOS rate was reconstructed. Further, the filtering bandwidth can also be adjusted. The linear and nonlinear mixed differentiator based on the sliding mode [10] were adopted to estimate the LOS rate.
All mentioned algorithms above are either mainly based on differential network and the reconstruction method or ignoring too much relative motion information between missile and target; then nonlinear Kalman filtering algorithms are employed to estimate LOS rate, which failed to get high accuracy and cannot meet the real-time requirement. This paper proposes an effective nonlinear algorithm to estimate the LOS rate, we take the relative motion between the missile and target and the missile attitude into account to derive the estimation model, and then LOS rate is estimated using UKF. The correctness and accuracy of the algorithm are verified through the semiphysical simulation experiment.
The remainder of this paper is organized as follows. Section 2 defines the reference frames and angles. The LOS rate model including standard LOS rate and kinematic model of LOS rate estimation were introduced in Section 3. Section 4 proposes the LOS rate estimation algorithm based on UKF. Different performance seekers and gyros impacts on the LOS rate accuracy are simulated in Section 5. The semiphysical simulation experiment is designed; result and discussion are also shown in Section 6. Section 7 illustrates the conclusion of this paper.
2. Reference Frames and Angles
In order to study the LOS rate estimation algorithm for strapdown imaging seeker, the definitions of earth frame [figure omitted; refer to PDF] , body frame [figure omitted; refer to PDF] , LOS frame [figure omitted; refer to PDF] , and BLOS frame [figure omitted; refer to PDF] are shown in Figure 1, where the subscripts [figure omitted; refer to PDF] , [figure omitted; refer to PDF] , [figure omitted; refer to PDF] , and [figure omitted; refer to PDF] represent earth, body, LOS, and BLOS. For the convenience, the influence of earth spin is neglected so that earth frame is coincident with inertial frame. Earth frame [figure omitted; refer to PDF] is defined as follows: the origin [figure omitted; refer to PDF] is selected as launching point, [figure omitted; refer to PDF] orients upwards and directs the plumb, axis [figure omitted; refer to PDF] directs the takeoff direction in the horizon plane, and axis [figure omitted; refer to PDF] forms right-handed system with [figure omitted; refer to PDF] and [figure omitted; refer to PDF] . Body frame [figure omitted; refer to PDF] is defined as follows: the origin [figure omitted; refer to PDF] is selected as rotating center of missile, axis [figure omitted; refer to PDF] directs the direct axis, [figure omitted; refer to PDF] is upward and perpendicular to [figure omitted; refer to PDF] in the longitudinal plane, and axis [figure omitted; refer to PDF] forms right-handed system with [figure omitted; refer to PDF] and [figure omitted; refer to PDF] . LOS frame [figure omitted; refer to PDF] is defined as follows: the origin [figure omitted; refer to PDF] is selected as optical center of optical system, axis [figure omitted; refer to PDF] points to the target along the LOS, [figure omitted; refer to PDF] is upward and perpendicular to [figure omitted; refer to PDF] in the plumb plane which contained [figure omitted; refer to PDF] , and axis [figure omitted; refer to PDF] forms right-handed system with [figure omitted; refer to PDF] and [figure omitted; refer to PDF] . BLOS frame [figure omitted; refer to PDF] is defined as follows: the origin [figure omitted; refer to PDF] is selected as optical center of optical system, axis [figure omitted; refer to PDF] points to the target along the LOS, [figure omitted; refer to PDF] is upward and perpendicular to [figure omitted; refer to PDF] in the longitudinal plane which contained [figure omitted; refer to PDF] , and axis [figure omitted; refer to PDF] forms right-handed system with [figure omitted; refer to PDF] and [figure omitted; refer to PDF] . [figure omitted; refer to PDF] and [figure omitted; refer to PDF] are LOS vertical angle and azimuth angle; [figure omitted; refer to PDF] and [figure omitted; refer to PDF] are BLOS vertical angle and azimuth angle.
Figure 1: Angle definitions of frames.
(a) Angle definitions between LOS frame and earth frame
[figure omitted; refer to PDF]
(b) Angle definitions between BLOS frame and body frame
[figure omitted; refer to PDF]
The rotation relationship among frames is shown in Figure 2, where [figure omitted; refer to PDF] is LOS transform angle. [figure omitted; refer to PDF] , [figure omitted; refer to PDF] , and [figure omitted; refer to PDF] are pitch, yaw, and roll, respectively. [figure omitted; refer to PDF] is the direction cosine matrix between frames.
Figure 2: Rotation relationships among coordinate frames.
[figure omitted; refer to PDF]
In the strapdown guidance system, the seeker is fixed on the missile body rigidly, so the seeker optical axis is in accordance with body axis [figure omitted; refer to PDF] and the coordinate of target on the focal plane can be calculated through the image processing algorithm. Combined with focal length [figure omitted; refer to PDF] , BLOS vertical angle [figure omitted; refer to PDF] and azimuth angle [figure omitted; refer to PDF] can be calculated. The measurement schematic is depicted as in Figure 3, where [figure omitted; refer to PDF] expresses the image coordinate of the target.
Figure 3: Schematic of BLOS angle measurement.
[figure omitted; refer to PDF]
3. LOS Rate Model
3.1. The Standard LOS Rate Information
The standard information of LOS rate can be derived from the relative motion between missile and target. As shown in Figure 2, earth frame could transform to LOS frame by two different paths.
The first path is from earth frame to body frame, then from body frame to BLOS frame, and in the end from BLOS frame to LOS frame. The rotary rate from earth frame to LOS frame can be expressed as [figure omitted; refer to PDF] in earth frame: [figure omitted; refer to PDF] where [figure omitted; refer to PDF] is the angular rate of LOS frame relative to BLOS frame expressed in LOS frame. [figure omitted; refer to PDF] is the angular rate of BLOS frame relative to body frame expressed in body frame. [figure omitted; refer to PDF] is the angular rate of body frame relative to earth frame expressed in body frame.
The second path is according to the direct rotation relationship between LOS frame and earth frame: [figure omitted; refer to PDF]
By synthesizing (1)-(5), the standard LOS rates [figure omitted; refer to PDF] and [figure omitted; refer to PDF] can be obtained: [figure omitted; refer to PDF] where [figure omitted; refer to PDF] is the element of row [figure omitted; refer to PDF] and column [figure omitted; refer to PDF] of the rotational matrix [figure omitted; refer to PDF] from earth frame [figure omitted; refer to PDF] to body frame [figure omitted; refer to PDF] .
To calculate LOS angle and rate, [figure omitted; refer to PDF] , [figure omitted; refer to PDF] , [figure omitted; refer to PDF] , [figure omitted; refer to PDF] , [figure omitted; refer to PDF] , [figure omitted; refer to PDF] , [figure omitted; refer to PDF] , [figure omitted; refer to PDF] , [figure omitted; refer to PDF] , and [figure omitted; refer to PDF] are required. In practical applications, the body angular rates [figure omitted; refer to PDF] , [figure omitted; refer to PDF] , and [figure omitted; refer to PDF] can be directly measured by inertial measurement unit (IMU). The attitudes [figure omitted; refer to PDF] , [figure omitted; refer to PDF] , and [figure omitted; refer to PDF] can be calculated by strapdown inertial navigation system (SINS). The BLOS angles [figure omitted; refer to PDF] and [figure omitted; refer to PDF] can also be measured by strapdown seeker. BLOS rates [figure omitted; refer to PDF] , [figure omitted; refer to PDF] can be estimated by methods of optical flow [11, 12], differential network, or other filter techniques.
3.2. Kinematic Model of LOS Rate Estimation
Relative kinematics relationship between missile and target in LOS frame can be shown by the following equation [13-15]: [figure omitted; refer to PDF] where [figure omitted; refer to PDF] is the relative distance between missile and target in LOS frame, [figure omitted; refer to PDF] and [figure omitted; refer to PDF] are the accelerations of missile and target, respectively, in LOS frame, and [figure omitted; refer to PDF] is the rotation matrix: [figure omitted; refer to PDF]
We can obtain that [figure omitted; refer to PDF]
According to the transformation between inertial frame and LOS frame, the relationship between LOS angle [figure omitted; refer to PDF] and the angular rate [figure omitted; refer to PDF] can be described as [figure omitted; refer to PDF] where [figure omitted; refer to PDF] is the transformation matrix from inertial frame to LOS frame.
Substituting (10) into (9), the movement equations of LOS can be derived: [figure omitted; refer to PDF]
According to the geometry relationship of the relative motion between missile and target, the target coordinates in LOS frame and in BLOS frame are both equivalent to [figure omitted; refer to PDF] . Using the coordinate and transformation relationship between different frames, [figure omitted; refer to PDF] and [figure omitted; refer to PDF] can be calculated by the following equation: [figure omitted; refer to PDF]
By representing missile attitude with Euler angles, the set of kinematic equations [16] is given as [figure omitted; refer to PDF]
4. LOS Rate Estimation Based on UKF
4.1. State Equation and Measurement Equation
We choose LOS azimuth angle [figure omitted; refer to PDF] , LOS azimuth rate [figure omitted; refer to PDF] , LOS vertical angle [figure omitted; refer to PDF] , LOS vertical rate [figure omitted; refer to PDF] , and attitudes [figure omitted; refer to PDF] , [figure omitted; refer to PDF] , and [figure omitted; refer to PDF] as state vector. Consider [figure omitted; refer to PDF] , where [figure omitted; refer to PDF] and [figure omitted; refer to PDF] .
According to (11), we can obtain [figure omitted; refer to PDF]
Comparing with the velocity of missile, the velocity of ground target is slow, so the missile-target relative velocity [figure omitted; refer to PDF] is approximated to [figure omitted; refer to PDF] . The information of relative distance [figure omitted; refer to PDF] and approaching velocity [figure omitted; refer to PDF] can be calculated approximately by SINS. [figure omitted; refer to PDF] is zero-mean uncorrelated process noise. The missile acceleration in LOS frame is [figure omitted; refer to PDF] where [figure omitted; refer to PDF] is the acceleration of missile measured by accelerometer. Since the target acceleration is unknown, it can be described by time-varying Gauss-Markov random vector [figure omitted; refer to PDF] , with time-varying statistical property [figure omitted; refer to PDF] .
According to the gyro random error and the attitude equation in (13), the attitude state equation can be given as follows: [figure omitted; refer to PDF] where [figure omitted; refer to PDF] and [figure omitted; refer to PDF] is zero-mean uncorrelated process noise.
So the system state equation is described as [figure omitted; refer to PDF] where [figure omitted; refer to PDF] .
The strapdown imaging seeker can directly measure BLOS angles [figure omitted; refer to PDF] and [figure omitted; refer to PDF] . Taking BLOS angle as measurement information [figure omitted; refer to PDF] , from (12), we can get [figure omitted; refer to PDF] where [figure omitted; refer to PDF] , [figure omitted; refer to PDF] is the function of state vector, [figure omitted; refer to PDF] and [figure omitted; refer to PDF] are measurement noise of the seeker, which obey normal distribution [figure omitted; refer to PDF] , and the value of [figure omitted; refer to PDF] is determined by the seeker's FOV and resolution and the performance of image tracker.
During the guidance process, missile angular rate can be measured in real time by MEMS gyros. Gyros output can be described as [figure omitted; refer to PDF] , [figure omitted; refer to PDF] where [figure omitted; refer to PDF] is the real angular rate, [figure omitted; refer to PDF] is the run-to-run bias, and [figure omitted; refer to PDF] is the noise of gyro output, which is determined by the gyro random error characteristic and obeys normal distribution [17, 18].
So the system measurement equation is described as [figure omitted; refer to PDF] where [figure omitted; refer to PDF] and [figure omitted; refer to PDF] .
In (19) and (24), [figure omitted; refer to PDF] and [figure omitted; refer to PDF] are the Gaussian process noise, [figure omitted; refer to PDF] , [figure omitted; refer to PDF] , and they are related with initial state [figure omitted; refer to PDF] , which has mean value [figure omitted; refer to PDF] and covariance [figure omitted; refer to PDF] . For [figure omitted; refer to PDF] , [figure omitted; refer to PDF]
4.2. UKF Estimation Algorithm
From (13), (14), and (20), we know that the LOS rate state equation and measurement equation of the strapdown imaging seeker are mainly composed of trigonometric functions and inverse trigonometric functions; the equations show strong nonlinearity, which cannot be directly estimated by a linear Kalman filter. The extended Kalman filter (EKF) is not in point for its big lineation error. So a nonlinear filtering method is considered. UKF proposed by Julier in [19-21] can be applied to nonlinear model directly, and the expected error is much lower than the EKF. The filter uses sigma sampling points by the unscented transformation to approximate the posterior distribution of the state vector, which avoids the linearization error and makes the filtering accuracy approach third-order Taylor expansion [22]. In addition, UKF need not calculate the Jacobian matrix used in the EKF, even though the calculation is still larger than the EKF. However, we should still assume the posterior probability distributed as Gaussian. Here the UKF algorithm [23] is introduced.
The nonlinear system model can be given by [figure omitted; refer to PDF] where [figure omitted; refer to PDF] is the state, [figure omitted; refer to PDF] is the measurement, [figure omitted; refer to PDF] is the Gaussian process noise, and [figure omitted; refer to PDF] is the Gaussian measurement noise.
Using the matrix form of unscented transform (UT), the prediction and update steps of the UKF can be computed as follows.
(i) Prediction: compute the predicted state mean [figure omitted; refer to PDF] and the predicted covariance [figure omitted; refer to PDF] as [figure omitted; refer to PDF] where initial states vector [figure omitted; refer to PDF] , the convenience [figure omitted; refer to PDF] , [figure omitted; refer to PDF] , and [figure omitted; refer to PDF] is a scaling parameter which determines the spread of the sigma points and is usually set to a small positive value (e.g., [figure omitted; refer to PDF] ), and we can take it as [figure omitted; refer to PDF] . [figure omitted; refer to PDF] is a secondary scaling parameter which provides an extra degree of freedom to "fine-tune" the higher order moments of the approximation and can be used to reduce the overall prediction errors. When [figure omitted; refer to PDF] is assumed Gaussian, a useful heuristic is to select [figure omitted; refer to PDF] . If a different distribution is assumed for [figure omitted; refer to PDF] , then a different choice of [figure omitted; refer to PDF] might be more appropriate. Vector [figure omitted; refer to PDF] and matrix [figure omitted; refer to PDF] are defined as follows: [figure omitted; refer to PDF] where the weights of sigma points are [figure omitted; refer to PDF] where [figure omitted; refer to PDF] is a scaling parameter, which is defined as [figure omitted; refer to PDF] . [figure omitted; refer to PDF] is a parameter used to incorporate any prior knowledge about the distribution of [figure omitted; refer to PDF] ; [figure omitted; refer to PDF] is optimal for Gauss distributions.
(ii) Update: compute the predicted mean [figure omitted; refer to PDF] and covariance of the measurement [figure omitted; refer to PDF] , and the cross-covariance of the state and measurement [figure omitted; refer to PDF] : [figure omitted; refer to PDF]
Then compute the filter gain [figure omitted; refer to PDF] and the updated state mean [figure omitted; refer to PDF] and covariance [figure omitted; refer to PDF] : [figure omitted; refer to PDF]
Computational complexity is a key factor in real-time applications. Many algorithms have high filtering accuracy, but they cannot be used in practical applications because of their expense computational complexity and the large amount of calculation. The computational complexity of the UKF algorithm [24] is [figure omitted; refer to PDF] and the float-point arithmetic operations required for UKF algorithm are [figure omitted; refer to PDF] where [figure omitted; refer to PDF] and [figure omitted; refer to PDF] are the dimensions of state vector and measurement vector and [figure omitted; refer to PDF] and [figure omitted; refer to PDF] are the float-point arithmetic operations required for time update and measurement update of the EKF in one step, which depend on the state and measurement equation.
5. Simulation
5.1. Simulation Principle
As is known from the LOS rate model in Section 3, LOS rate accuracy is influenced by BLOS angle accuracy and the bias stability of gyro. In order to research LOS rate estimation algorithm and how the performance of seeker and gyro impacts on the estimation accuracy, the simulation model is given as in Figure 4. [figure omitted; refer to PDF] and [figure omitted; refer to PDF] are the relative acceleration between missile and target in inertial frame and body frame, which are produced by the relative motion model. [figure omitted; refer to PDF] and [figure omitted; refer to PDF] can be directly obtained by the relative motion model in earth frame. The attitude dynamics and motion module outputs triaxial angular acceleration [figure omitted; refer to PDF] , angular rate [figure omitted; refer to PDF] , and attitude angles [figure omitted; refer to PDF] , [figure omitted; refer to PDF] , and [figure omitted; refer to PDF] . According to (20), BLOS angles [figure omitted; refer to PDF] and [figure omitted; refer to PDF] can be calculated with the above information. The strapdown seeker measures [figure omitted; refer to PDF] and [figure omitted; refer to PDF] ; then α -β filter is used to estimate the BLOS rates [figure omitted; refer to PDF] and [figure omitted; refer to PDF] . The algorithm based on UKF utilizes the information above to estimate LOS rates [figure omitted; refer to PDF] and [figure omitted; refer to PDF] . So we can verify the estimation algorithm by comparing the result with the standard data. The tilde superscript means sensors measurements or the results of calculation algorithm.
Figure 4: Block diagram of LOS rate decoupling algorithm.
[figure omitted; refer to PDF]
5.2. Result and Discussion
5.2.1. LOS Rate Accuracy Based on Different Seeker Accuracy
Simulation conditions are as follows: in the earth coordinate, initial relative position is [figure omitted; refer to PDF] m, [figure omitted; refer to PDF] m, and [figure omitted; refer to PDF] = 300 m; initial relative velocity is [figure omitted; refer to PDF] = -200 m/s, [figure omitted; refer to PDF] = -150 m/s, and [figure omitted; refer to PDF] = -20 m/s; initial relative acceleration is [figure omitted; refer to PDF] = -6 m/s2 , [figure omitted; refer to PDF] = -4.5 m/s2 , and [figure omitted; refer to PDF] = -3.17 m/s2 ; initial attitude angle is [figure omitted; refer to PDF] , [figure omitted; refer to PDF] , and [figure omitted; refer to PDF] ; initial rotation angular rates of missile are zeros; moment of inertia is [figure omitted; refer to PDF] = 0.15 kg m2 , [figure omitted; refer to PDF] = [figure omitted; refer to PDF] = 1.5 kg m2 ; external moment imposed on missile is [figure omitted; refer to PDF] , [figure omitted; refer to PDF] , and [figure omitted; refer to PDF] ; simulation step is 20 ms; simulation time is 10 s. Assuming that the seeker FOV is [figure omitted; refer to PDF] , for a seeker with camera resolution of [figure omitted; refer to PDF] , the pixel resolution is 0.028°/pix. When the measurement accuracy of BLOS angle is 1 pixel, 3 pixels, 5 pixels, and 10 pixels, respectively, the estimation curves and error curves of LOS angle and rate are shown in Figures 5 and 6, and the mean square errors are shown in Table 1 and Figure 7.
Table 1: LOS angle and rate accuracy with different BLOS angle accuracy.
Accuracy | [figure omitted; refer to PDF] (°) | [figure omitted; refer to PDF] (°/s) | [figure omitted; refer to PDF] (°) | [figure omitted; refer to PDF] (°/s) |
1 pix | 0.014 | 0.055 | 0.014 | 0.033 |
3 pixs | 0.042 | 0.071 | 0.043 | 0.050 |
5 pixs | 0.068 | 0.092 | 0.069 | 0.085 |
10 pixs | 0.140 | 0.162 | 0.143 | 0.167 |
Figure 5: LOS vertical angle and rate estimation and error curves due to different BLOS angle accuracy.
(a) LOS vertical angle estimation
[figure omitted; refer to PDF]
(b) LOS vertical rate estimation
[figure omitted; refer to PDF]
(c) LOS vertical angle estimation error
[figure omitted; refer to PDF]
(d) LOS vertical rate estimation error
[figure omitted; refer to PDF]
Figure 6: LOS azimuth angle and rate estimation error curves due to different BLOS angle accuracy.
(a) LOS azimuth angle estimation
[figure omitted; refer to PDF]
(b) LOS azimuth angle rate estimation
[figure omitted; refer to PDF]
(c) LOS azimuth angle estimation error
[figure omitted; refer to PDF]
(d) LOS azimuth rate estimation error
[figure omitted; refer to PDF]
Figure 7: LOS angle and rate accuracy influenced by BLOS accuracy.
[figure omitted; refer to PDF]
With reference to Table 1 and Figure 7, the BLOS angle accuracy impacts the estimation accuracy of LOS angle and rate directly. BLOS angle accuracy and LOS angle accuracy present a relation which is almost linear; also pitch channel and yaw channel have the same characteristics. One-pixel accuracy leads to LOS angle accuracy of 0.0137°. There is an approximate linear relationship between BLOS angle accuracy and LOS rate accuracy, and the scale is 0.015°/s/pix. As the seeker accuracy becomes worse, the LOS angle and rate accuracy becomes worse, too. So, it is necessary to improve the measured BLOS angle accuracy of strapdown seeker to improve LOS rate accuracy.
5.2.2. LOS Rate Accuracy due to Different Gyro Accuracy
MEMS gyros are applied to strapdown missile due to its small size, light weight, and low cost. In this section, we have simulated four gyros of different accuracy to study how gyro accuracy impacts on LOS angle and rate accuracy. Table 2 shows the gyro parameters. The estimation curves of LOS angle and rate are shown in Figure 8, and the mean square errors are shown in Table 3.
Table 2: Parameters of gyro random error model.
Gyro | Random constant | First-order Markov process | White noise | ||
(°/h) | Sampling time (s) | Standard deviation (°/h) | Time constant (s) | Standard deviation (°/h) | |
Type 1 | 10 | 0.005 | 10 | 1.43 | 10 |
Type 2 | 50 | 0.005 | 50 | 1.43 | 50 |
Type 3 | 100 | 0.005 | 100 | 1.43 | 100 |
Type 4 | 300 | 0.005 | 300 | 1.43 | 300 |
Table 3: LOS angle and rate accuracy with different gyro accuracy.
Gyro | [figure omitted; refer to PDF] (°) | [figure omitted; refer to PDF] (°/s) | [figure omitted; refer to PDF] (°) | [figure omitted; refer to PDF] (°/s) |
Type 1 | 0.020 | 0.003 | 0.046 | 0.012 |
Type 2 | 0.063 | 0.005 | 0.090 | 0.015 |
Type 3 | 0.143 | 0.011 | 0.175 | 0.025 |
Type 4 | 0.365 | 0.045 | 0.406 | 0.062 |
Figure 8: LOS angle and rate estimation and error curves due to different accuracy of gyro.
(a) LOS angle estimation curves
[figure omitted; refer to PDF]
(b) LOS rate estimation curves
[figure omitted; refer to PDF]
(c) LOS angle estimation error curves
[figure omitted; refer to PDF]
(d) LOS rate estimation error curves
[figure omitted; refer to PDF]
We can see from Figure 8 that as gyro bias stability grows worse, LOS angle accuracy grows worse too. Under the condition of gyro accuracy 50°/h, LOS angle and rate estimated accuracy are 0.06° and 0.005°/s, respectively. The periodic oscillation curves are produced by gyro first-order Markov process, and the period of oscillation is equal to the first-order Markov time constant.
As shown in Table 3 and Figure 9, the relation between gyro accuracy and LOS angle is approximately linear, and the impact on the LOS rate has the same characteristics. The slope of gyro-LOS angle line is 0.0012°/°/h and the slope of gyro-LOS rate line is 0.0002°/s/°/h separately. LOS angle and rate accuracy improve when gyro accuracy improves, because equivalent bias of gyro directly impacts the attitude, and the increase of attitude error will increase LOS angle and rate error, which is in accordance with the simulation result.
Figure 9: LOS angle and rate accuracy influenced by gyro accuracy.
[figure omitted; refer to PDF]
6. Experimental Verification
6.1. Experiment Design
In order to verify the estimation accuracy of LOS rate based on UKF in practical application, semiphysical simulation experiment platform is designed as in Figure 10, which mainly consists of real-time simulation computer, triaxial flight simulation turntable, graphic workstation, projector and screen, strapdown seeker, MEMS SINS, and so forth. The seeker and MEMS SINS are fixed on the inner frame of turntable. The distance between the seeker and screen and the target size produced by graphic workstation can meet the requirement of seeker FOV and operating range. The simulation computer calculates the flight trajectory in real time using Matlab xPC, which sends the attitude commands [figure omitted; refer to PDF] to the flight simulation turntable through reflection memory network (RMN) and sends the specific force information [figure omitted; refer to PDF] to the processing computer through CAN bus simultaneously; it also computes the relative motion model of target and missile and sends velocity and position information [figure omitted; refer to PDF] to graphic workstation through RS422 serial interface. Graphic workstation observes the motion of target in BLOS frame and shadows the image on the screen by projector. The triaxial turntable simulates the body attitude according to the attitude commands made by the simulation computer. The gyro measures the angular rate of the turntable [figure omitted; refer to PDF] . The seeker tracks the target on the screen and outputs BLOS angle [figure omitted; refer to PDF] . The processing computer reads the body angular rate [figure omitted; refer to PDF] from MEMS gyro STIM202; thus it can compute LOS rate [figure omitted; refer to PDF] in real time with the information of [figure omitted; refer to PDF] .
Figure 10: Semiphysical simulation experiment platform.
[figure omitted; refer to PDF]
In the semiphysical simulation experiment, the actual target size is about 3 m × 3 m, the distance from seeker to screen is about 5 m, and the target initial size in the screen is about 0.012 m × 0.012 m. The accuracy of BLOS angle actually measured by seeker is 3 pixels. STIM202 from Sensonor Company is used for MEMS IMU and its equivalent bias calibrated through experiment is 60°/h. DSP TMS320C6713 from TI Company is selected as processor. Turntable specifications are shown in Table 4. The parameters of strapdown seeker and gyro are shown in Table 5.
Table 4: Turntable specifications.
| Inner axis | Middle axis | Outer axis |
Angular freedom | 0.0000°~359.9999° | 0.0000°~359.9999° | 0.0000°~359.9999° |
| |||
Position |
|
|
|
Accuracy | 0.0001° | 0.0001° | 0.0001° |
Command resolution | 0.0001° | 0.0001° | 0.0001° |
Repeatability | ±2[variant prime][variant prime] | ±2[variant prime][variant prime] | ±2[variant prime][variant prime] |
| |||
Rate |
|
|
|
Range | ±0.001°/s~±1000°/s | ±0.001°/s~±300°/s | ±0.001°/s~±200°/s |
Stability over 360 deg. | 1 × 10-4 | 1 × 10-4 | 1 × 10-4 |
Stability over 10 deg. | 1 × 10-3 | 1 × 10-3 | 1 × 10-3 |
Command resolution | 0.0005°/s | 0.0005°/s | 0.0005°/s |
| |||
Dynamic |
|
|
|
Bandwidth | ≥12 Hz | ≥10 Hz | ≥8 Hz |
Acceleration | ≥3000°/s2 | ≥1500°/s2 | ≥800°/s2 |
Table 5: Seeker and gyro parameters table.
Model item | Parameters |
Strapdown seeker |
|
Bias | Uniform distribution U(0, 0.028°) |
Image processing uncertainty | Normal distribution N(0, 0.028°) |
Quantized error | Uniform distribution U(0, 0.028°) |
Frame frequency | 50 Hz |
| |
Gyro STIM202 |
|
Bias | 60°/h |
Bias stability | 60°/h |
Scale factor accuracy | 200 ppm |
6.2. Result and Discussion
The semiphysical simulation experiment is carried out for verifying LOS estimated algorithm, and the results are shown in Figures 11 and 12 and Table 6.
Table 6: Table of experiment result.
LOS angle and rate | [figure omitted; refer to PDF] | [figure omitted; refer to PDF] | [figure omitted; refer to PDF] | [figure omitted; refer to PDF] |
Max estimation error | 0.345° | 0.352° | 0.478°/s | 0.366°/s |
Estimation accuracy (1 [figure omitted; refer to PDF] ) | 0.100° | 0.097° | 0.110°/s | 0.096°/s |
Figure 11: LOS angle and rate estimation curves.
(a) LOS angle estimation curves
[figure omitted; refer to PDF]
(b) LOS rate estimation curves
[figure omitted; refer to PDF]
Figure 12: LOS angle and rate estimation error curves.
(a) LOS angle estimation error curve
[figure omitted; refer to PDF]
(b) LOS rate estimation error curve
[figure omitted; refer to PDF]
From Figure 12, we can see that the estimated LOS angle and rate could well approach the true value. The maximum errors of LOS vertical angle and azimuth angle are 0.345° and 0.352°, and the estimation accuracy is 0.100° and 0.097°, respectively. The maximum errors of LOS vertical rate and azimuth rate are 0.478°/s and 0.366°/s, and the estimation accuracy is 0.110°/s and 0.096°/s, respectively. The process noise [figure omitted; refer to PDF] has an impact on the convergence rate: the smaller [figure omitted; refer to PDF] is, the faster convergence rate is. Because of the hypothesized slow target motion on the ground, the parameters of target motion can be ignored in practical application. From (14), process noise [figure omitted; refer to PDF] is initialized by the relative distance of missile and target [figure omitted; refer to PDF] , velocity, and acceleration of missile. The algorithm running time is about 2.3 ms in DSP TMS320C6713, which could meet the guidance time requirement of 20 ms.
The correctness of the estimation algorithm based on UKF is verified by the semiphysical simulation experiment, and the estimation accuracy can meet the LOS rate accuracy requirement of guidance system.
7. Conclusion
Strapdown imaging seeker has been widely used due to its simple structure, high reliability, and low cost. However, it cannot output the LOS rate directly. In this paper, considering the relative motion relationship between missile and target, the nonlinear state model of LOS rate estimation is derived. To deal with strong nonlinearity and real-time performance, estimation algorithm based on UKF is proposed. Hitherto unknown, we have proposed and analyzed the idea that the BLOS angle accuracy and gyro accuracy are the main factors impacting on the LOS angle and rate accuracy. Simulation results show that BLOS angle accuracy and LOS rate accuracy present an approximate linear relationship; gyro accuracy and LOS rate accuracy have almost the same characteristics, too. Semiphysical simulation experiment result shows that the LOS rate estimation accuracy can meet the accuracy requirement of guidance system. Algorithm running time in DSP can also meet the requirement of guidance time. Consequently, the LOS rate estimation algorithm based on UKF provides a strong theoretical basis for engineering applications of strapdown imaging seeker and other nonlinear state estimation fields. In the future studies, by applying the LOS angular rate estimate algorithm to the missile guidance system hardware in loop simulation experiment, we can further verify the practical application ability of the algorithm. For non-Gaussian noise, our work will focus on analyzing how the presence of non-Gaussian variables affects the estimation algorithm, and another filter will be employed to overcome this problem. Also another method such as integrated navigation may be introduced to improve the LOS accuracy.
Nomenclature
[figure omitted; refer to PDF] :
LOS vertical angle and azimuth angle
[figure omitted; refer to PDF] :
BLOS vertical angle and azimuth angle
[figure omitted; refer to PDF] :
Euler angles in body axis (pitch, yaw, and roll)
[figure omitted; refer to PDF] :
LOS transform angle
[figure omitted; refer to PDF] :
Image coordinates of the target
[figure omitted; refer to PDF] :
Angular rate of [figure omitted; refer to PDF] frame relative to [figure omitted; refer to PDF] frame expressed in [figure omitted; refer to PDF] frame
[figure omitted; refer to PDF] :
Rotation matrix from [figure omitted; refer to PDF] frame to [figure omitted; refer to PDF] frame
[figure omitted; refer to PDF] :
The element of row [figure omitted; refer to PDF] and column [figure omitted; refer to PDF] of the rotational matrix [figure omitted; refer to PDF]
[figure omitted; refer to PDF] :
Body angular rates in inertial frame
[figure omitted; refer to PDF] :
Body angular rates measured in real time by gyros
[figure omitted; refer to PDF] :
Relative distance and relative velocity between the missile and target
[figure omitted; refer to PDF] :
The accelerations of missile and target, respectively, in LOS frame
[figure omitted; refer to PDF] :
The acceleration of missile measured by accelerometer
[figure omitted; refer to PDF] :
A time-varying Gauss-Markov random vector
[figure omitted; refer to PDF] :
Time-varying statistical property
[figure omitted; refer to PDF] :
Zero-mean uncorrelated process noise
[figure omitted; refer to PDF] :
Measurement noise of the seeker, which obeys normal distribution [figure omitted; refer to PDF]
[figure omitted; refer to PDF] :
The run-to-run bias
[figure omitted; refer to PDF] :
The noise of gyro output
[figure omitted; refer to PDF] :
The noise of strapdown seeker output
[figure omitted; refer to PDF] :
The Gaussian process noise
[figure omitted; refer to PDF] :
The process noise covariance matrix of nonlinear LOS rate estimated model
[figure omitted; refer to PDF] :
The measurement noise covariance matrix of nonlinear LOS rate estimated model
[figure omitted; refer to PDF] :
Initial state mean
[figure omitted; refer to PDF] :
Initial state covariance
[figure omitted; refer to PDF] :
The state of the system on the time step [figure omitted; refer to PDF]
[figure omitted; refer to PDF] :
The measurement on the time step [figure omitted; refer to PDF]
[figure omitted; refer to PDF] :
The process noise on the time step [figure omitted; refer to PDF]
[figure omitted; refer to PDF] :
The process noise covariance matrix
[figure omitted; refer to PDF] :
The measurement noise on the time step [figure omitted; refer to PDF]
[figure omitted; refer to PDF] :
The measurement noise covariance matrix.
Acknowledgments
This work was supported by the Major Science Innovation Foundation of Chinese Academy of Sciences (YYYJ-1122). The authors thank the reviewers and editors for their helpful and constructive comments.
Conflict of Interests
The authors declare that there is no conflict of interests regarding the publication of this paper.
[1] O. Bulent, U. Altug, "Comparison of the strapdown and gimbaled seekers utilized in aerial applications," in Infrared Technology and Applications XXXVIII, vol. 8353, of Proceedings of SPIE, 2012.
[2] R. D. Ehrich, P. Vergez, "Strapdown seeker technology for the terminal guidance of tactical weapons,", no. AD-A092606, 1980.
[3] R. I. Emmert, R. D. Ehrich, "Strapdown seeker guidance for air-surface tactical weapons," ADB030995, 1978
[4] S. Sadhu, T. K. Ghoshal, "Sight line rate estimation in missile seeker using disturbance observer-based technique," IEEE Transactions on Control Systems Technology , vol. 19, no. 2, pp. 449-454, 2011.
[5] D. Kim, C.-K. Ryoo, Y. Kim, J. Kim, "Guidance and control for missiles with a strapdown seeker," in Proceedings of the 11th International Conference on Control, Automation and Systems (ICCAS '11), pp. 969-972, IEEE, Gyeonggi-do, The Republic of Korea, October 2011.
[6] J. Waldmann, "Line-of-sight rate estimation and linearizing control of an imaging seeker in a tactical missile guided by proportional navigation," IEEE Transactions on Control Systems Technology , vol. 10, no. 4, pp. 556-567, 2002.
[7] J. Yingjie, W. Xiao, C. Zhijian, "Application of strapdown homing guidance technology in short-range guided rocket," Journal of Projectiles, Rockets, Missiles and Guidance , vol. 32, no. 1, pp. 13-17, 2012.
[8] L. Jingjing Research of LOS Rate Estimation Method for Strapdown Imaging Seeker , Harbin Institute of Technology, Harbin, China, 2008.
[9] F.-G. Li, Q.-L. Xia, L.-Q. Xiong, "Study on air-to-ground missile with strapdown imaging infrared seeker against moving target," in Proceedings of the 32nd Chinese Control Conference, pp. 5149-5152, Xi'an, China, 2013.
[10] J.-F. Fan, S. Zhong, L. Qing, W. Jiang, "A hybrid differentiator for strapdown guidance system," in Proceedings of the 12th International Conference on Control, Automation and Systems (ICCAS '12), pp. 1960-1964, Jeju Island, Republic of Korea, October 2012.
[11] J. L. Barron, D. J. Fleet, S. S. Beauchemin, "Performance of optical flow techniques," International Journal of Computer Vision , vol. 12, no. 1, pp. 43-77, 1994.
[12] C. Wang, Z. You, F. Xing, B. Zhao, B. Li, G. Zhang, Q. Tao, "Optical flow inversion for remote sensing image dense registration and sensor's attitude motion high-accurate measurement," Mathematical Problems in Engineering , vol. 2014, 2014.
[13] B. Ekstrand, "Tracking filters and models for seeker applications," IEEE Transactions on Aerospace and Electronic Systems , vol. 37, no. 3, pp. 965-977, 2001.
[14] S. Blackman Multiple-Target Tracking with Radar Applications , Artech House, Dedham, Mass, USA, 1986.
[15] Y. Bar-Shalom, T. E. Fortmann Tracking and Data Association , Academic Press, New York, NY, USA, 1988.
[16] G. M. Siouris Missile Guidance and Control Systems , Springer, New York, NY, USA, 2004.
[17] M. Kirkko-Jaakkola, J. Collin, J. Takala, "Bias prediction for MEMS gyroscopes," IEEE Sensors Journal , vol. 12, no. 6, pp. 2157-2163, 2012.
[18] J. Georgy, A. Noureldin, M. J. Korenberg, M. M. Bayoumi, "Modeling the stochastic drift of a MEMS-based gyroscope in gyro/odometer/GPS integrated navigation," IEEE Transactions on Intelligent Transportation Systems , vol. 11, no. 4, pp. 856-872, 2010.
[19] S. J. Julier, J. K. Uhlmann, H. F. Durrant-Whyte, "A new approach for filtering nonlinear systems," in Proceedings of the American Control Conference, vol. 3, pp. 1628-1632, IEEE, Seattle, Wash, USA, June 1995.
[20] S. J. Julier, J. K. Uhlmann, "Unscented filtering and nonlinear estimation," Proceedings of the IEEE , vol. 92, no. 3, pp. 401-422, 2004.
[21] S. J. Julier, J. K. Uhlmann, "new extension of the Kalman filter to nonlinear systems," in The 6th Signal Processing, Sensor Fusion, and Target Recognition, vol. 3068, of Proceedings of SPIE, pp. 182-193, Orlando, Fla, USA, July 1997.
[22] S. S. Bisht, M. P. Singh, "An adaptive unscented Kalman filter for tracking sudden stiffness changes," Mechanical Systems and Signal Processing , vol. 49, no. 1-2, pp. 181-195, 2014.
[23] R. Veloso Garcia, H. K. Kuga, M. C. F. P. S. Zanardi, "Unscented Kalman filter applied to the spacecraft attitude estimation with Euler angles," Mathematical Problems in Engineering , vol. 2012, 2012.
[24] W. Yang, W. Shou-yong, "Analysis of performances on nonlinear filter algorithms," Journal of Air Force Radar Academy , vol. 24, no. 2, pp. 111-114, 2010.
You have requested "on-the-fly" machine translation of selected content from our databases. This functionality is provided solely for your convenience and is in no way intended to replace human translation. Show full disclaimer
Neither ProQuest nor its licensors make any representations or warranties with respect to the translations. The translations are automatically generated "AS IS" and "AS AVAILABLE" and are not retained in our systems. PROQUEST AND ITS LICENSORS SPECIFICALLY DISCLAIM ANY AND ALL EXPRESS OR IMPLIED WARRANTIES, INCLUDING WITHOUT LIMITATION, ANY WARRANTIES FOR AVAILABILITY, ACCURACY, TIMELINESS, COMPLETENESS, NON-INFRINGMENT, MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE. Your use of the translations is subject to all use restrictions contained in your Electronic Products License Agreement and by using the translation functionality you agree to forgo any and all claims against ProQuest or its licensors for your use of the translation functionality and any output derived there from. Hide full disclaimer
Copyright © 2015 Tingting Sun et al. Tingting Sun et al. This is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.
Abstract
Aiming at the problem that the strapdown imaging seeker cannot measure line-of-sight (LOS) rate directly, this paper presents an effective algorithm for LOS rate estimation. To address the problem, the reference frames and angles are defined. According to the relative kinematics and attitude relationship between missile and target, the nonlinear state equations and measurement equations of LOS rate are derived, and the estimation algorithm based on unscented Kalman filter (UKF) is proposed. Considering the estimation accuracy mainly depends on body LOS (BLOS) angle accuracy and gyro accuracy, the paper is unprecedented to research how these two factors impact the LOS angle and rate accuracy by simulation. Semiphysical simulation experiment verifies the correctness and accuracy of the algorithm, and the result shows that the estimation algorithm can meet the accuracy and real-time requirements of guidance system simultaneously. Thus LOS rate estimation algorithm based on UKF provides a theoretical basis for engineering applications of strapdown imaging seeker.
You have requested "on-the-fly" machine translation of selected content from our databases. This functionality is provided solely for your convenience and is in no way intended to replace human translation. Show full disclaimer
Neither ProQuest nor its licensors make any representations or warranties with respect to the translations. The translations are automatically generated "AS IS" and "AS AVAILABLE" and are not retained in our systems. PROQUEST AND ITS LICENSORS SPECIFICALLY DISCLAIM ANY AND ALL EXPRESS OR IMPLIED WARRANTIES, INCLUDING WITHOUT LIMITATION, ANY WARRANTIES FOR AVAILABILITY, ACCURACY, TIMELINESS, COMPLETENESS, NON-INFRINGMENT, MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE. Your use of the translations is subject to all use restrictions contained in your Electronic Products License Agreement and by using the translation functionality you agree to forgo any and all claims against ProQuest or its licensors for your use of the translation functionality and any output derived there from. Hide full disclaimer