# In-Flight Self-Alignment Method Aided by Geomagnetism for Moving Basement of Guided Munitions

Authors: Shuang-biao Zhang; Xing-cheng Li; Zhong Su
Journal: Journal of Control Science and Engineering
 (2015)

---

## Abstract

Due to power-after-launch mode of guided munitions of high rolling speed, initial attitude of munitions cannot be determined accurately, and this makes it difficult for navigation and control system to work effectively and validly. An in-flight self-alignment method aided by geomagnetism that includes a fast in-flight coarse alignment method and an in-flight alignment model based on Kalman theory is proposed in this paper. Firstly a fast in-flight coarse alignment method is developed by using gyros, magnetic sensors, and trajectory angles. Then, an in-flight alignment model is derived by investigation of the measurement errors and attitude errors, which regards attitude errors as state variables and geomagnetic components in navigation frame as observed variables. Finally, fight data of a spinning projectile is used to verify the performance of the in-flight self-alignment method. The satisfying results show that (1) the precision of coarse alignment can attain below 5°; (2) the attitude errors by in-flight alignment model converge to 24′ at early of the latter half of the flight; (3) the in-flight alignment model based on Kalman theory has better adaptability, and show satisfying performance.


---

## Body

## 1. Introduction

Guided munitions improved from conventional artillery shells attract more global attention for their outstanding advantages such as low cost, high battle effectiveness, and high stability. In practical applications, the power-before-launch mode is chosen for guided munitions. But this mode frequently induces the electrical circuits systems fixed in guided munitions to shock fiercely, and the electrical circuits systems are damaged to be invalid by momentary impact force. Thus, a more appropriate power-after-launch mode, as an ideal power mode, is raised to ensure the safety of the electrical circuits systems. The only drawback of this power mode is that initial attitude cannot be obtained accurately, and this makes it hard for navigation and control system to work effectively and validly. Therefore, to guarantee implement of guidance, it is imperative for the power-after-launch mode of guided munitions to exploit an effective approach of initial alignment.Up to now, many achievements on in-flight alignment and alignment of moving basement are undergoing by using Global Position System (GPS), due to the fact that GPS can provide accurate position for carriers in need. A strapdown inertial navigation system (SINS) in-flight alignment algorithm proposed by Mei decomposes the attitude quaternion into three parts: inertial rate, separate earth motion, and a constant quaternion. The first two parts are solved based on Microelectromechanical Systems (MEMS) gyros’ measurement and GPS position information, respectively, and the constant quaternion is solved by using request method [1]. A coarse alignment method is presented by Qian et al. to acquire the initial position, velocity, and attitude information with the help of GPS. The method could be implemented in airplanes of high speed and high dynamic flight without any restrictive condition of dynamic process and flight stability [2]. A robust filter and various error models for SINS in-flight alignment are presented by Yu and Lee to deal with the uncertainty by linearization of the system that degrades the performance of the filter. This method shows fine performance of estimation if enough time is allowed [3]. A H∞ filter designed by Pei et al. can analyze the uncertainty of measurement noise and realize in-flight alignment of aircrafts [4]. A technique for constructing the initial alignment system for unmanned aerial vehicles is proposed by Veremeenko and Savel’Ev to improve the accuracy of alignment and reduce the alignment time [5]. An estimation algorithm is proposed by She et al. to calculate initial roll angle of guided munitions under small angle of attack with the help of GPS [6]. An adaptive filtering algorithm of an extended Kalman filter (EKF) combined with innovation-based adaptive estimation is proposed by Fang and Yang to realize initial alignment, and the algorithm introduces the calculated innovation covariance into the computation of the filter gain matrix directly [7]. Meanwhile, an estimation method is presented by Silson for fast initial coarse alignment of a ship’s strapdown inertial attitude reference system using only inertial measurement unit (IMU) measurements for quasi-static alignment and IMU measurements with GPS aiding for moving-base alignment [8]. An improved self-alignment scheme for SINS based on the EKF and augmented measurements is proposed by Acharya et al. Monte Carlo simulations show that the method provides fine azimuth alignment and improves rate of convergence of azimuth attitude error and reduction in sensitivity to gyro biases [9]. A novel method using the GPS measurements is investigated by Ma et al. to help to solve coarse alignment. Specific vectors are constructed with GPS measurements and used for attitude matrix computation [10]. In addition, a nonlinear approach for the in-motion alignment problem of inertial navigation system using Doppler speed measurements with unknown initial vehicle is proposed by Bimal Raj and Joshi, and an unscented Kalman filter for alignment shows better performance than that of extended Kalman filter [11]. Body frame velocity from Doppler Velocity Log (DVL) is used by Li et al. to construct the vector observations for initial alignment of underwater vehicles [12].At our best knowledge, applications of satellite navigation technique are dependent on authorization, and it is easy to disturb signal of satellites by other strong signals on purpose. Moreover, GPS and Doppler technique are suitable for low dynamical carrier, especially for the carrier with low rolling speed or without rolling. In other words, there is no valid way to implement initial alignment of guided munitions with high spinning speed and power-after-launch mode.In this paper, we represent an in-flight self-alignment method of moving basement aided by geomagnetism, which includes a fast in-flight coarse alignment method and an in-flight alignment model based on Kalman theory. The rest of this paper is organized as follows. In the second section, we exploit a fast in-flight coarse alignment method by using gyros, magnetic sensors, and trajectory angle. The third section describes an in-flight alignment model by using Kalman theory to estimates the attitude angles. The case study is given in the fourth section. Finally, we conclude this paper in the fifth section.


