Abstract
At present, existing wide range Micro-Electro-Mechanical-Systems (MEMS) inertial sensors have relatively lower precision and direct measurement of the missile’s high-rotation motion inevitably uses a large-range sensor. To achieve high-precision navigation, this paper proposes a novel Semi-strap-down Stabilized Platform (SSP) based on the Missile-borne Semi-Strap-down Inertial Navigation System, which is used to mount sensors and lowers sensor range requirements through isolating the high-rotational motion of missile. First, the author innovatively puts forward a dynamic model under missile-borne environment, then analyses the influence of SSP quality on the range of gyro according to the dynamic model of the SSP. Finally, when the angle of attack of the missile is 2°, the best quality of the SSP with minimum roll angular rate amplitude was calculated through the Runge-Kutta method and the mass gradient control method. Experiments have been carried out by using a high-precision, tri-axial flight simulation turntable to validate the viability of the method. Experiments show that under the same conditions, the angular velocity of the new optimized SSP with the best quality design is reduced to 1/3 of the unoptimized SSP, and the measured roll angle error is reduced to 60% of the unoptimized measurement. The results indicate that the novel SSP has better performance segregating the high-speed rotational motion, and provides theoretical guidance for the high-precision small-range sensor instead of the low-precision wide-range sensor. In addition, the first proposed SSP quality selection method creates a new idea for the improvement of the positioning accuracy in the missile-borne environment.
1. Introduction
The high-speed-rotation and high-overload missile, as a kind of common missile, plays an essential role in modern military warfare [1,2]. Furthermore, the high-precision measurement of high-speed rotation missile attitude information is the key technology of guidance and precision strike, which is the main development trend of conventional high-speed rotation missile guidance [3,4]. Therefore, the implementation of accurate navigation and positioning for high-rotation and high-overload missiles is a key technology that needs an urgent breakthrough [5,6]. The data shows that the initial velocity of the missile launch is about 550 m/s, and its overload is up to 10,000 g, which makes most types of sensors not work properly. As a common device in inertial navigation, Micro-Electro-Mechanical-System (MEMS) sensors are widely used in navigation guidance because of their small size, low cost, and strong anti-overload capability [7]. Therefore, we choose Miniature Inertial Measurement Unit (MIMU) sensors to measure velocity, position, and attitude information. However, the common Strap-down Inertial Navigation System (SINS) is not suitable for high-dynamic, high-spinning, and high-overload missiles, due to the fact that the accelerometer and the gyroscope have poor anti-overload capability without protection, and the range of sensors used in the SINS is too large, resulting in a decrease in accuracy [8]. In this case, different from traditional measurement methods, the concept of Semi-Strapdown Inertial Navigation System (SSINS) is proposed by Key Laboratory of Instrumentation Science & Dynamic Measurement [9,10]. A mechanical structure, the Semi-strap-down Stabilized Platform (SSP) is a key part of SSINS, its main function is to reduce the range of sensors required and resist overload [11]. Therefore, we should further analyze its principle and design its structure, in order to achieve the optimal choice of sensor range, and improve the accuracy of navigation solution.
In recent years, the measurement of missile attitude has attracted amount of attention. Raúl de Celis et al. proposed an approach for guidance of high rate spinning ballistic rockets, which is based on an innovative hybridization between GNSS/accelerometer and semi-active laser quadrant photo-detector [12]. In [12], the fusion scheme is studied, and it can precisely measure the attitude of the high-rotation missile, however GNSS cannot be completely independent and is not suitable for high overload environments. In Li’s paper, a method based on photoelectric theodolite to measure the roll angle of ammunition is proposed [13]. This method can precisely measure the roll angle of ammunition, applicable to measure the roll angle of low-dynamic missile. In Beijing Institute of Technology, two Micro-Electro-Mechanical System (MEMS) accelerometers are used to measure the roll angle of high-speed missile. This system puts the MEMS sensor inside the high-rotation missile [14,15]. Firstly, the system measurement equations and statistical model equations are established. Then, the improved adaptive Unscented Kalman Filter (UKF) nonlinear filtering algorithm is used to improve the accuracy of the calculation. Compared with other methods, this method emphasizes the study of the algorithm more [16].
The above methods provide many means for realizing the measurement of the roll angle of high-rotation missiles, but these methods have inevitably used large-range sensors. In the case of the existing sensor processing technology, there is a problem that the wide range sensor is not possible to meet the low-cost and high-precision requirements at the same time. To solve these problems, it is not sufficient to improve the accuracy of the solution by simply improving the algorithm. Therefore, a new flight attitude measurement system, SSINS, was used to solve these problems. Moreover, in SSINS, the key part to the range selection of the sensor that measures the roll angle is the SSP, and the rationality of its design is directly related to the accuracy of the navigation solution, because the SSP can equivalently reduce the range of the required sensor [17,18]. This structure is mounted inside the missile and used to mount MEMS inertial sensors. In contrast to SINS, the SSINS Inertial Measurement Unit (IMU) for signal acquisition is mounted on a SSP, and the SSP is not rigidly attached to the missile, but is connected to the missile via bearings, which provides a stable low-dynamic environment for the IMU and eliminates the interference of the high-speed rotation on the device’s accuracy. Therefore, the gyros with small range can be used to measure the missile’s attitude information in a relatively stable environment. In reference [17], Zhang et al. presented a measurement method for the realization of high-rotation missiles, which is a new compensation method that is proposed to remove or reduce sensor errors, so as to make it possible to maintain high precision autonomous navigation performance by MIMU when there is no external aiding. Among them, the motor is used to implement the rotation modulation method. Due to the fact that the servo motor cannot withstand a large impact, it is easily damaged or even destroyed under high overload conditions. Considering the above situation, this system may has poor stability in achieving attitude measurement in high overload environments.
In reference [18], in our lab, Duan et al. obtained the Semi-strap-down Stabilized Platform (SSP), using gravity to control the roll angular rate of the SSP. This paper analyzed and validated the dynamic model of the SSP on the ground, and proved the effectiveness of the model in the ground-based experiment. However, he did not analyze the impact of the missile’s lift force on the SSP. During the flight of a missile, due to the change of lift force, the SSP has three different states: Overweight, weightless, and normal state. The three different states have a non-negligible impact on the stability of the SSP. Therefore, in order to achieve accurate measurement of missile navigation parameters, it is necessary to consider the indirect effects of lift force on the SSP.
In the past, in order to improve the stability of the SSP, our laboratory applied many methods to reduce the friction torque of bearing. For example, in reference [19], the SSP optimization design with a dual bearing nested structure was proposed in our lab.
Above all, in order to better replace wide-range sensors with small-range sensors, we have conducted further research. This paper describes the design and implementation of the new SSP based on the Missile-borne Semi-Strap-down Inertial Navigation System in the high-speed rotation missile-borne environment using three steps, which are described as follows. In the first step, according to the dynamic model of the stabilized platform in the ground-based experiment, the lift force of a missile is calculated when flying at 2° angle of attack, and the dynamic model of the SSP is given in the high-speed rotation missile-borne environment. The second step combines the characteristics of the space reserved inside the missile and gives the optimal design of the SSP. The last step achieves the best quality of the SSP, which can minimize the roll angular rate and roll angle of the SSP by controlling the quality of the platform. Using the Runge-Kutta method and mass gradient control method to calculate and plot the time-varying curve of the roll angle and angular rate of the SSP under different conditions, the best quality of the platform is obtained. In order to verify the above conclusions, we installed the prototype of the SSP on the flight simulation turntable and did an experiment, and the experiment results were in accordance with the theoretical results.
The remainder of this paper is organized as follows. Section 2 illustrates the working principle of the Semi-strap-down Inertial Navigation System (SSINS) and the relationship between the quality selection method of the SSP and the range of the Inertial Measurement Unit. The stability principle of the SSP is introduced and the dynamic model of the SSP in the high-speed rotation missile-borne environment is obtained. Then the SSP optimal quality selection method is proposed in Section 3. Section 4 is the implementation of the SSP, as well as test verification. The conclusion is given in Section 5.
3. Design Principle and Optimal Quality Selection Method of SSP
3.1. The Introduction of SSP
3.1.1. The Principle Behind the SSP
The high-speed rotation missile is a conventional missile which relies on its own rotating motion to eliminate machining errors and achieve flight stability [20], and there is a high-speed rotational motion around its own roll axis. In order to complete the high-precision navigation and positioning requirements of the missile, the accurate measurement of the roll angle cannot be completed by relying on the large-range sensor, under the condition that the existing sensor fabrication process is unchanged [21,22].
The SSP is a mechanical structure using for mounting sensors and creating a good working environment for MEMS inertial sensors. Its main role is to isolate the high-speed rotational motion of the missile, through the SSP to reduce the range requirements of MEMS inertial sensors, then the wide-range sensor is replaced by a small-range sensor, so it can achieve high-precision navigation and positioning. The direction of the roll axis of the SSP is connected with the missile through bearings, so the bearing friction torque and the gravity torque are the key factors of the SSP. The equivalent gravity model of the SSP is shown in Figure 3.
Figure 4 describes the compound pendulum motion of the SSP around its own roll axis in the case of ground tests [23,24], and it is also equivalent to the compound pendulum motion of the platform’s center of gravity around the supporting axis point in the cross-section of the platform. indicates the bearing friction torque that acts on the supporting axis point, represents the angle between the position of the mass point and the vertical axis, which changes with time, and denotes an arm of force whose size is equal to the distance from the mass point to the support point. State 0 represents the equilibrium position between the bearing frictional force and the equivalent gravity moment, at this point the angular rate reaches a maximum. State 1 and State 2 indicate that the roll angular rate is zero and at this point the amplitude of the swing is greatest. The center of gravity of the stabilized platform is a pendulum movement around state 0. When the bearing friction torque is a constant value, is larger, is smaller, and the lower the torque balance position, the smaller the swing amplitude of the SSP [25].
Figure 4.
Dynamics diagram of the Semi-strap-down Stabilized Platform (SSP).
Vibrations will occur when the missile flies in the air [26,27]. In order to make the SSP undisturbed, it is necessary to increase the stability of the SSP by lowering the equivalent gravity center position of the SSP.
3.1.2. Composition and Shape Design of SSP
Figure 4 shows the composition of the newly designed SSP, where part 1 represents the bearing. The front cover, the anti-overload rear cover, the upper rectangular cover, the lower arch cover, and the counterweight are represented by parts 2.1 to 2.5. Part 2.1 is fixed with the relative rotation angle measurement section, it plays a role in supporting the platform. Part 2.2 acts as an overload protection device. Parts 2.5 and 2.4 are fixed together inside, playing the role of lowering the center of gravity. The main part of the SSP is composed of parts 2.1–2.5.
As shown in Figure 5, the convex part of the front cover (2.1) and the back cover (2.2) are connected with the bearing inner ring though an interference fit. The bearing outer ring is fixed with the missile. When the missile rotates at a high speed, the bearing outer ring rotating with the missile at the same speed. Under the drive of the bearing friction torque, the rotation of the inner ring of the bearing causes the SSP to oscillate. At this time, the gravity torque will prevent the SSP from swinging. In order to make the SSP less prone to swinging, we need to reduce the center of gravity of the SSP. According to the spatial characteristics of the cylinder space reserved in the missile, the novel shape structure shown in Figure 5 is designed.
Figure 5.
Composition diagram of the newly designed SSP.
In order to make maximum use of the space inside the missile and reduce the center of gravity of the SSP, the novel shape of the SSP is designed as shown in Figure 5. The measuring device is light in weight and can be neglected, so the position of the center of gravity of the SSP is determined by the parts of the shell composed of parts 2.1 to 2.4, and the counterweight indicated by part 2.5. The position of the center of gravity of the SSP′ shell can be derived from the following equation:
where and denote the density of different materials and the axis of symmetry of the SSP. The SSP shell part consists of two materials. The material of the upper rectangular cover 2.3 is duralumin, and the other parts are alloy steel. The material of the upper rectangular cover 2.3 is duralumin, its main function is to reduce the quality of the upper part of the SSP. The remaining part of the shell is made of alloy steel, whose role is to increase the quality of the bottom of the SSP, and it can also resist the overload, so it can protect the IMU inside the SSP. Because the materials of the shell are different, the center of gravity is calculated according to the two different parts. The center of gravity of the above two parts is deduced by Equation (1), and the center of gravity of the shell can be obtained according to the two points of gravity center position equation. The equation for the two-point center of gravity is as follows:
where denotes the center of gravity of upper rectangular cover and describes the center of gravity of the three parts 2.1, 2.2, and 2.4; and represent the above two parts of the center of gravity, represents the equivalent center of gravity position of the shell part. The relevant data involved in the calculation are shown in Table 2.
Table 2.
Parameters related to stable platform.
The position of the center of gravity of the shell is around (0, 10 mm). In order to increase the force arm of the SSP′s gravitational restoring moment by reducing the position of the center of gravity of the SSP, a counterweight with a large density is placed at the bottom of the SSP near part 2.4. As the quality of the counterweight increases, the parameters such as the quality of the SSP, the arm of force, the moment of inertia, and the frictional torque of the bearing will change. Therefore, we can change the parameters of the SSP by controlling the quality of the counterweight.
3.2. Dynamic Model of the SSP in Missile-borne Environment
3.2.1. Force Acting on the Missile
During the missile’s flight in the air, it is subject to forward thrust from the direction of the missile’s rolling axis, resistance in the opposite direction of the missile’s velocity, lift perpendicular to the missile’s roll axis, and vertical downward gravity. If the missile’s aerodynamic configuration, speed, and angle of attack are determined, the lift of the missile is certain [28]. The upper left corner of Figure 6 is the force diagram of the missile in the missile-borne environment, and the lower right corner is the force diagram of the SSP under the same conditions.
Figure 6.
Diagram of main forces acting on missile and the SSP.
In Figure 6, it can be seen that the forces acting on the SSP are mainly friction force of bearing, gravity, and supporting force, when the high-rotation missile’s flight remains in a stable state. In the vertical direction, there is acceleration of the missile, since the SSP is a part of the missile, it has the same state of motion as the missile, so they have the same acceleration in the vertical direction. According to the different acceleration of the missile in the vertical direction, the SSP is in an overweight state, a weightless state, or a normal state. When the missile has an upward acceleration during the flight, in the direction of the missile’s vertical rolling axis, the lift force of the missile is greater than gravity, and the SSP is in an overweight state. At this moment, the effect of gravity and acceleration is consistent to prevent the SSP from swinging and the stability effect is enhanced. When the missile has downward acceleration during the flight, in the direction of the missile’s vertical rolling axis, the lift of the missile is less than gravity. At this time, the SSP is in a weightless state, the stability of the platform is weakened at this moment. When the missile’s acceleration in the vertical direction during the flight is zero, that is, the same as the ground test, only gravity acts as a stabilizing effect on the platform [29].
In summary, according to the different lift force of the missile, the stability of the SSP is also different. The SSP′s dynamic model previously proposed in our lab is a special case where the acceleration of the missile is zero in the vertical direction. It does not fully consider the impact of changes in lift force on the stability of the SSP in the actual missile-borne environment. This article innovatively analyzes the characteristics of a certain missile’s lift for the first time, and fully considers the influence of the change of the missile’s vertical direction lift on the SSP, and establishes a dynamic model of the SSP under the actual missile-borne environment for the first time.
3.2.2. Lift Calculation of a Certain Missile
During the missile’s flight, due to the relative movement between the missile and the air, the missile is subjected to forces from the air [30]. The lift force acting on the missile can be calculated by Equation (3):
where denotes air density, denotes the maximum cross-sectional area of the missile, denotes the speed of the missile relative to the air, and denotes the lift force coefficient combined with the characteristics of missile structure, which can be calculated by Equation (4):
where describes the normal-force coefficient of the missile, describes the missile’s axial force coefficient, describes the attack angle of the missile (in radians), indicates the bottom diameter of the missile, denotes the diameter of the missile, describes the length of the cylinder, indicates the tail length of the missile, describes the maximum diameter of the missile, and describes the length of the missile head. When the flow around the projectile is a laminar flow boundary layer, . When the flow around the projectile is a turbulent flow boundary layer, . represents zero drag coefficient and can be solved by Equation (5):
The missile will be affected by different types of air resistance depending on the speed of flight. These air resistances are frictional resistance, eddying resistance, and shock wave drag [31]. represents the frictional resistance coefficient of the missile. represents the eddying resistance coefficient of the missile. represents shock wave drag coefficient of the missile. Equation (5) is further described as the following according to the flight characteristics of a missile.
In Equation (6), stands for the bottom diameter of the missile; is the maximum length of the missile; is Mach number; is cone half-angle of the missile (in radians); is the cone angle of the missile tail (in radians); and is viscosity coefficient of air and its value is pa/s. When Equations (4)–(6) are substituted into Equation (3), we can get a lift force when the angle of attack is . The parameters used to calculate the lift force can be seen in Table 3.
Table 3.
Parameters of the missile.
Assume that the attack angle of the missile is constant and the value is 2°. The missile’s flying speed is shown in Figure 7. We can get the trend of missile lift force with time.
Figure 7.
The speed of the missile.
We can determine from Figure 7 that the lift of the missile is between 150 N and 300 N.
3.2.3. Establishment of Dynamic Model in Missile-Borne Environment
In the missile-borne environment, the lift force and the component of gravity act together in the direction of the roll axis perpendicular to the missile, and the resultant force provides the acceleration for the missile in this direction [32]. The SSP and the missile have the same motion state in the pitch and yaw directions, because the SSP is fixedly connected to the missile in the above directions. In other words, the SSP has the same acceleration as the missile in the direction of the roll axis that is perpendicular to the missile. The resultant forces of gravity components and supporting force of the SSP provides the acceleration for the SSP in the direction of the roll axis that is perpendicular to the missile; the supporting force of the SSP is provided directly by the bearing. The direction of the supporting force acting on the SSP and the lift force acting on the missile are the same, and there is a relationship between the magnitude of the two forces. The specific relationship can be obtained by the following two equations:
In Equation (7), represents the quality of the SSP; represents the angle of attack; represents the supporting force of the SSP; represents the acceleration acting in the direction of the roll axis that is perpendicular to the missile; represents the quality of the missile; and represents the lift force of the missile. The relationship between the supporting force of the SSP and the lift force of the missile can be described as Equation (8):
From Equation (8), it can be seen that when the lift force and quality of the missile are determined, the supporting force of the SSP is proportional to the quality of the SSP.
The effect of the component of gravity which is perpendicular to the roll axis of the SSP can be divided into two parts. The part of gravity that interacts with the support force of the SSP plays a role in increasing the stability of the SSP, so the value of this part of gravity of SSP is equal to the value of the support force. The effect of the one part of gravity and constitutes an interaction force, since they are equal and opposite. Another part of gravity provides acceleration which is perpendicular to the roll axis of the SSP. According to Ref. 5, the dynamic model of the SSP in the ground condition is shown as Equation (9):
In Equation (9), represents friction torque of bearing; represents a moment of inertia of SSP; and represents the angle between the arm of gravity of the SSP and the vertical direction. According to Equations (8) and (9), the dynamic model of the SSP in the missile-borne environment can be obtained.
When the angle of attack of the missile is constant, then is a constant value. It can be seen from Equation (10) that in order to minimize the swing angular rate of the SSP, this can be achieved by setting the ratio of to as one. Under the premise that the swing angle of the SSP is the smallest, in order to minimize the swing amplitude of the SSP the weight of the part must be increased. In summary, in order to minimize the swing angular rate and swing angle of the SSP, we can find the which minimizes the value by controlling the value by combining Equations (9) and (10). In addition, we can see that the angular acceleration of the rolling axis is independent of the change of the g value during the flight of the missile. Therefore, by controlling the quality of each part of the SSP, the range of the MEMS sensor for measuring the angular rate of rolling is reduced.
This section takes a certain type of missile as an example to obtain the equation for describing the change of the SSP′s roll angular rate in the missile-borne environment, and clarifies the variation law of the roll angular rate of SSP; we can, through the study of the law of roll angular rate, optimize the selection of the range of MEMS sensors installed in the SSP.
3.3. The Method of Selecting the Best Quality of the SSP
3.3.1. Design Objectives of the SSP
The SSP based on the missile-borne Semi-Strap-down Inertial Navigation System is a mechanical structure that is installed in a high-speed rotation missile, and its main function is to mount the MEMS sensor and create a good working environment for the MEMS inertial sensor, so the stability of the SSP will be directly reflected in the MEMS inertial sensor range requirements [33]. The better the stability of the SSP, the lower the range requirement of the sensor and the higher the measurement accuracy of the navigation parameters. In other words, the ultimate aim of the SSP design is to reduce the roll angular rate and improve the accuracy of navigation positioning.
3.3.2. The Relationship between Bearing Friction Torque and Supporting Force on the SSP
With the increase in the SSP′s quality and the bearing pressure increase, it leads to an increase in bearing friction torque. The relationship between the bearing pressure and the friction torque of the bearing can be calculated by the bearing friction torque equation [34]. Equation (11) is the Svenska Kullager-Fabriken (SKF) bearing friction torque equation:
Bearings were strictly selected, as the Semi-strap-down Inertial Navigation System (SINS) uses an open bearing. Therefore, there is no bearing friction torque caused by the sealing element. The bearing frictional torque caused by oil drag loss, eddy-current, and splashing accounts is only a small fraction of the total, so in this article, we do not calculate it. The expressions of rolling friction torque coefficient and sliding friction torque coefficient are related to bearing type and axial load. Their expressions are definite when the bearing type and axial load are determined. In this paper, we take deep groove ball bearing 6200 as an example to study the best quality of the SSP. Bearing friction torque is only related to axial pressure and radial pressure when bearing type is determined. When the axial pressure of the bearing is zero, the rolling friction torque coefficient and sliding friction torque coefficient can be expressed by the following equation:
In Equation (12), and are bearing-related geometric constants which can be obtained by referring to the bearing catalogue. represents the average diameter of the bearing. represents the radial pressure of bearing. Because two bearings are installed on the SSP, the radial pressure of each bearing is 1/2 of the SSP gravity. Then Equation (12) can be further described as:
In Equation (13), (a) describes the acceleration of the missile in the vertical direction. When the radial pressure of the bearing is greater than zero, the rolling friction torque coefficient and sliding friction torque coefficient of the bearing are as follows:
In Equation (14), indicates a bearing basic steady load. When is not zero, the relationship between the friction torque of the bearing and the quality of the stabilized platform can be determined by Equation (7), as shown in Equation (15):
In Equation (15), represents the angle between the roll axis of the missile and the horizontal line. and are bearing-related coefficients which can be obtained by referring to the bearing catalogue. is the coefficient related to the bearing type. is the relative angular rate of the inner and outer rings. The angular rate of the inner ring is small and can be negligible. In the following calculations, can be approximately equal to the roll angular rate of the missile.
3.3.3. The Choice of the Best Quality Interval for the SSP
In order to increase the stability of the SSP and reduce the angular rate of the SSP in the direction of the roll axis, we have to study the variation of the value of according to Equation (9). We find the value that makes the SSP angular rate minimal by controlling the quality of the SSP. Form the above analysis, it is known that the supporting force and effective gravity of the SSP are interacting forces. The change rule between the value of and the quality of the SSP can be obtained through simulation, then the optimal quality of the SSP can be found when the ratio is the minimum. Since the axial pressure being zero belongs to a special case, this situation is not considered in the actual analysis. Therefore, in actual analysis, the relationship between the bearing friction torque and the quality of the SSP is expressed by Equation (14). The relevant data is substituted into Equation (14) to obtain the change rule of the ratio of bearing friction torque to the quality of the SSP with when the attack angle of the missile is . Since a missile flies at an attack angle of 2°, the missile lift force curve of Figure 8 is combined, and we take the lift force of 100 N, 150 N, 200 N, and 250 N, respectively.
Figure 8.
The lift force missile.
The above parameters are brought into Equation (15), then the simplified Equation (16) is obtained when the attack angle is 2°.
Figure 9 describes, when the axial load of the bearing is not zero, the variation between the ratio of the bearing friction torque to the support force of the SSP and the quality of the SSP. The curves labeled with the numbers ①, ②, ③, and ④ indicate the case where the lift is 100 N, 150 N, 200 N, or 250 N, respectively.
Figure 9.
Changing curve of the ratio of following .
3.4. Optimization Design of the SSP
Assume that the missile is subject to a lift of 200 N, we change the quality of the counterweight to observe the trend of the roll angle and the maximum angular rate of the SSP with the quality. When the lift force of the missile is 200 N, the support force and bearing friction torque of the SSP can be obtained by solving Equations (8) and (14), respectively. The SSP′s support and bearing friction torque are brought into Equation (9), so that Equation (9) is transformed into a second-order differential equation about . The required parameters can be found in Table 4 and Table 5.
Table 4.
Parameters of bearing.
Table 5.
Simulation Parameters.
The data in Table 5 are the simulation data obtained from the SolidWorks. represents the quality of counterweight. Bearing friction torque can be calculated according to Equation (15). Bring the relevant data in Table 5 into Equation (8), and divide to the left of the equation. The equation is solved by the Runge-Kutta method and the curve is drawn. Equation (17) can be obtained, after the first row of data in Table 4 is brought into Equation (9).
In Equation (17), is the SSP roll angular rate, and is the roll angle of the SSP. Equation (17) is solved by using the Runge-Kutta method, and the curve of the angular rate and roll angle of the SSP is drawn. In this paper, Equation (17) is solved and the diagrammatic drawing is created when the quality of the SSP is 1029.97 g, 1492.67 g, 1681.18 g, and 1875.09 g respectively.
Table 6 shows the variation of the maximum roll angular rate and the maximum roll angle of the SSP when the quality of the SSP changes. As can be seen from Figure 10 and Table 6, with increasing quality of the SSP, the angular rate and the roll angle of the SSP exhibit the same trend. It can be seen from Table 6 that when the quality of the SSP is about 1492 g, the roll angular rate is the smallest, and the stability of the SSP is best at this time. That is to say, the range of the inertial MEMS sensor mounted on the SSP is greatly reduced, and the navigation accuracy of the SSINS is improved.
Table 6.
The maximum angular rate and the maximum angle of the SSP with different quality.
Figure 10.
Curves of the roll angular rate and the roll angle of the SSP change with the quality: (a) A curve of roll angular rate and roll angle vary with time when the quality of the SSP is 1029.97 g; (b) A curve of roll angular rate and roll angle vary with time when the quality of the SSP is 1492.67 g; (c) A curve of roll angular rate and roll angle vary with time when the quality of the SSP is1681.18 g; (d) A curve of roll angular rate and roll angle vary with time when the quality of the SSP is1875.09 g.
4. Test Verification
According to the above analysis, the quality of each part of the SSP was strictly controlled, and the quality of the final integrated SSP is 1494.6 g. The quality of the optimized SSP and the unoptimized SSP is shown in Figure 11 and Figure 12, respectively. It is obvious that the quality of optimized SSP is larger than the unoptimized SSP.
Figure 11.
Quality of the SSP after optimization.
Figure 12.
Quality of the SSP before optimization.
A number of shooting tests were conducted by using the unoptimized system and the optimized system. Test results showed that the measurement precision of the optimized system is higher than the unoptimized system. Due to the variability of the shooting test conditions, the superiority of the optimized system cannot be fully explained. According to the above, when the attack angle of the missile is 2°, the lift force of the missile is greater than gravity. In this condition, the stability of the SSP is better than that of the ground test. Therefore, the ground test can be used to verify the stability of the new SSP. In order to verify the isolation effect of the SSP to the high-speed rotational motion of the missile and the correctness of the theoretical analysis, a SSINS with SSP was used to perform the experiments by using a high-precision tri-axial flight simulator. The tri-axial flight simulator has three rotational frames, namely, outer frame, middle frame, and inner frame. Table 7 and Table 8 summarize the technical parameters of tri-axial flight simulator and the characteristics of the IMU in the optimized SSINS, respectively.
Table 7.
Technical parameters of tri-axial flight simulator.
Table 8.
Characteristics of IMU in the optimized Semi-Strapdown Inertial Navigation System (SSINS).
The comparison of the parameters of the sensors in the two tables in Table 1 and Table 8 shows that the gyro on the roll axis is reduced by ± 150°/s through the optimized design range of the SSP, and the performance parameters of the sensor are also improved. Due to the decrease in the roll angular rate of the SSP, the centrifugal force of the X and Y axes is reduced, so the X, Y axis acceleration measurement range is changed from 2.5 g to 0.85 g. It can be seen from the above that the small range sensor’s error is smaller than the larger one, so the use of a small range sensor effectively helps to improve the navigation accuracy.
In order to verify the effect of the SSINS before and after optimization, the comparison experiment is performed under the same experimental conditions. First, the isolation rotation comparison experiment is performed to compare the tri-axial angular rate of the SSINS before and after the optimization. Then, the comparison experiment of the roll angle calculation accuracy is carried out. The roll attitude angle measured before and after the optimization was compared with the feedback value of the flight simulation turntable roll angle, and the two difference values were compared.
The experiment conditions are set as shown in Table 9. In the above two experiments, the SSINS’s pitch and yaw angle provided by high-precision tri-axial flight simulator are same.
Table 9.
Setting of the experiment conditions.
The unoptimized system and the optimized system were installed on the flight simulator and the experiments were carried out. The scene of the flight simulation experiment is shown as Figure 13. The experiment conditions are set as Table 9. We set the rotational speed of the flight simulator is 20 r/s and the pitch angle is 2°. The feedback angular rate of flight simulation turntable is shown in Figure 14. The system experiment data is solved by the same procedure and SSP attitude information can be obtained.
Figure 13.
Flight simulator test.
Figure 14.
Feedback angular rate of flight simulation turntable.
Figure 15 depicts the change of roll angular rate for the unoptimized and optimized systems under the same experimental conditions. We can determine from Figure 15 that the roll angular rate of the SSP after optimization is about 1/3 of the angular rate of the SSP before optimization. This shows that the SSP after optimization has better stability and ability to isolate the high-rotational motion of the missile body.
Figure 15.
Angular rate in the direction of the roll axis.
We can see from Figure 16 and Figure 17 that the angular rate of the SSP after optimization is about 1/3 of the angular rate of the SSP before optimization. This once again proves the superiority of the optimized SSP.
Figure 16.
The angular rate of the pitch axis.
Figure 17.
The angular rate of the yaw axis.
Figure 18 describes the change in roll angle over time, the blue curve represents the feedback value of roll angle of flight simulation turntable and red curve represents the measured roll angle of the optimized system. We can see from the Figure 18 that the change trend of the two curves is the same. Figure 19 shows the difference between the roll angle measured by the system and the roll angle of the flight simulator. The red curve represents the difference between the roll angle measured by the system before optimization and the feedback value of the roll angle of the flight simulator. The blue curve represents the difference between the roll angle measured by the system after optimization and the feedback value of the roll angle of the flight simulator. After comparison, it was found that since the SMINS used a small range sensor after optimization, the error of the solution was reduced to 60% of the system that used a wide range sensor. Through the flight simulation turntable experiment, the practicability and effectiveness of the proposed method in actual application was illustrated.
Figure 18.
Roll attitude.
Figure 19.
Rolling attitude angle difference.
5. Conclusions
The Semi-Strapdown Inertial Navigation System (SSINS) is a new type of system that can measure the navigation parameters of high-speed rotational missiles. In this paper, taking a typical missile type as an example, the lift force curve of this missile was calculated for the first time. The author innovatively proposes a dynamic model of the SSP in the missile-borne environment, which has greater practical application value. In addition, firstly, based on the new shape of the SSP, we controlled the quality of the SSP, then looked for the relationship between the quality of the SSP and the force affecting the roll angular rate from the principles of the SSP. Finally, when the angle of attack of the missile is constant, the SSP′s quality is obtained by the Runge-Kutta method when the swing angle and the swing angle rate are minimized. The choice of the best quality method proposed for the first time is based on the mechanism of the SSP, which enables the MEMS inertial sensor to measure the attitude of the missile in a relatively stable environment with high precision. The experiment results show that the measured roll angle error is reduced to 60% of the unoptimized measurement. It provides a new method for attitude and position measurement of high-rotation and high-overload missiles. Furthermore, there is no systematic theoretical study on the design principle and quality selection method of the SSP based on the SSINS. The first proposed quality selection method provides theoretical guidance for the selection of the range of MEMS inertial sensors in the SSP.
Author Contributions
All authors were involved in the study in this manuscript. J.L. and Z.J. wrote the paper and proposed the idea; Z.J. and J.Z. provided the analysis; J.L. and T.Z. designed and carried out the experiments; S.G. carried out the experiments.
Funding
This work was supported in part by the National Natural Science Foundation of China (51575500, 51705477), the Fund for Shanxi ‘1331 project’ Key Subject Construction and the Foundation for Middle-Aged and Young Talents in Higher Education Institutions.
Conflicts of Interest
The authors declare no conflict of interest.
References
- Pan, J.; Zhang, C.; Niu, Y.; Fan, Z. Accurate calibration for drift of fiber optic gyroscope in multi-position north-seeking phase. Optik-Int. J. Light Electron. Opt. 2014, 125, 7244–7246. [Google Scholar] [CrossRef]
- Zhang, G.; Li, C.; Deng, F.; Chen, J. Research on ballistic missile INS/GNSS/CNS integrated navigation System. Missiles Space Veh. 2004, 4, 11–15. [Google Scholar]
- Xu, M.; Bu, X.; Yu, J.; He, Z. Spinning projectile’s attitude measurement with LW infrared radiation under sea-sky background. Infrared Phys. Technol. 2018, 90, 214–220. [Google Scholar] [CrossRef]
- Chadwick, W. Miss distance of proportional navigation missile with varying velocity. J. Guidance Control Dyn. 2012, 8, 662–666. [Google Scholar] [CrossRef]
- Sasiadek, J.; Hartana, P. GPS/INS Sensor fusion for accurate positioning and navigation based on Kalman Filtering. IFAC Proc. Vol. 2004, 37, 115–120. [Google Scholar] [CrossRef]
- Zeng, Q.; Pan, P.; Liu, J.; Wang, Y.; Liu, S. Fast and accurate target positioning with large viewpoint based on inertial navigation system information. Acta Aeronaut. Astronaut. Sin. 2017, 38, 188–200. [Google Scholar]
- Wu, Y.; Hu, X.; Hu, D.; Li, T.; Lian, J. Strapdown inertial navigation system algorithms based on dual quaternions. IEEE Trans. Aerosp. Electron. Syst. 2005, 41, 110–132. [Google Scholar]
- Li, B.; Wang, M. Research on the error correction algorithm of ballistic missile CNS/INS integrated navigation. Flight Dyn. 2006, 24, 41–44. [Google Scholar]
- Li, J.; Zhao, Y.; Liu, J.; Chen, W. Research on semi-strapdown mems inertial measurement device for flight attitude measurement of high-speed rotating ammunition. Acta Armamentarii 2013, 11, 1398–1403. [Google Scholar]
- Li, J.; Zhu, J.D.; Hou, L.P.; Liu, J. Error compensation technology of semi-strapdown mems inertial measurement system. Key Eng. Mater. 2014, 609, 1213–1218. [Google Scholar] [CrossRef]
- Tao, Y.; Liu, Y.; Dong, J. Recovery procedure and bias shift analysis of MEMS high overload accelerometer due to shock. In Proceedings of the IEEE Chinses Guidance, Navigation and Control Conference, Yantai, China, 8–10 August 2014; pp. 1595–1599. [Google Scholar]
- De Celis, R.; Cadarso, L. Hybridized attitude determination techniques to improve ballistic projectile navigation, guidance and control. Aerosp. Sci. Technol. 2018, 77, 138–148. [Google Scholar] [CrossRef]
- Li, Q.; Sun, X.; Gao, Y.; Qiao, Y. Research on measuring rolling angle of space target based on photoelectric theodolites. J. Grad. Sch. Chin. Acad. Sci. 2006, 23, 765–769. [Google Scholar]
- Yan, X.; Chen, G.; Tian, X. Two-Step adaptive augmented unscented Kalman Filter for roll angles of spinning missiles based on magnetometer measurements. Meas. Control 2018, 51, 73–82. [Google Scholar] [CrossRef]
- Yang, C.; Shi, W.; Chen, W. Correlational inference-based adaptive unscented Kalman Filter with application in GNSS/IMU-integrated navigation. GPS Solut. 2018, 22, 100. [Google Scholar] [CrossRef]
- Zhao, L.; Nie, Q.; Gao, W. A comparison of nonlinear filtering approaches for in-motion alignment of SINS. In Proceedings of the International conference on mechatronics and automation, Harbin, China, 5–8 August 2007; pp. 1310–1315. [Google Scholar]
- Zhang, J.; Li, J.; Zhang, X.; Che, X.; Huang, Y.; Feng, K. Analysis and compensation of modulation angular rate error based on missile-borne rotation semi-strapdown inertial navigation system. Sensors 2018, 18, 1430. [Google Scholar] [CrossRef] [PubMed]
- Duan, X.; Li, J.; Liu, J. Research on the dynamic model of a partial strapdown platform and the impact analysis of pitching angle and the stability of platform. Acta Armamentarii 2014, 35, 1436–1442. [Google Scholar]
- Zheng, T.; Li, J.; Hu, C.; Jiang, G.; Guo, L.; Qian, H. Optimization design of missile-borne semi-strapdown Platform Based on Nested Structure of Double Bearing. Acta Armamentarii 2018, 39, 724–730. [Google Scholar]
- Hu, X.; Yang, S.; Xiong, F.; Zhang, G. Stability of spinning missile with homing proportional guidance law. Aerosp. Sci. Technol. 2017, 71, 546–555. [Google Scholar] [CrossRef]
- Guang, X.; Gao, Y.; Leung, H.; Liu, P.; Li, G. An autonomous vehicle navigation system based on inertial and visual Sensors. Sensors 2018, 18, 2952. [Google Scholar] [CrossRef]
- Alsalaymeh, A.; Durst, F. Development and testing of a novel single-wire sensor for wide range flow velocity measurements. Meas. Sci. Technol. 2004, 15, 777. [Google Scholar] [CrossRef]
- Åström, K.; Furuta, K. Swinging up a pendulum by energy control. Automatica 2000, 36, 287–295. [Google Scholar] [CrossRef]
- Zayas, V.; Low, S.; Mahin, S. A simple pendulum technique for achieving seismic isolation. Earthq. Spectra 2012, 6, 317–333. [Google Scholar] [CrossRef]
- Chung, C.; Hauser, J. Nonlinear control of a swinging pendulum. Automatica 1995, 31, 851–862. [Google Scholar] [CrossRef]
- Jameson, A. Aerodynamic design via control theory. J. Sci. Comput. 1988, 3, 233–260. [Google Scholar] [CrossRef]
- Caccamise, D.F. An aerodynamic basis for selecting transmitter loads in birds. Wilson Bull. 1985, 97, 306–318. [Google Scholar]
- Sane, S.; Dickinson, M. The aerodynamic effects of wing rotation and a revised quasi-steady model of flapping flight. J. Exp. Biol. 2002, 205, 1087. [Google Scholar] [PubMed]
- Spence, D.A. The Lift Coefficient of a Thin, Jet-Flapped Wing. Proc. R. Soc. Lond. A 1956, 238, 46–68. [Google Scholar] [CrossRef]
- Martinezval, R.; Perez, E. Optimum cruise lift coefficient in initial design of jet aircraft. J. Aircr. 1992, 29, 712–714. [Google Scholar] [CrossRef]
- De, G.; Sargeant, A.; Geysel, J. Air friction and rolling resistance during cycling. J. Biomech. 1992, 25, 1090. [Google Scholar]
- Ying, W.; Zhong, Y.; Wang, L. Study on angular motion characteristics of spin-stabilized 2D trajectory correction projectile under the effect of fixed canards. Acta Armamentarii 2017, 38, 1263–1272. [Google Scholar]
- Palm, H.G.; Lang, P.; Strobel, J.; Riesner, H.J.; Friemert, B. Computerized dynamic posturography: the influence of platform stability on postural control. Am. J. Phys. Med. Rehabil. 2014, 93, 49–55. [Google Scholar] [CrossRef] [PubMed]
- Bouyer, J.; Fillon, M. Experimental measurement of the friction torque on hydrodynamic plain journal bearings during start-up. Tribol. Int. 2011, 44, 772–781. [Google Scholar] [CrossRef]
© 2018 by the authors. Licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution (CC BY) license (http://creativecommons.org/licenses/by/4.0/).