1. Introduction
As an important air-to-ground detection platform, the parachute scanning platform has been widely applied to many fields, including air-to-ground weapons and aerial detection. Its movement has the characteristics of high speed and complex attitude. The movement state of the platform has an important impact on its detection quality and efficiency during the fall of the platform. Many studies assume a pendulum motion rather than a scanning motion [
1,
2]. However, a pendulum motion will make the parachute platform detect the same area repeatedly, which is not necessary in some situations. In order to expand the detection area of the parachute platform and avoid repeated detection, it is better to make the parachute platform spiral scanning downward. Therefore, research on the measurement methods of the motion parameters of a parachute scanning platform is of great significance for improving its detection performance. This paper uses a terminal sensitive projectile that is a typical air-to-ground scanning weapon as a research object.
With the continuous development of modern armor defense technology, many types of defensive materials and technologies with excellent performance have been applied to tanks, which has greatly improved their defense capabilities [
3]. In response to the high defensive performance of tanks, anti-tank weapons have also been developed rapidly. Long-distance, high-precision, low-cost, high-efficiency, and cost-effective terminal-sensitive projectiles are favored by many countries. The United States, Germany, France, Sweden, and Russia have all conducted research on terminal-sensitive projectiles, and in this field, they are in a leading position [
4,
5].
A terminal-sensitive projectile is a type of smart and flexible ammunition that can identify and strike the target automatically after being thrown and has high efficiency [
6]. Generally, a terminal-sensitive projectile is carried to a designated area by a carrier, such as a missile, a rocket, a projectile, or a spreader, and a number of terminal-sensitive projectiles are thrown according to a planned pattern. After a terminal-sensitive projectile is thrown, it will go through three phases, namely, the free-fall phase, the deceleration and reducing rotation phase, and the steady-state scanning phase. During the steady-state scanning phase, the terminal-sensitive projectile scans the designated area, and the projectile quickly strikes the armored vehicle once it is detected [
7]. The motion parameters and their changing laws in the steady-state scanning stage directly influence the hit probability and the damage probability of a terminal-sensitive projectile [
8]. Therefore, it is of great significance to research the changing law of motion parameters of a parachute scanning platform. The main research objective regarding the terminal-sensitive projectile scanning platform’s motion is to achieve real-time measurement of the motion parameters, such as the steady-state scanning angle, the scanning angular velocity, the falling velocity, and the 2D scanning attitude [
9].
Much research has been conducted on methods for the accurate determination of motion parameters of a terminal-sensitive projectile. Under the assumption that the surrounding geomagnetic field is constant, Zhou et al. [
10] proposed a method for attitude measurement of a terminal-sensitive projectile based on magnetic sensor data. However, in practice, the surrounding geomagnetic field can be easily changed by external disturbances. Therefore, the attitude measurement method based only on the geomagnetic field cannot guarantee high accuracy. Ma [
11] from North University of China analyzed the measurement method of stable scanning parameters of a terminal-sensitive projectile based on miniature inertial measurement units (MIMUs). The analysis results showed that the accuracy of the formula approximation method was better than that of the integral solution algorithm. However, the inertial navigation measurement requires information on the initial attitude angle, and initial errors can easily appear. In addition, the errors in the solution process accumulate with the integral, so they increase with time. Cai [
12] proposed a method based on 12 accelerometers and a magnetic sensor for the attitude measurement of rotating projectiles. However, since the attitude angles were obtained by the accelerometers and magnetic sensor, high solution accuracy was difficult to achieve. Li et al. [
13] used contrastive simulation to validate the quaternion transformation model and its advantages in describing the revolving motion of the terminal sensing ammunition. The simulated results showed that the ballistic model amended by the quaternion method is more suitable for describing the terminal sensing ammunition’ s scanning motion with a large or uncertain angle than the Euler equation.
The traditional attitude measurement methods often use a single sensor to measure the target information but cannot adapt to various complex environments and can be easily interfered with [
14,
15]. The multi-sensor data fusion strategy can solve the problem of the low accuracy of a single-sensor measurement in extreme environments [
16,
17]. At the same time, the reliability, adaptability, and resolution of a multi-sensor measurement system are better than those of a single-sensor measurement system when the performance of the multi-sensor device is at the same level as that of the single sensor device [
18,
19]. Aiming at addressing the mentioned problems, this paper proposes a method of motion parameter measuring a parachute scanning platform by using three-axis magnetic sensors, a three-axis gyroscope, and a three-axis accelerometer. The proposed method can solve the problems of easy interference of the geomagnetic information and cumulative error of the inertial measurement. The proposed method has the advantages of wide adaptability, high measurement precision, and anti-magnetic interference.
The proposed attitude measurement method is evaluated by taking a terminal-sensitive projectile as an example. First, the scanning motion characteristics of a parachute terminal-sensitive projectile are analyzed. Next, the combination of magnetic sensors and inertial sensors is used to measure the motion parameters of the terminal-sensitive projectile. Then the extended Kalman filter (EKF) is used to observe and filter the measurement error, and the scanning angle, scanning angular velocity, falling velocity, and 2D scanning attitude are obtained. Finally, the semi-physical turntable simulation experiment and the airdrop experiment are carried out, and the experimental results verify the feasibility and accuracy of the proposed attitude measurement method. In order to obtain more accurate geomagnetic and inertial sensor data, a symmetrical parachute scanning platform attitude measuring device that can effectively reduce the measurement error is designed. The contribution of this work is twofold: A reliable attitude measurement method of parachute scanning platforms is proposed, and the presented results can provide helpful references for the design and analysis of parachute scanning platforms. Moreover, accurate scanning parameters of the test samples can help to improve the design efficiency and reduce the numbers of parameter adjustment tests, test samples, and labor and time costs, thereby saving both time and costs.
The rest of this paper is organized as follows. In
Section 2, the principle of attitude measurement is explained. The design process of the attitude measurement algorithm and the data fusion based on the EKF are introduced in
Section 3. In
Section 4, the simulation on the geomagnetic field and the semi-physical turntable simulation are presented to verify the feasibility of the proposed method and the accuracy of the solution results. The algorithm is further verified by the airdrop experiment in
Section 5. Finally, in
Section 6, the main conclusions are drawn and future research directions are given.
3. Motion Parameter-Solving Algorithm
The motion parameters of a terminal-sensitive projectile in the steady-state scanning phase are measured by the three-axis gyroscope, three-axis accelerometer, and three-axis magnetic sensor. A flow diagram of the motion parameter-solving algorithm is shown in
Figure 3. As shown in
Figure 3, first the bomb-mounted computer obtains the output data of the three-axis gyroscope, three-axis accelerometer, and three-axis magnetic sensor. Next, the quaternions and EKF are used for attitude and data fusion. Then the attitude and velocity are obtained. Finally, the accurate scanning motion parameters, such as the scanning angle and scanning angular, are obtained by (1). In
Figure 3,
,
and
denote the gyroscope output data in the
,
and
z directions, respectively;
,
and
denote the accelerometer output data in the
,
and
directions, respectively; and
,
and
denote the output data of the magnetic sensor in the
,
and
directions, respectively.
3.1. Attitude Measuring by Inertial Navigation Device
3.1.1. Initial Alignment
The initial attitude alignment is required before the attitude measuring. Since an unmanned aerial vehicle (UAV) is in a stable state of hovering before the projectile is thrown, it is a good practice to use the data within 20 ms before the device is thrown for initial alignment. The initial alignment formulas of roll angle
and pitch angle
can be respectively expressed as
where
denotes the initial roll angle,
represents the initial pitch angle, and
,
and
are the average values of the output data of the three-axis accelerometer within the first 20 ms (stationary state) in the
,
, and
directions, respectively.
When the roll angle and the pitch angle are known, the initial magnetic heading angle
can be obtained as follows:
where
denotes the local magnetic declination and
,
and
denote the average values of the output data of the three-axis magnetic sensor within 20 ms in the three directions before the device is thrown, respectively.
3.1.2. Attitude Calculation
(i) The initial attitude angle, which is also called the Euler angle, is the basis of the initial attitude matrix. The direction cosine matrix
from the carrier system
b to the navigation coordinate system
n can be expressed as
(ii) After the initial direction cosine matrix
is obtained by Equation (6), the initial quaternion can be obtained by:
(iii) The quaternion is solved by the time-sampled incremental method of the Pica solution. The quaternion is updated by
where
denotes a 4 × 4 unit matrix;
;
(iv) After the quaternion is updated by Equation (9), the Euler angle can be obtained by
Following the above steps, the initial attitude alignment, attitude matrix update, quaternion update, and attitude update are performed. In this way, the attitude data of the entire steady-state scanning phase can be obtained [
21,
22].
3.1.3. Position and Falling Velocity Calculation
The initial values of velocity, position, and acceleration are assumed to be set as follows:
,
, and
, respectively. After the output data of the accelerometer are filtered by the EKF, the velocity and position of the terminal-sensitive projectile are respectively obtained by
where
represents the velocity at time (
k + 1),
Pk+1 is the position at time (
k + 1),
s is the sampling period, and
is the acceleration at time (
k + 1).
3.2. Attitude Measurement Based on Geomagnetic Field
3.2.1. Attitude Measurement Model Based on Geomagnetic Field
The terminal-sensitive projectile is usually dropped by a dispenser about 300 m above the ground, and after launching, it goes through the free-fall phase, deceleration and reducing rotation phase, and steady-state scanning phase. During the steady-state scanning phase, the terminal-sensitive projectile scans the designated area and quickly strikes the armored vehicle once the target has been detected. During the falling phase of the terminal-sensitive projectile, its spatial displacement is small, and the geomagnetic field hardly changes. Therefore, it can be considered that the geomagnetic field is constant during the falling phase of the terminal-sensitive projectile.
In order to facilitate model development, the falling velocity of the terminal-sensitive projectile is ignored. A simplified steady-state scanning model of the terminal-sensitive projectile is built according to the rotation cycle of the scanning motion of a terminal-sensitive projectile. The scanning motion diagram is presented in
Figure 4.
The geomagnetic model of the terminal-sensitive projectile motion is built using the navigation coordinate system
, as shown in
Figure 4. In
Figure 4,
denotes the magnetic slant angle,
represents the geomagnetic field strength, and
denotes the phase angle.
The total strength of the geomagnetic field
B represents the vector sum of the magnetic field strengths in the three directions. Under the premise of neglecting the change in the geomagnetic field, the total strength of the geomagnetic field
and the magnetic slant angle
can be considered constants. In the navigation coordinate system, the strength of the geomagnetic field in the three directions can be obtained by
The geomagnetic field strength in the three directions of the projectile coordinate system can be obtained by
where the geomagnetic field strength is
B = 0.6 gauss, the data sampling period is
= 0.001 s, the scanning angle velocity is
rev/s, the initial phase angle is
, the scanning angle is
, the magnetic slant angle is
,
t denotes time, and
,
and
are the geomagnetic field strengths of the projectile coordinate system in the
,
and
directions, respectively.
3.2.2. Attitude Calculation
The scanning angular velocity
and the scanning angle
can be respectively obtained by
where the range of the scan angle
is [0, π/2].
3.3. Combined Filter
The data measured by the sensor contains certain noise. Filtering the measured data using a suitable filter helps to improve the accuracy of the attitude result. The EKF has the characteristics of the simple algorithm and calculation and is suitable for the Gaussian environment of a terminal-sensitive projectile.
In this paper, the specific filtering process of the combined filter is as follows. First, the position, velocity, attitude errors and output errors of the inertial device are used as state variables of the EKF. Next, a 15-dimensional filter model is established according to the motion characteristics of the terminal-sensitive projectile in the steady-state scanning phase. Then the position and attitude measurement errors are used as observation variables of the system. Finally, more accurate scanning parameters are obtained.
3.3.1. State Variable Selection and State Equation Establishment
In this paper, the following errors are used as state variables of the EKF, which can be expressed as
where
,
and
denote the position errors in the
x,
y and
z directions, respectively;
,
and
denote the velocity errors in the
x,
y and
z directions, respectively;
,
and
represent the roll angle error, pitch angle error, and heading angle error, respectively;
,
and
are the accelerometer zero-offset errors in the
x,
y and
z directions, respectively; and lastly,
,
, and
are the gyroscope zero-offset errors in the
x,
y and
z directions, respectively.
The discrete-time state equation of the system based on the state variables can be expressed as
where
denotes the askew symmetric matrix
;
is the position error at time (
k + 1);
is the velocity error at time (
k + 1);
is the attitude error at time (
k + 1);
is the accelerometer zero-offset error at time (
k + 1);
is the gyro zero-offset error at time (
k + 1);
and
are the scaling factors of the accelerometer zero-offset error and the gyroscope zero-offset error, respectively, and according to the analysis of experimental data, they are very small;
and
are random system dynamic noises of accelerometer and gyroscope errors at time
k, respectively; and the mean and variance of the noise satisfy the zero-mean white noise sequence of
.
3.3.2. Observation Variable Selection and Observation Equation Establishment
The position error and attitude measurement error are used as observation variables of the system. The attitude measurement error is obtained from the geomagnetic information and inertial information. The set of the observation equations can be expressed as follows:
where
denote the position information obtained by the ideal motion state and coordinate values of the landing point;
denote the position information of the terminal-sensitive projectile obtained from the inertial device data;
are the roll, pitch, and yaw angles obtained by the geomagnetic information, respectively; and lastly,
are the roll, pitch, and yaw angles obtained by the inertial device data, respectively.
The observation equation of the EKF can be expressed as
where
denoted the observed variable,
is the noise, and the covariance matrix of the noise is expressed as
.
3.3.3. Filtering Algorithm
The EKF is suitable for geomagnetic and inertial sensor integrated measurement. The state and observation equations of the system are given in Equations (17) and (18), respectively. The main process of the EKF is as follows.
Step 1: The initial state: attitude error, position error, and velocity error:
Step 2: State prediction:
Step 3: Observation prediction:
Step 4: Covariance matrix prediction
Step 5: Calculation of the Kalman gain
Step 6: State variable update
Step 7: Covariance update
In Equations (20)–(26), and denote the Jacobian matrices derived from the decrease in and in the direction, respectively, denotes the state variance after the state is updated, and stands for the three-order identity matrix.
The above seven steps constitute a calculation cycle of the EKF [
23,
24,
25,
26]. When the initial value and the output data of sensors are known, the motion data can be obtained by Equations (20)–(26).
5. Airdrop Experiment
In order to simulate the motion environment of the terminal-sensitive projectile more realistically, an unmanned aerial vehicle (UAV) was used in the airdrop experiment. The parachute scanning platform with the installed attitude measuring device was transported to the specified altitude by the UAV for the purpose of airdropping. After the experiment, the data recorded by the attitude measuring device were collected, and the proposed algorithm was used to process the collected data. The result was compared with the designed parameters. At the same time, the scanning angle, scanning angular velocity, and falling velocity of the parachute scanning platform were verified by video analysis.
5.1. Airdrop Experiment Procedure
The experiment used the UAV to throw the parachute scanning platform carrying the attitude measuring device from a height of 300 m. In addition, the designed parachute scanning platform had a scanning angular velocity of 4 rev/s and a scanning angle of 30°.
The schematic diagram of the experimental process is shown in
Figure 11.
The airdrop test steps were as follows:
Power on the parachute scanning platform, turn on the system, and operate the UAV to carry the parachute scanning platform to a height of 300 m.
The UAV releases the parachute scanning platform once it is stabilized; the parachute scanning platform is put into the free-fall motion and it opens the rotating umbrella.
After the rotating umbrella is fully opened, the umbrella begins to rotate and drives the parachute scanning platform to rotate; during this period, there are accelerating and decelerating processes until the platform reaches a stable rotating scanning state.
The parachute scanning platform enters the steady-state scanning state and stays in that state until it hits the ground and waits for recycling.
5.2. Experimental Parameters
The attitude measuring device started to record the data of each sensor when it got power and stopped recording the data when the UAV landed and the device lost power. The parachute scanning platform attitude measurement device used in the experiment is shown in
Figure 12.
The measurement device consisted of the main board and four attachment plates, as shown in
Figure 13. The main board included two Advanced RISC Machine (ARM) microprocessors, a field programmable gate array (FPGA) microprocessor responsible for logic control, a micro-electromechanical system (MEMS) accelerometer, a yaw rate gyroscope with vibration suppression, a two-axis magnetic sensor, four eight-channel analog-to-digital converters, a flash memory chip, four serial transceiver controllers, related signal processing circuits, and power supply circuits. In addition, the three-axis accelerometer used an American ADI Inc. ADXL377 sensor with a measurement range of ±200 g and shock survivability of 10,000 g. The gyroscope used an American ADI Inc. ADXRS649 sensor with a measurement range of ±20,000°/sec and shock survivability of 10,000 g. The magnetic sensor was an HMC1052L sensor with a measurement range of ±6 gauss and a resolution of 120 microgauss. Four attachment plates were vertically distributed around the main board. Each attachment plate had a two-axis magnetic sensor and a yaw rate gyroscope, where the magnetic sensor was an HMC1052L sensor. The gyroscope used an American ADI Inc. ADXRS646 sensor with a measurement range of ±300°/sec and a shock survivability of 10,000 g. The multi-magnetic sensor could amplify the signal and eliminate the errors. The gyroscopes placed symmetrically could eliminate the errors caused by forward and reverse rotations of the device. The FPGA was responsible for logic control and was equipped with a 16-bit high-precision synchronous analog to digital (AD) converter for achieving high-speed, real-time, and high-quality data acquisition. The 32-bit ARM with Cortex-M7 was responsible for data processing, enabling complex sensor compensation. The data processing module was responsible for human–computer interaction and scheduling relevant calculation results, self-test results, command response, and other operations. The data processing module and the FPGA were connected via the Flexible Memory Controller (FMC) bus to achieve efficient data acquisition. In addition, the device used the advanced Single-Level Cell (SLC) flash particles and HdntRec core independently developed to achieve differential dual-mode data recording.
The signals of the geomagnetic data acquisition module, gyroscope data acquisition module, and acceleration data acquisition module were transmitted to the AD converter after being amplified by the high-speed amplifier. After the AD conversion, the data were transmitted to the data processing module for arithmetic processing. Finally, the processed data were saved to the data storage module. The saved data could be read from the host computer through the communication module, and the motion posture information of the device was obtained after the analysis and inversion.
The results showed that the proposed device could reduce the error of traditional attitude measurement devices such as a gyroscope and a magnetic sensor. At the same time, it could realize high-speed processing and storage of the collected data. The proposed device has the advantages of simple structure, fast startup speed, strong stability, high measurement accuracy, fast processing speed, and the ability to store and read data. Therefore, it is suitable for the flight attitude measurement and analysis of a parachute scanning platform in practice.
5.3. Experimental Results
After the airdrop experiment, the data stored in the attitude measurement equipment were read and the output data of each sensor were plotted. The output data of the three-axis accelerometer, three-axis gyroscope, and three-axis magnetic sensor collected by the device in the UAV airdrop experiment are shown in
Figure 14,
Figure 15 and
Figure 16, respectively.
According to the above-presented experimental process and the sensor output data graph, a rough analysis of the data was conducted and the main observations were as follows:
From zero to 2 s, the parachute scanning platform was in a state of free fall and umbrella opening.
From 2 s to 3.5 s, the parachute scanning platform completed the umbrella opening process and started to rotate.
From 3.5 s to 4.5 s, the parachute scanning platform was decelerating and spinning.
At 4.5 s, the steady-state scanning state was basically reached.
From 4.5 s to 18 s, the parachute scanning platform was in a steady-state scanning state with slight fluctuations during the period.
At approximately 18 s, the parachute scanning platform touched the ground.
During the fall of the terminal-sensitive projectile, its movement state was affected by external factors such as wind speed. Thus, the obtained data fluctuated to a certain extent, for instance, for the data at approximately 13 s. The results in
Figure 17,
Figure 18,
Figure 19 and
Figure 20 match the movement law of the terminal-sensitive projectile well.
After obtaining the data of each sensor, the scanning angle, scanning angle velocity, falling velocity, and 2D scanning attitude were obtained by the proposed algorithm, and the obtained results are presented in
Figure 17,
Figure 18,
Figure 19 and
Figure 20.
According to the experimental results, in the steady-state scanning phase the scanning angle was approximately 30°, the scanning angular velocity was approximately 4 rev/s, the falling velocity was stabilized at approximately 12 m/s, and the 2D scanning attitude conformed to the movement law of the rotation and scanning of the terminal-sensitive projectile. The results of this experiment coincided well with the scanning motion law of the terminal-sensitive projectile and were basically consistent with the set parameters. Consequently, it can be concluded that the proposed method can be used for attitude measurement of parachute scanning platforms and can achieve high measurement accuracy.
5.4. Experimental Results Discussion
5.4.1. Variance Analysis
The variance refers to a statistical measurement of the spread between numbers in a data set. More specifically, variance measures how far each number in the set is from the mean and thus from every other number in the set. Variance is often depicted by this symbol:
σ2. It is used to determine volatility. The square root of the variance is the standard deviation (
σ), which helps to determine the consistency of error over a period of time. The attitude angle variance curve and the velocity variance curve of the parachute scanning platform are shown in
Figure 21.
According to the presented variance curves, the velocity variance was less than 0.03 m/s and the attitude angle variance was less than 0.03°. In addition, the velocity variance curves and the attitude angle variance curves tended to converge. Therefore it can be concluded that with the passage of time, the velocity error and attitude angle error tend to be stable.
5.4.2. Video Data Analysis
During the experiment, a high-definition camera was used to record the motion of the parachute scanning platform. After the experiment, the video data were processed and analyzed to obtain the average scanning angle [
27], scanning angular velocity, and falling velocity [
28] in the stable phase. The video data analysis results and algorithm results in the period of 14 s to 17 s are given in
Table 1.
According to the data presented in
Table 1, the following conclusions were drawn. The error between the average scanning angular velocity obtained by the video analysis and the average scanning angular velocity obtained by the algorithm was 0.01rev/s. Similarly, the error of scanning angle was 0.292°, and the error of falling velocity was 0.868m/s. Within the allowable error range, the scanning angle, scanning angular velocity, and falling velocity obtained by the video analysis were equal to the corresponding parameters obtained by the algorithm. The proposed attitude measurement method based on the combination of a magnetic sensor and an inertial sensor could measure the attitude of the terminal-sensitive projectile accurately, and the measurement results had a high reference value.
In terms of terminal-sensitive projectile attitude measurement, the traditional measurement method has the following shortcoming: The calculation accuracy is not high, a group of experiments can obtain only a single or a small number of scanning parameters, and measurement results are easily affected by external interference. In contrast, the proposed attitude measurement scheme can accurately measure multiple scanning motion parameters from a group of experiments, including the scanning angle, scanning angular velocity, falling velocity, and 2D scanning attitude. Simultaneously, the optimal combination and layout of multiple sensors can improve the reliability, anti-interference ability, and measurement accuracy of the device.
6. Conclusions
This paper proposes a combined measurement method based on inertial and geomagnetic sensors, which can accurately and simultaneously measure multiple motion parameters of a parachute scanning platform, including the scanning angle, scanning angular velocity, and falling speed, thus significantly improving the measurement efficiency. Moreover, the proposed method adopts a combined measurement method, and the system stability and anti-interference ability are improved. The proposed method was verified by experiments, and according to the experimental results, the proposed combined measurement method can overcome the shortcoming that the traditional measurement method of a parachute scanning platform can obtain only one signal measurement parameter at a time. In addition, the measurement results obtained by the proposed method have high accuracy, which can meet the measurement requirements of the parachute scanning platform. The research results presented in this paper can provide a useful reference for the design of parachute scanning platforms, thus decreasing the development costs and shortening the development time.
The range of the projectile in this study was within 300 m, so some improvements should be developed in higher-range cases. In the future work, it is possible to consider introducing more sensor information and adopting a reasonable filter to obtain a higher-precision projectile attitude.