## 2. A Fast In-Flight Coarse Alignment Method

In general, the initial alignment consists of two stages, the coarse alignment and the fine alignment. The coarse alignment is the basic step to supply initial attitude for the fine alignment. This process is crucial but difficult to estimate attitude angle of munitions with high spinning speed and power-after-launch mode. Thus, in this section, we investigate a fast in-flight coarse alignment method to calculate initial attitude by analyzing the angular kinematic model and attitude resolving algorithm of magnetic sensors.For convenience of investigation, we choose east-north-up frame as navigation frame, and the angular kinematic models are described as [13](1)γ˙ϑ˙ψ˙=1-sin⁡γtan⁡ϑ-cos⁡γtan⁡ϑ0cos⁡γ-sin⁡γ0sin⁡γcos⁡ϑcos⁡γcos⁡ϑωbxωbyωbz,where γ is the roll angle, ϑ is pitch angle, ψ is yaw angle, γ˙, ϑ˙, and ψ˙ are the corresponding angle changing rates, and ωbx, ωby, and ωbz are measurement data of MEMS gyros.By transforming (1), the pitch angle can be formulated by(2)ϑ=±arccos⁡ωby2+ωbz2-ϑ˙2ψ˙2.From (2), it is seen that the symbol of pitch angle is positive in the rising stage of guided munitions, and it is opposite in the falling stage. To implement coarse alignment and ensure enough time for fine alignment, the pitch angle must be determined in the rising stage. So its symbol of pitch angle is positive.Assuming aerodynamic force and gravity that guided munitions suffer vary slightly, the influence of coning motion is ignored. The pitch angle, yaw angle, and their corresponding changing rates can be regarded as long-periodic variables. Meanwhile, the changing rates of pitch angle and yaw angle vary slowly and even keep invariant during very short time. We can formulateϑ˙ and ψ˙ by the ideal ballistic trajectory angles, inclination angle θ, and heading angle ψv:(3)ϑ˙≈θ˙≈θt+Δt-θtΔt,ψ˙≈ψ˙v≈ψvt+Δt-ψvtΔt,where Δt is time interval. Equation (3) can be used to calculate data on line. If some calculations need to be done offline, θ and ψv can be calculated by(4)θ=arctan⁡υyυx2+υz2,ψv=-arctan⁡υzυx,where υx, υy, and υz are components of velocity in navigation frame, and they can be calculated as(5)υx=xt+Δt-xtΔt,υy=yt+Δt-ytΔt,υz=zt+Δt-ztΔt,where x, y, and z are components of location. In fact, the real ballistic trajectory angles are similar to the ideal ones.Due to low cost of the MEMS sensors, they are familiar in navigation and control system of guided munitions. However, narrow measurement range and poor accuracy of existing MEMS gyros cannot meet measurement requirement of guided munitions with high rolling speed ofx-axis. To solve the problem of calculation of roll angle, we make use of MEMS magnetic sensors that are fixed in guided munitions to help navigation computer calculate attitude.The attitude algorithm of geomagnetic technology has been investigated for several years. It has high level of resolving precision and satisfying instantaneity, so we can resolve attitude in real-time. The formulations of yaw angle and roll angle are described as [14](6)ψ=D+arccos⁡mbx/B+sin⁡ϑsin⁡Icos⁡ϑcos⁡I,γ=arctan⁡cos⁡Isin⁡ψ-Dcos⁡ψ-Dcos⁡Isin⁡ϑ+sin⁡Icos⁡ϑ+arctan⁡mbymbz,where I and D are, respectively, inclination angle and declination angle of geomagnetic vector and mbx, mby, and mbz are measurement values of MEMS magnetic sensors in body frame. From (6), we can see that the yaw angle is related to measurement value of the longwise magnetic sensor, and the roll angle is related to lateral measurement values. By combining (2) and (6), the initial attitude can be determined, and the coarse alignment can be realized.Generally speaking, the firing range of munitions is about several kilometers or scores of kilometers, and the geomagnetic vector changes slightly. Thus, the geomagnetic information can be stored in the navigation computer before launching. It is convenient to extract geomagnetic information when guided munitions are in-flight.


