Roll Attitude Determination of Spin Projectile Based on GPS and Magnetoresistive Sensor
Improvement in attack accuracy of the spin projectiles is a very significant objective, which increases the overall combat efficiency of projectiles. The accurate determination of the projectile roll attitude is the recent objective of the efficient guidance and control. The roll measurement system for the spin projectile is commonly based on the magnetoresistive sensor. It is well known that the magnetoresistive sensor produces a sinusoidally oscillating signal whose frequency slowly decays with time, besides the possibility of blind spot. On the other hand, absolute sensors such as GPS have fixed errors even though the update rates are generally low. To earn the benefit while eliminating weaknesses from both types of sensors, a mathematical model using filtering technique can be designed to integrate the magnetoresistive sensor and GPS measurements. In this paper, a mathematical model is developed to integrate the magnetoresistive sensor and GPS measurements in order to get an accurate prediction of projectile roll attitude in a real flight time. The proposed model is verified using numerical simulations, which illustrated that the accuracy of the roll attitude measurement is improved.
Improvement in attack accuracy of the spin projectiles is a very important objective, which increases the overall combat efficiency of projectiles. The accurate determination of the spin projectile roll attitude has recently become the key technology for improving guidance accuracy and flight stability. Inertial Navigation System (INS) is commonly used to determine the position, speed, and attitude of projectile with a high update, which consists mainly of three gyroscopes and three accelerometers. The INS has commonly been used as a means of localization for projectiles [1–3]. The disadvantage in use of an INS, particularly when using low-cost sensors, is due to the accumulation of errors with time due to the dead-reckoning nature of the sensor. Furthermore, the inertial navigation can hardly satisfy the requirements of the projectile launching system such as high-g and high spin rate. The magnetoresistive sensor can be used to determine the roll attitude in effective way, especially in the high spin and high-g projectile launching environment. In addition, it can overcome the disadvantage of the accumulated errors over time. Moreover, it has advantages [4, 5] of passive sensing, high sensitivity, high-resolution measurement, low power, small size, and low cost. For example, HMC1043 has a linearity error of 0.1% Fs under best fit straight line (±1 Gauss) conditions, and the sensitivity is 1 mV/V/Gauss. So it has been widely and successfully used in attitude measurement [6, 7]. The GPS also is commonly used to determine the navigation data of projectile. It has advantages of high precision, all-weather capability, and continuous work, which can provide real-time information of position and velocity of projectile [8–10]. A method for synthesizing attitude data using single-antenna GPS velocity measurements was successfully demonstrated in this study . The notion of pseudoattitude was introduced and was shown to provide adequate attitude data with no subjective or substantial objective differences as compared with the conventional attitude display.
In many practical applications, if only one kind of sensor is adopted for attitude measurement, the precision will be affected due to respective drawbacks and restrictions. Hence, some integrated sensors are emerged [11–14], such as GPS/INS, GPS/MEMS-INS, integration of GPS and accelerometer, and integration of magnetoresistive sensor and gyroscope. Attitude determination systems that use inexpensive sensors, which are based on computationally efficient and robust algorithms, are indispensable for real-time vehicle navigation, guidance, and control applications [15, 16]. The accelerometers in conjunction with the derivative of GPS velocity provided a measure of the gravitation field vector and the magnetometers measured the earth’s magnetic field vector.
In this paper, a mathematical model is developed to integrate the magnetoresistive sensor and GPS measurements in order to get an accurate prediction of projectile roll attitude in a real flight time. Based on the velocity information provided by GPS, the trajectory inclination angle and deflection angle are determined. And then the roll attitude can be calculated by using the developed model which utilizes the magnetoresistive sensor output. In this study , a high-frequency measuring method for the projectile roll angle and angular rate, which is based on the assumptions of small angle-of-attack and single axis rotation, is established using the flight characteristics of high-spin projectile. The real-time systematic error of this combined measuring system is calculated by establishing the simulation model with pitch angle as a variable. In this work, the typical magnetoresistive sensor is used for roll attitude measurement, and in the event of blind spot, GPS can give aiding data, enabling the navigation system to go on until the magnetoresistive output can be reestablished. Regarding the geomagnetic field characteristics, it can be seen that the intensity of geomagnetic field and its direction are function of position. And based on the calculation of the International Geomagnetic Reference Field (IGRF), the total amounts of the Earth magnetic field in our country are basically equal in all places. And, as known, with the variation of 1° in latitude or longitude, the ground distance varies by approximately 110 km. For the proposed projectile, which is used in this paper for roll attitude determination, the range is basically within 100 km. Therefore, the magnitude and direction of local magnetic field are almost invariable with the range. The proposed model is verified using numerical simulations, which illustrated that the accuracy of the roll attitude measurement is improved.
2. Principle on Measurement of Projectile Roll Attitude with GPS and Magnetoresistive Sensor
Three attitude angles (Euler angles) of projectile describe the relation between body coordinate system o-x1y1z1 and ground coordinate system o-xyz. , , and refer to pitch angle, yaw angle, and projectile spinning angle, respectively. Transformation matrix between these two frames is noted as , and corresponding transformation relation is listed in Table 1.
Magnetoresistive sensor was embedded on the projectile; the direction of its sensitive axis should be consistent with direction of three axes in body coordinate system, which is used to measure the projection of the Earth magnetic field. The three components of geomagnetic field intensity, B, in geographical coordinate system o-NED (North East Down) are denoted as , , and , respectively. , , and refer to the projection of geomagnetic vector on the three axes of ground coordinate system. Angle is used to describe the angle between ox-axis of ground coordinate system and oN-axis of geographical coordinate system. , , and refer to components of geomagnetic vector in body coordinate system. Using geomagnetic information, the formula can be derived from coordinate systems transformation as follows:
Generally, angle is the fixed and known parameter. In this work, the ox-axis of ground coordinate system is coincided with oN-axis of geographic coordinate system, so, namely, .
Thus, formula (1) can be simplified and transformed into
Hence, calculation formula of projectile spinning angle can be obtained from the above formula: where
It can be derived from analysis of formula (3) that projectile spinning angle can be calculated conveniently if the pitch angle and yaw angle are replaced by trajectory inclination angle and deflection angle, respectively. Although replacement of attitude angles can lead to certain error, the feasibility of such replacement has been verified. Usually, attack angle is very small during the projectile flight aiming to ensure flight stability, while it also assures the effectiveness of the replacement, and then the error caused by the replacement under flight of small attack angle can be neglected.
Using the components , , and of projectile velocity in the NED coordinate system, which is provided by GPS, trajectory inclination angle and trajectory deflection angle can be calculated. From the definition of trajectory inclination angle, which describes the angle between horizontal plane of ground coordinate system and velocity vector, the formula of trajectory inclination angle can be written as
From the definition of trajectory deflection angle, which describes the relation between the projection of velocity vector on horizontal plane of ground coordinate system and the ox-axis, the formula of trajectory deflection angle can be written as
In above parts, the detailed approach to measure and calculate projectile spinning angle utilizing the combination of GPS and magnetoresistive sensor outputs is described. However, in the projectile flight, outputs of magnetoresistive sensor installed on -axis and -axis of projectile depend on the position relation between geomagnetic field vector and the projectile body axis. In flight, when the direction of geomagnetic field intensity is lying on the firing plane, the component of geomagnetic field intensity on lateral axis of projectile will be zero. So the output of sensitive axis of magnetoresistive sensor on lateral axis is noise only. In this situation, calculation of projectile spinning angle is somewhat limited. Similarly, at certain moment in flight, if the projectile axis is paralleled or nearly paralleled to geomagnetic field vector, the projection of geomagnetic field intensity on longitudinal plane of carrier is zero, and calculation result of projectile spinning angle is unreliable. Therefore, in measurement of projectile spinning angle, possible blind spot of magnetic measurement will exist. And then the projectile spinning angle will be inaccurate. In order to solve the problem of blind spot of magnetic measurement, roll angle relative to velocity vector axis is calculated according to GPS output, which is used as a compensation to the inaccurate projectile spinning angle. Note that the roll angle relative to velocity vector axis is referred to as the projectile pseudoroll angle. Moreover, relevant mathematical model is established and the feasibility of the compensation is demonstrated.
3. Solution of Projectile Pseudoroll Angle
For the purposes of coordinates description, trajectory-fixed coordinate system o- and velocity coordinate system o- are defined. The trajectory-fixed coordinate origin, o, is located in the projectile’s center of mass. The -axis is coincided with velocity vector. The -axis is perpendicular to the -axis and is located in the vertical plane, while the -axis is determined by completing the right-hand rule. The velocity coordinate origin, o, is also located in the projectile’s center of mass, and the -axis is also coincided with velocity vector. The -axis is perpendicular to the -axis and is located in longitudinal symmetry plane of the projectile, while the -axis is determined by completing the right-hand rule. According to their definitions, the relation between ground coordinate system and trajectory-fixed coordinate system is derived by using two angles, while the relation between trajectory-fixed coordinate system and velocity coordinate system can be derived by using one angle. Mutual relations between the three coordinates can be seen clearly from Figure 1.
3.1. Calculation of Projectile Pseudoroll Angle
By using , , and to represent unit vectors along three axes of NED coordinate system, the velocity components and acceleration components of projectile in the NED coordinate system can be shown as
Acceleration can be estimated by the velocity from GPS output, and the calculation of longitudinal acceleration is taken as instance to make explanation. The longitudinal velocities at the moments and are denoted as and , respectively. So the longitudinal acceleration at moment can be calculated as follows:
Thus, the steps to calculate projectile pseudoroll angle are listed below.
① Resolve of Acceleration in Plane of Velocity Coordinate System. The acceleration vector a is resolved into tangential acceleration and normal acceleration along velocity vector v, while the angle between acceleration vector and velocity vector is marked as . The gravitational acceleration vector g is resolved into tangential component and normal component along velocity vector v, while the angle between gravitational acceleration vector and velocity vector is marked as . Obviously, both the normal acceleration and the normal gravitational acceleration are in longitudinal plane , which is vertical to the velocity. According to the principle of physical dynamic balance, we can see that is a total tangential acceleration including vector and another acceleration vector l, so vector . Calculations involved are listed as follows:
② Direction of Resultant Force in Plane of Velocity Coordinate System. It is known from exterior ballistics theory that, because of the existence of angle of attack, the direction of projectile velocity and the projectile axis are not coincident. Therefore, total aerodynamic force includes not only drag aligned with the opposite direction of the velocity but also lift which is vertical to velocity and located in plane of velocity coordinate system. According to Newton’s second law of motion, we can see that the direction of lift force is consistent with the direction of acceleration vector l. The lift force in plane can be decomposed into force and force along the -axis and the -axis, respectively, shown as Figure 2.
The angle between the lift and -axis can be calculated as
③ Construction of Horizontal Parameter. Horizontal parameter vector p can be constructed according to the relation between gravitational acceleration vector and velocity vector, represented as . It is located in horizontal reference plane, and its direction is aligned with the direction of -axis in trajectory-fixed coordinate system, which is shown in Figure 3 as red-dotted line.
④ Calculation of the Angle between Vector and Vertical Plane. The angle between acceleration vector l and the constructed horizontal parameter vector p can be solved with the following formula:
The coordinate of vector l in ground coordinate system is denoted as , and then
The angle between acceleration vector and vertical plane is calculated as follows:⑤ Calculation of Projectile Pseudoroll Angle. Using the relation among the three angles , , and which is shown in Figure 4, the projectile pseudoroll angle can be solved as follows:
3.2. Verifying Feasibility of Replacement
According to the exterior ballistics theory, the relation among ground, trajectory-fixed, velocity, and body coordinate systems is correlated by eight angles , and they are not independent completely . It is known that the cosine angle between two unit vectors, which both pass through the origin of the reference system, is equivalent to the sum of the product of the cosine angles between each unit vector and the three respective axes of the reference system. Body coordinate system is taken as the reference system, and one unit vector is along the direction of oz3-axis of velocity coordinate system, while the other unit vector is along the direction of oy-axis of ground coordinate system. Then, the geometrical relationship equation can be established as follows:where refers to angle of attack and refers to angle of side slip.
Based on the assumption of small angle of attack, it can be considered that and are small; therefore there are approximate relations shown as follows:
Using the projectile axis and velocity coordinate system, the following relations can be derived: Then (15) can be rewritten as
Generally, the range of trajectory inclination angle is (, /2). Therefore,
Take simultaneously the limit of both sides of (18), which are shown as follows:where is integer number.
From the definition of ground, trajectory-fixed, velocity, and body coordinate systems, it can be known that both projectile pseudoroll angle and projectile spinning angle are within the same range at the same moment, so multiple-valued situations are excluded. Therefore,
4. Simulation Verification
Towards the measurement of projectile spinning angle using GPS and magnetoresistive sensor and the calculated method of projectile pseudoroll angle, a numerical simulation is used to verify their effectiveness and feasibility. Trajectory simulation is developed based on a full six degree-of-freedom rigid-projectile model. This simulation has been performed to generate the trajectory parameters as a reference in the following flight conditions: muzzle velocity of the projectile , total mass , and caliber . World Magnetic Model (WMM) is issued every 5 years, and the latest one will expire by the end of 2019. Nanjing is located at 32.028-degree north latitude and 118.854-degree east longitude, with a height of 24.03 meters. According to WMM and geographic location of Nanjing, geomagnetic factors of Nanjing can be obtained by calculation; that is, , , and . The velocity output of GPS and the three-axial output of magnetoresistive sensor can be simulated according to theoretical trajectory parameters. Finally, projectile spinning angle is calculated according to the algorithm presented in this work and then compared with roll angle generated by exterior ballistics. The simulation results are shown in Figures 5–9.
Figure 5 compares the calculation result of projectile spinning angle with its theoretical value. The left one shows the comparison about projectile spinning angle curve in whole flying process, while in the right one, the comparison curve of whole process is enlarged locally to see the coincidence more clearly. It can be seen from Figure 5 that, without taking blind spot of magnetic measurement into consideration, projectile spinning angle can be calculated effectively by the method with the combination of GPS and magnetoresistive sensor. The curve of error between calculation result of projectile spinning angle and its theoretical value is shown in Figure 6. The magnitude of the error is used to describe the precision of projectile roll attitude calculated with GPS and magneticresistive sensor combination, and simulation results indicate that high precision can be obtained by this method.
The projectile pseudoroll angle is calculated according to the proposed method using GPS output and compared with its theoretical value. The error of comparison is shown in Figure 7; it can be seen from the error curve that the method proposed in this work is effective and feasible to solve the projectile pseudoroll angle.
Figure 8 compares the results of projectile roll attitude calculation. The full line depicts projectile spinning angle calculated with the combination method, while the dotted line reflects the calculation result of the projectile pseudoroll angle based on GPS measurement only. Besides, the error curves of the two methods are shown in Figure 9. It can be seen that both of the errors are within range of 0.5°, and the calculation error is smaller with the GPS measurement only. Therefore, if blind spot of magnetic measurement appears in flight, the result of projectile attitude determination based on the combination of GPS and magnetoresistive sensor would be inaccurate. And the method based on GPS measurement only can be adopted to calculate the projectile pseudoroll angle which can efficiently substitute the invalid projectile spinning angle solved by the method with GPS and magnetoresistive sensor combination.
At last, we talk about the effect on the accuracy of the model in the geomagnetic anomaly environment and the electromagnetic environment on battleship. Magnetic anomaly is a local variation in the Earth’s magnetic field resulting from variations in the magnetism of the rocks. From geomagnetic theory, in general, the interference of variations in the solar activity on the Earth’s magnetic field is only tens of nanotesla. When the intensity of geomagnetic anomaly is 100 nanotesla, the effect on the accuracy of the attitude measurement method is about 1.2 degrees. The simulation experiment regarding the electromagnetic environment on battleship has been carried out to test the working performance of the composite attitude measurement device. It shows that the composite attitude measurement device can work properly without the influence on measurement accuracy.
In this paper, a mathematical model is developed to integrate the magnetoresistive sensor and GPS measurements in order to get an accurate prediction of projectile spinning angle in a real flight time. It can be seen that the error between numerical simulation value and theoretical value of roll angle is within range of 1°, and it is a satisfactory precise solution that meets the requirement. In the event of blind spot of magnetic measurement, the three-axial output of magnetoresistive sensor will be invalid, and then the roll attitude calculation will have too large error and sequentially will affect the guidance and control precision. In this time, utilizing the aiding data given by the GPS, another new calculation model is built to solve the projectile pseudoroll angle, which enables the navigation system to go on until the magnetoresistive output can be reestablished. This new method can overcome the blind area drawback of magnetoresistive sensor effectively and improve precision in measurement of projectile roll attitude. In addition, the feasibility to replace projectile spinning angle with projectile pseudoroll angle is verified.
Conflicts of Interest
The authors declare that there are no conflicts of interest regarding the publication of this paper.
This work is supported by the National Natural Science Fund (no. 11472136).
J.-B. Lacambre, M. Narozny, and J.-M. Louge, “Limitations of the unscented Kalman filter for the attitude determination on an inertial navigation system,” in Proceedings of the 2013 IEEE Digital Signal Processing and Signal Processing Education Meeting, DSP/SPE 2013, pp. 187–192, USA, August 2013.View at: Publisher Site | Google Scholar
P. Henkel and C. Günther, “Attitude determination with low-cost GPS/INS,” in Proceedings of the 26th International Technical Meeting of the Satellite Division of the Institute of Navigation, pp. 2015–2023, Nashville, TN, USA, September 2013.View at: Google Scholar
S. Changey, D. Beauvois, and V. Fleck, “A Mixed Extended-Unscented Filter for attitude estimation with magnetometer sensor,” in Proceedings of the American Control Conference, pp. 2892–2897, June 2006.View at: Google Scholar
R. P. Kornfeld, H. R. John, and J. J. Deyst, “Single-antenna GPS-based aircraft attitude determination,” Navigation, vol. 45, no. 1, pp. 51–60, 1998.View at: Google Scholar
I. Y. Bar-Itzhack, P. Y. Montgomery, and J. C. Garrick, “Algorithms for attitude determination using GPS,” in Proceedings of the Guidance, Navigation, and Control Conference, 1997, pp. 841–851, August 1997.View at: Google Scholar
G. Schmidt, “INS/GPS Integration Architectures,” RTO Lecture Series RTO-EN-SET-116, 2010.View at: Google Scholar
O. S. Salychev, V. V. Voronov, and M. E. Cannon, “Attitude determination with GPS-aided inertial navigation systems,” in Proceedings of the Iain World Congress & Annual Meeting of the Institute of Navigation, vol. 18, pp. 1–17, 2000.View at: Google Scholar
S. Changey, E. Pecheur, and T. Brunner, “Attitude Estimation of a projectile using Magnetometers and Accelerometers: Experimental Validation,” in Proceedings of the 2014 IEEE/ION Position, Location and Navigation Symposium, PLANS 2014, pp. 1168–1173, USA, May 2014.View at: Publisher Site | Google Scholar
D. Gebre-Egziabher, G. H. Klkaim, J. Powell, and B. W. Parkinson, “A Gyro-free quaternion-based attitude determination system suitable for implementation using low cost sensors,” in Proceedings of the IEEE Position, Location, and Navigation Symposium, pp. 185–192, March 2000.View at: Google Scholar
P. Cao, J. Y. Yu, and X. M. Wang, “High-frequency Measurement and Calculation study of Systematic Error of High-rolling Projectile Roll Angle Based on Combination of MR/GNSS,” Journal of China Ordnance, vol. 35, no. 6, pp. 795–800, 2014.View at: Google Scholar
X. F. Qian, R. X. Lin, and Y. N. Zhao, Flight Mechanics of Guided Missile, Beijing Institute of Technology Press, Beijing, China.