## 3. An In-Flight Alignment Model Based on Kalman Theory

Based on the coarse alignment, it is ready to make fine alignment for navigation and control system. In this section, we develop an in-flight alignment model based on Kalman theory to estimate angle errors and achieve fine alignment.The measurement errors of MEMS gyros sensing lateral control channels exist all the time because of their poor measurement precision. So the measurement values of gyros contain actual angular speed and error information, and the attitude resolved by (1) also contains actual attitude and error information. Thus, the actual formulations of (1) can be improved as (7)γ˙+δγ˙ϑ˙+δϑ˙ψ˙+δψ˙=1-sin⁡γ+δγtan⁡ϑ+δϑ-cos⁡γ+δγtan⁡ϑ+δϑ0cos⁡γ+δγ-sin⁡γ+δγ0sin⁡γ+δγcos⁡ϑ+δϑcos⁡γ+δγcos⁡ϑ+δϑωbx+δωbxωby+δωbyωbz+δωbz,where δγ, δϑ, and δψ are attitude errors, δγ˙, δϑ˙, and δψ˙ are changing rates errors of attitude, and δωbx, δωby, and δωbz are measurement errors of gyros.As long as the attitude errors are enough small, which are assumed less than five degree, the trigonometric functions in (7) can be simplified by using sin⁡(δx)≈δx and cos⁡(δx)≈1:(8)tan⁡ϑ+δϑ≈tan⁡ϑ+1+tan2⁡ϑδϑ,cos⁡γ+δγ≈cos⁡γ-δγsin⁡γ,sin⁡γ+δγ≈sin⁡γ+δγcos⁡γ,1cos⁡ϑ+δϑ≈cos⁡δϑcos⁡ϑ-sin⁡δϑsin⁡ϑ≈1cos⁡ϑ-δϑsin⁡ϑ.Thus, we can simplify (7) by substituting (8) into (7). Meanwhile, comparing (1) with simplified formulation of (7), the differential equations of attitude errors can be obtained:(9)δγ˙=δγωbytan⁡ϑsin⁡γ-ωbztan⁡ϑcos⁡γ-δϑ1+tan2⁡ϑωbycos⁡γ+ωbzsin⁡γ+Δx,(10)δϑ˙=-δγωbysin⁡γ+ωbzcos⁡γ+Δy,(11)δψ˙=δϑ-ωbysin⁡γ+ωbzcos⁡γsin⁡ϑ+δγωbycos⁡γ-ωbzsin⁡γcos⁡ϑ+Δz,where Δx, Δy, and Δz are drift errors of equivalent gyros. From (11), it is seen that yaw angle error may be singular if pitch angle is zero.By dealing with (9)–(11), the state formulation based on Kalman theory can be described as(12)X˙=FX+GΔ,where F is state transition matrix and defined as(13)F=F11F12F13F21F22F23F31F32F33,where(14)F11=ωbytan⁡ϑsin⁡γ-ωbztan⁡ϑcos⁡γ,F12=1+tan2⁡ϑωbycos⁡γ+ωbzsin⁡γ,F13=0,F21=ωbysin⁡γ+ωbzcos⁡γ,F22=0,F23=0,F31=ωbycos⁡γ-ωbzsin⁡γcos⁡ϑ,F32=-ωbysin⁡γ+ωbzcos⁡γsin⁡ϑ,F33=0.X is state variable matrix, X=ΔγΔϑΔψT. G is system noise drive matrix, G=100010001. Δ is system noise matrix, Δ=ΔxΔyΔzT.The main frame of mind to establish observing matrix is as follows. We transform the measurement values of MEMS magnetic sensors fixed in body frame to navigation frame and transform the geomagnetic vector to navigation frame. Then we regard the discrepancy of comparison between the two parts as the observed quantities to estimate the state values. Considering about attitude errors, the actual transform matrix contains the errors matrix. The observed equation can be formulated by(15)Cmn0B0=C~bn-δCbnmbxmbymbz,where δCbn is error matrix, and it can be described as(16)δCbn=δC11δC12δC13δC21δC22δC23δC31δC32δC33.Each element inδCbn is described as(17)δC11=cos⁡ϑcos⁡ψΔψ-sin⁡ϑΔϑsin⁡ψ,δC12=-sin⁡γsin⁡ϑcos⁡ψΔψ+sin⁡γcos⁡ϑΔϑsin⁡ψ+cos⁡γΔγsin⁡ϑsin⁡ψ+cos⁡γsin⁡ψΔψ+sin⁡γΔγcos⁡ψ,δC13=-sin⁡γΔγsin⁡ϑsin⁡ψ+cos⁡γcos⁡ϑΔϑsin⁡ψ+cos⁡γsin⁡ϑcos⁡ψΔψ+cos⁡γΔγcos⁡ψ-sin⁡γcos⁡ψΔψ,δC21=-cos⁡ϑsin⁡ψΔψ-sin⁡ϑcos⁡ψΔϑ,δC22=-sin⁡γsin⁡ϑsin⁡ψΔψ+sin⁡γcos⁡ϑΔϑcos⁡ψ+cos⁡γΔγsin⁡ϑsin⁡ψ+cos⁡γcos⁡ψΔψ-sin⁡γΔγsin⁡ψ,δC23=--sin⁡γΔγsin⁡ϑcos⁡ψ+cos⁡γcos⁡ϑΔϑcos⁡ψ-cos⁡γsin⁡ϑsin⁡ψΔψ-cos⁡γΔγsin⁡ψ+sin⁡γsin⁡ψΔψ,δC31=cos⁡ϑΔϑ,δC32=-sin⁡γsin⁡ϑΔϑ+cos⁡γΔγcos⁡ϑ,δC33=-sin⁡γΔγcos⁡ϑ-cos⁡γsin⁡ϑΔϑ.The differences of magnetic components in navigation frame can be obtained by transforming (15):(18)C~bnmbxmbymbz-Cmn0B0=δCbnmbxmbymbz=δC11mbx+δC12mby+δC13mbzδC21mbx+δC22mby+δC23mbzδC31mbx+δC32mby+δC33mbz.Attitude errors that are contained in each element in the right side of (18) can be separated from the actual attitude, and the observed equation can be described directly as(19)Z=HX+V,where Z is observed quantities, Z=Cmn0B0-Cbnmbxmbymbz, H is measurement matrix, H=H1H2H3H4H5H6H7H8H9, and V is measurement noise, V=ζeζnζuT. In addition, each element of H is formulated as (20)H1=-cos⁡γsin⁡ϑsin⁡ψ+sin⁡γcos⁡ψmby+-sin⁡γsin⁡ϑsin⁡ψ+cos⁡γcos⁡ψmbz,H2=-sin⁡ϑsin⁡ψmbx-sin⁡γcos⁡ϑsin⁡ψmby-cosγcosϑsinψmbz,H3=cos⁡ϑcos⁡ψmbx+-sin⁡γsin⁡ϑcos⁡ψ+cos⁡γsin⁡ψmby+-cos⁡γsin⁡ϑcos⁡ψ-sin⁡γcos⁡ψmbz,H4=-cos⁡γsin⁡ϑsin⁡ψ-sin⁡γsin⁡ψmby+sin⁡γsin⁡ϑcos⁡ψ-cos⁡γsin⁡ψmbz,H5=-sin⁡ϑcos⁡ψmbx-sin⁡γcos⁡ϑcos⁡ψmby-cos⁡γcos⁡ϑcos⁡ψmbz,H6=-cos⁡ϑsin⁡ψmbx+-sin⁡γsin⁡ϑsin⁡ψ+cos⁡γcos⁡ψmby+cos⁡γsin⁡ϑsin⁡ψ-sin⁡γsin⁡ψmbz,H7=cos⁡γcos⁡ϑmby-sin⁡γcos⁡ϑmbz,H8=cos⁡ϑmbx-sin⁡γsin⁡ϑmby-cos⁡γsin⁡ϑmbz,H9=0.


## 4. Case Study

For the sake of verification of the in-flight self-alignment method, we utilize a real experimental data of a spinning projectile whose navigation computer monitored the whole fight data. The flight experiment is made in the northern hemisphere, and the angles of geomagnetic vector areI=1.00 rad and D=0.11 rad. The total flight time is 65 s, and the interval time is 0.01 s. The trajectory of the spinning projectile is shown in Figure 1, which is obtained by telemetry technology.Figure 1
Trajectory of the spinning projectile.The main mind of this process is as follows. We apply the fast coarse alignment method firstly to calculate the initial attitude by using data during 0 s~5 s from Figures1, 3, and 4 and then apply in-flight alignment model based on Kalman theory to realize more accurate self-alignment by using data during 5 s~65 s.Figure2 shows measurement data of the MEMS triaxial gyro fixed in the projectile. A high rolling speed in x-axis of the projectile is 43.33 rad/s at first. Then the rolling speed suffers a fast reduction of speed in front half of the flight, and finally it maintains about 7.35 rad/s that is still regarded as a high spinning speed.Figure 2
Measurement data of the MEMS triaxial gyro.Figure 3
Measurement data of the triaxial magnetic sensor.Figure 4
The changing rate of the trajectory angles.Figure3 shows the measurement data of the MEMS triaxial magnetic sensor fixed in the projectile. The longwise component of the sensor is negative during rising stage and then becomes positive during falling stage. The transversal components vary alternately like a sinusoid as the projectile spins. In fact they are the components of projection of geomagnetic vector in body frame during the whole flight.Figure4 shows the changing speed of the trajectory angles that can be calculated by using the data of Figure 1. From Figure 4, we can see the varying range of θ˙ is -0.038rad/s-0.013rad/s and the varying range of ψ˙ is -0.001rad/s-0.023rad/s. They change slowly in the whole time.Figure5 provides the attitude by using fast alignment method during 0 s~5 s. It is seen that seven sets are calculated by fast coarse alignment method. It is because not any value of ϑ by (2) is satisfied, and we choose the value under square root that is less than 1.Figure 5
Attitude calculated by fast coarse alignment method.Table1 shows the attitude error. It is clear that the attitude error is less than five degree and meets the assumption of (8). So the fast coarse alignment method is valid.Table 1
Attitude error by fast coarse method.
Time (s)
Δ
ϑ (rad)
Δ
ψ (rad)
Δ
γ (rad)
0.43
0.017
0.008
0.062
0.77
−0.008
0.0014
0.051
1.09
−0.014
0.009
−0.074
2.81
0.09
0.0041
0.081
3.29
0.013
−0.016
0.054
4.33
−0.016
−0.009
−0.063
4.67
0.026
0.012
0.049We choose the attitude of this projectile at 4.33 s as the initial attitude that isϑ=0.75 rad, ψ=-0.00084 rad, and γ=0.18 rad, and the corresponding actual attitude is ϑ=0.72 rad, ψ=-0.0044 rad, and γ=0.13 rad.Based on the coarse initial alignment, we continue to make fine alignment by using the in-flight alignment mode based on Kalman theory. Figure6 shows the process of the alignment from 5 s~65 s. It is seen that the attitude error reduces gradually, and the converging speed of rolling angle error is slower than others. When the projectile flies over the peak of the flight, the alignment error has fluctuation near 29 s due to occurrence of singular of ϑ. Through the alignment method working, the attitude converges soon. It is apparent that the model has a better adaptability.Figure 6
The process of the fine alignment by the in-flight alignment mode based on Kalman theory.Figure7 shows the partial magnification of attitude error. At 34 s, the attitude error is less than 0.01 rad. At 39.26 s, the roll angle error is 0.006 rad, pitch angle error is zeros, and yaw angle error is −0.007 rad. It is clear that the maxium error is about 24′, which is high precision level for spining munintions. Although the pitch angle error is increasing after 39.26 s, the final error is 0.0020 rad at 65 s. At the same time, the roll angle error is 0.0067 rad, and yaw angle error is 0.0021 rad. It is apparent that fine alignment by the in-flight alignment model based on Kalman theory shows satisfying performance, which is achieved finalliy.Figure 7
Partial magnification of attitude error.


## 5. Conclusions

To solve the problem of initial alignment of guided munitions, this paper introduces an in-flight self-alignment method aided by geomagnetism composed of a fast coarse alignment method and an in-flight alignment model by Kalman theory. The fast in-flight coarse alignment method is developed by using gyros, magnetic sensors, and trajectory angle. The in-flight alignment model by Kalman theory is developed through investigation of the measure errors and attitude errors, and this model regards attitude errors as state variables and geomagnetic components in navigation frame as observed variables. Finally, we utilize a data of a spinning projectile to verify the performance of alignment method. The results show that (1) the precision of coarse alignment can attain below 5°; (2) the attitude errors by in-flight alignment model converge to 24′ at early of the latter half of the flight; (3) the in-flight alignment model based on Kalman theory has better adaptability and show satisfying performance. Therefore, the in-flight self-alignment method aided by geomagnetism can meet the requirement of guided munitions with high spinning speed and power-after-launch mode. Furthermore, this method is also suitable for carriers of low rotating speed. In the future, the guidance and control for guided munitions of the high rotating speed will be investigated.



---

*Source: 425698-2015-05-24.xml*