# Guidance and Control Design for a Class of Spin-Stabilized Projectiles with a Two-Dimensional

Authors: Yi Wang; Wei-dong Song; Dan Fang; Qing-wei Guo
Journal: International Journal of Aerospace Engineering
 (2015)

---

## Abstract

A guidance and control strategy for a class of 2D trajectory correction fuze with fixed canards is developed in this paper. Firstly, correction control mechanism is researched through studying the deviation motion, the key point of which is the dynamic equilibrium angle. Phase lag of swerve response is the dominating factor for correction control, and formula is deduced with the Mach number as argument. Secondly, impact point deviation prediction based on perturbation theory is proposed, and the numerical solution and application method are introduced. Finally, guidance and control strategy is developed, and simulations to validate the strategy are conducted.


---

## Body

## 1. Introduction

An important objective for future artillery projectiles is high delivery accuracy, in other words, improved aim to reduce round expenditure. In last few decades, several interesting concepts of guided projectiles were proposed, and they could be divided into three categories in terms of the control mechanisms employed: aerodynamic surfaces (nose-mounted canards, tail fins, and wedge-shaped paddle) [1–9], jet thrusters (gas or explosive thrusters) [10–13], and inertial loads (translating or rotating internal masses) [14, 15]. The first category of control mechanism presents some advantages over the other two: on one hand, the aerodynamic surfaces provide continuous time correction easier than jet thrusters; on the other hand, they potentially give the designer more control authority and bear more resemblance to missile trajectory control system. Furthermore, guided projectile concepts involving aerodynamic control devices can be divided into two categories: fin-stabilized (such as the US M712 Copperhead and the M982 Excalibur) and spin-stabilized (such as the US XM 1156 Precision Guidance Kit). Spin-stabilized guided projectiles are generally equipped with a roll-decoupled trajectory correction fuze, designed to provide range and lateral trajectory correction, while at the same time they rely on the high spin rate of the aft part for airframe stability. But the high spin rate creates an important coupling between the normal and lateral axes of the body, which makes the dynamic characteristic rather complex.Swerve response of the spin-stabilized is a key point of the dynamic characteristic to be studied, when control input is added. Ollerenshaw and Costello gave the close-form formulas for the magnitude and phase angle of a projectile excited by a control force in terms of fundamental and pointed out that spin-stabilized projectiles respond out of phase to control-force inputs forward of the center of pressure [16]. Fresconi and Plostins studied various control mechanism strategies for spin-stability projectiles and gave the correction authority under different conditions [17]. But this paper just introduced the strategies, and the conclusion could not be used in engineering application directly.The trajectory correction fuze incorporates all the necessary electromechanical devices for guidance, navigation, and control system of the airframe. Due to the limit of the volume of the fuze, all the electromechanical devices must have high integration degree, which requires the guidance algorithm to have small amount of calculation but high accuracy.The five main types of guidance most considered in guided ammunition contexts are trajectory shaping, model predictive guidance, path following, impact point prediction control, and proportional navigation. When only small correction to a trajectory is possible, only the later four are applicable. In model predictive guidance a model of the projectile and the environment is used in each update instant to compute a sequence of control actions, given the current state [18–20]. The accuracy of the guidance is decided by the model of the projectile. If we want high accuracy, a complex model is needed, and the more state variables are acquired, the higher accuracy is got. The disadvantage of this method is that the amount of calculation is too large. In path following guidance, the current position of the projectile is compared with the nominal trajectory and a control is applied to bring the projectile to the nominal trajectory in some near future [5]. A drawback with path following is that it only uses the position to correct the trajectory but it neglects the velocity, which means that the projectile will fly through the nominal trajectory and further corrections are needed. Trajectory integration is one of the impact points prediction, which makes use of numerical calculation of the trajectory to get the impact point. The predictive accuracy depends on the trajectory model, and the higher accuracy of the model, the higher precision of the predictive. The disadvantage of this method is that for long range shoots of the spin-stability the trajectory is complex, which will cause a large amount of calculation [21, 22]. Proportional navigation is a useful guidance method. But to our best knowledge, only projectiles with jet thrusters as actuators have taken this method [12, 13], and if the method can be used for other two concepts is needed to be researched. Of course, some new methods are proposed for guidance [23, 24]. Perturbation based guidance for a generic 2D trajectory correction fuze is proposed by Robinson, which uses perturbation theory to predict state variables of the projectile [25]. The advantage is that the onboard computer can compute the control signal quickly by the parameters loaded prior to flight, but there is still a drawback that the guidance algorithm only takes drag force in consideration.In this paper, guidance and control algorithm for a class of spin-stabilized projectile with trajectory correction fuze is proposed. Section2 presents the trajectory model of this projectile. Section 3 studies the response of trajectory correction. Section 4 introduces a new impact point prediction methods and its application. Section 5 describes the process of guidance and control, and conclusion is provided in Section 6.


## 2. Trajectory Model

Trajectory correction fuze is attached to the projectile by screw thread, and by the bears in the fuze the guided projectile is divided into two parts: the front part called correction part and the aft part called body part. On the correction part, two sets of fixed canards are mounted; one has the same cant angle called steering canards to provide control force, and the other called rotation canards has the opposite cant angle to rotate the correction part by the rotational moment, as is shown in Figure1.Figure 1
Sketch map of correction part.The definition for the roll angle of the correction part is also given in Figure1. Define the roll angle to be 0 deg, when the steering canards are in horizontal plane and provide upward force, whereas when providing downward force, the roll angle is at the position of 180 deg. And the positive direction of the correction part is left, when looking from nose to the base.


### 2.1. Reference Coordinate System

Two reference coordinate systems are needed in the present analysis: ground launch system and quasi body system. The ground launch frame is an approximation of the earth inertial reference frame. It is a fixed, nonrotating frame, and it neglects the earth’s curvature and rotation. Itsx and z axes are in the horizontal plane and its y-axis is normal to thex-z plane, pointing upward. The original is set at the end of the gun tube, and the x-axis points ahead along the launching direction, while the z-axis points to the right when looking forward from the gun.The quasi body reference frameOx4y4z4 is fixed to the projectile with its original at the projectile center of mass. Its x4-axis aligns with the centerline of the projectile and points forward out of the nose, its positive z4-axis to the right, and its y4-axis upward. Note that x4-y4 plane is fixed in the vertical plane, and it is more convenient to describe the motion of the projectile. The sequence of rotation from the ground launch reference is pitch φ, yaw ψ, as is shown in Figure 2.Figure 2
Coordinate transformation relation.


### 2.2. Trajectory Model

During the flight, the two parts of the projectile spin in different directions due to the effort of the aerodynamic forces. In order to describe the motion of the projectile, three translational and four rotational rigid body degrees of freedom are introduced. The translational degrees of freedom are the three components of the mass center position vector. The rotational degrees of freedom are the Euler yaw and pitch angles as well as the correction part roll and body part roll angles.Equations (1)–(4) represent the translational and rotational kinematic and dynamic equations of motion for a dual spin projectile, and all these equations are expressed in the quasi body reference frame:(1)dvx4dt+vz4ωz4-vy4ωy4=Fx4m,dvy4dt+vx4ωy4+vz4ωz4tan⁡ψ=Fy4m,dvz4dt-vx4ωz4-vy4ωy4tan⁡ψ=Fz4m.Fx4,Fy4,Fz4 are components of the total force expressed in the quasi body reference frame, vx4,vy4,vz4 are velocity vector components of the composite center of mass expressed in the quasi body frame, ωy4,ωz4 are components of the angular velocity vector expressed on the y- and z-axis of the quasi body reference frame, m is the mass of the projectile, and ψ is the yaw angle:(2)x˙y˙z˙=cos⁡φcos⁡ψsin⁡φcos⁡ψ-sin⁡ψ-sin⁡φcos⁡φ0cos⁡φsin⁡ψsin⁡φsin⁡ψcos⁡ψvx4vy4vz4.x,y,z are position vector components of the composite center of mass expressed in the inertial frame and φ is the pitch angle(3)Jxfω˙xfJxω˙x4Jyω˙y4Jzω˙z4=MxfMxMyMz-0Jz-Jyωy4ωz4Jx-Jzωx4ωz4Jy-Jxωx4ωy4+00-Jzωz4γ˙aJyωy4γ˙a.Jxf,Jx are moments of both the front and the aft parts expressed on the x-axis of the quasi body reference frame, Jy,Jz are moments of the projectile expressed on the y- and z-axis of the quasi body reference frame, ωxf,ωx4 are components of the angular velocity vector of both the front and the aft parts expressed on the x4-axis of the quasi body reference frame, ωy4,ωz4 are components of the angular velocity vector expressed on the y- and z-axis of the quasi body reference frame, Mxf,Mx are components of the total moment of both the front and the aft parts expressed on the x-axis of the quasi body reference frame, My,Mz are components of the total moment expressed on the y- and z-axis of the quasi body reference frame, and γf,γa are roll angles of the correction and body part: (4)φ˙ψ˙γ˙aγ˙f=0sin⁡γcos⁡ψcos⁡γγcos⁡ψ00cos⁡γa-sin⁡γa01tan⁡ψsin⁡γatan⁡ψcos⁡γa00001ωx4ωy4ωz4ωxf.Loads on the composite projectile body are due to weight and aerodynamic forces. All the aerodynamic coefficients are acquired by numerical computing, and the forces as well as moments present as follows:(5)Fx4=-12ρv2SCa,Fy4=12ρv2SCn′α-12ρv2SCzf′′dγ˙fvβ-12ρv2SCza′′dγ˙avβ+12ρv2SCnδδzcγf+α,Fz4=-12ρv2SCn′β-12ρv2SCzf′′dγ˙fvα-12ρv2SCza′′dγ˙avα-12ρv2SCnδ-δzsγf+β,(6)Mxf=12ρv2SLmxh-12ρv2SLdpfvClpf-Mfa,Mx=-12ρv2SLdpavClpa-Maf,My=12ρv2SLmz′β-12ρv2SLCnrLrv+12ρv2SLCnpafdγ˙fvα+12ρv2SLCnpaadγ˙avα+12ρv2SLCCnδ-δzcγf+β,Mz=12ρv2SLmz′α-12ρv2SLCmqLqv-12ρv2SLCnpafdγ˙fvβ-12ρv2SLCnpaadγ˙avβ+12ρv2SLCCnδδzsγf+α.Ca is axial force coefficient, Cn′ is normal force derivative coefficient, Czf′′,Cza′′ are Magnus force coefficient of the correction and body part, mxh is roll moment coefficient of the front part, mz′ is overturn moment coefficient, Clpf,Clpa are roll damping moment coefficient of the correction and body part, Cnr,Cmq are yaw and pitch rate damping moment coefficient, Cnpaf,Cnpaa are Magnus moment aerodynamic coefficient of the correction and body part, α,β are attack and sideslip angles, S,L are reference area and length, d is diameter of the projectile, and v is the total velocity. The attack and sideslip angles are computed as follows:(7)α=-tan-1vy4v,β=tan-1vz4v.When the projectile is controlled, the correction part will be set at a given command angle relative to the ground launch frame, and the roll velocity of the correction part will be 0. So the control equations can be added as follows:(8)γf=γc,γ˙f=ωxf=0,where γf and ωxf are the roll angle and roll angle velocity components on the x4-axis of the quasi body frame and γc is the command angle.


## 2.1. Reference Coordinate System

Two reference coordinate systems are needed in the present analysis: ground launch system and quasi body system. The ground launch frame is an approximation of the earth inertial reference frame. It is a fixed, nonrotating frame, and it neglects the earth’s curvature and rotation. Itsx and z axes are in the horizontal plane and its y-axis is normal to thex-z plane, pointing upward. The original is set at the end of the gun tube, and the x-axis points ahead along the launching direction, while the z-axis points to the right when looking forward from the gun.The quasi body reference frameOx4y4z4 is fixed to the projectile with its original at the projectile center of mass. Its x4-axis aligns with the centerline of the projectile and points forward out of the nose, its positive z4-axis to the right, and its y4-axis upward. Note that x4-y4 plane is fixed in the vertical plane, and it is more convenient to describe the motion of the projectile. The sequence of rotation from the ground launch reference is pitch φ, yaw ψ, as is shown in Figure 2.Figure 2
Coordinate transformation relation.


## 2.2. Trajectory Model

During the flight, the two parts of the projectile spin in different directions due to the effort of the aerodynamic forces. In order to describe the motion of the projectile, three translational and four rotational rigid body degrees of freedom are introduced. The translational degrees of freedom are the three components of the mass center position vector. The rotational degrees of freedom are the Euler yaw and pitch angles as well as the correction part roll and body part roll angles.Equations (1)–(4) represent the translational and rotational kinematic and dynamic equations of motion for a dual spin projectile, and all these equations are expressed in the quasi body reference frame:(1)dvx4dt+vz4ωz4-vy4ωy4=Fx4m,dvy4dt+vx4ωy4+vz4ωz4tan⁡ψ=Fy4m,dvz4dt-vx4ωz4-vy4ωy4tan⁡ψ=Fz4m.Fx4,Fy4,Fz4 are components of the total force expressed in the quasi body reference frame, vx4,vy4,vz4 are velocity vector components of the composite center of mass expressed in the quasi body frame, ωy4,ωz4 are components of the angular velocity vector expressed on the y- and z-axis of the quasi body reference frame, m is the mass of the projectile, and ψ is the yaw angle:(2)x˙y˙z˙=cos⁡φcos⁡ψsin⁡φcos⁡ψ-sin⁡ψ-sin⁡φcos⁡φ0cos⁡φsin⁡ψsin⁡φsin⁡ψcos⁡ψvx4vy4vz4.x,y,z are position vector components of the composite center of mass expressed in the inertial frame and φ is the pitch angle(3)Jxfω˙xfJxω˙x4Jyω˙y4Jzω˙z4=MxfMxMyMz-0Jz-Jyωy4ωz4Jx-Jzωx4ωz4Jy-Jxωx4ωy4+00-Jzωz4γ˙aJyωy4γ˙a.Jxf,Jx are moments of both the front and the aft parts expressed on the x-axis of the quasi body reference frame, Jy,Jz are moments of the projectile expressed on the y- and z-axis of the quasi body reference frame, ωxf,ωx4 are components of the angular velocity vector of both the front and the aft parts expressed on the x4-axis of the quasi body reference frame, ωy4,ωz4 are components of the angular velocity vector expressed on the y- and z-axis of the quasi body reference frame, Mxf,Mx are components of the total moment of both the front and the aft parts expressed on the x-axis of the quasi body reference frame, My,Mz are components of the total moment expressed on the y- and z-axis of the quasi body reference frame, and γf,γa are roll angles of the correction and body part: (4)φ˙ψ˙γ˙aγ˙f=0sin⁡γcos⁡ψcos⁡γγcos⁡ψ00cos⁡γa-sin⁡γa01tan⁡ψsin⁡γatan⁡ψcos⁡γa00001ωx4ωy4ωz4ωxf.Loads on the composite projectile body are due to weight and aerodynamic forces. All the aerodynamic coefficients are acquired by numerical computing, and the forces as well as moments present as follows:(5)Fx4=-12ρv2SCa,Fy4=12ρv2SCn′α-12ρv2SCzf′′dγ˙fvβ-12ρv2SCza′′dγ˙avβ+12ρv2SCnδδzcγf+α,Fz4=-12ρv2SCn′β-12ρv2SCzf′′dγ˙fvα-12ρv2SCza′′dγ˙avα-12ρv2SCnδ-δzsγf+β,(6)Mxf=12ρv2SLmxh-12ρv2SLdpfvClpf-Mfa,Mx=-12ρv2SLdpavClpa-Maf,My=12ρv2SLmz′β-12ρv2SLCnrLrv+12ρv2SLCnpafdγ˙fvα+12ρv2SLCnpaadγ˙avα+12ρv2SLCCnδ-δzcγf+β,Mz=12ρv2SLmz′α-12ρv2SLCmqLqv-12ρv2SLCnpafdγ˙fvβ-12ρv2SLCnpaadγ˙avβ+12ρv2SLCCnδδzsγf+α.Ca is axial force coefficient, Cn′ is normal force derivative coefficient, Czf′′,Cza′′ are Magnus force coefficient of the correction and body part, mxh is roll moment coefficient of the front part, mz′ is overturn moment coefficient, Clpf,Clpa are roll damping moment coefficient of the correction and body part, Cnr,Cmq are yaw and pitch rate damping moment coefficient, Cnpaf,Cnpaa are Magnus moment aerodynamic coefficient of the correction and body part, α,β are attack and sideslip angles, S,L are reference area and length, d is diameter of the projectile, and v is the total velocity. The attack and sideslip angles are computed as follows:(7)α=-tan-1vy4v,β=tan-1vz4v.When the projectile is controlled, the correction part will be set at a given command angle relative to the ground launch frame, and the roll velocity of the correction part will be 0. So the control equations can be added as follows:(8)γf=γc,γ˙f=ωxf=0,where γf and ωxf are the roll angle and roll angle velocity components on the x4-axis of the quasi body frame and γc is the command angle.


## 3. Control Mechanism Strategy

In this section, control mechanism strategy is researched. Firstly, formula for dynamic equilibrium angle caused by the trajectory correction is deduced based on the equations of the angle motion. Then, swerve response is studied by researching the deviation motion, and the formulas for the magnitude and the phase angle are acquired. Finally, formula for the phase angle of a spin-stability projectile with Mach number as argument is got.


### 3.1. Dynamic Equilibrium Angle Caused by Correction

When deducing the equation of angle motion, a few assumptions are invoked.(1) The argument is changed from timet to arc length s, and the arc length is defined as follows:(9)s=∫0tvdτ.(2) The attack and sideslip angles are small, so(10)α≈-vy4v,β≈vz4v.(3) Compared tovx4,ωx4, and ωxh, the quantities vy4,vz4,ωy4, and ωz4 are small, so that the total velocity(11)v˙≈v˙x4=-ρSCa2mv2-gsin⁡φcos⁡ψ.Products of small quantities and their derivatives are negligible.(4) The projectile is mass balanced, such that the centers of gravity of both the correction part and the body part lie on the rotational axis of symmetry:(12)Jz=Jy.Neglecting the products of small quantities, the derivation of (10) is that(13)α˙=-Fy4mv+ωz4-v˙vα,β˙=Fz4mv+ωy4-v˙vβ.Let Δ=α-iβ,μ=ωy4+iωz4,Jy=Jz=A; substituting (5) into (13), after a series of deducing, the equation of angle motion is acquired:(14)Δ′′+H-iPΔ′-M+iPTΔ=G+D.G and D are the gravity term and control force term, respectively, and the meaning of the symbols is as follows:(15)H=kzz+by-bx-gv2sin⁡φcos⁡ψ+bc,P=bzfγ˙f+bzaγ˙av+Jxfγ˙f+Jxaγ˙aAv,M=kz-kzzby-bx-gv2sin⁡φcos⁡ψ+bc+Jxfγ˙f+Jxaγ˙abzfγ˙f+bzaγ˙aAv2+kc,PT=Jxfγ˙f+Jxaγ˙aAvby-bx-gv2sin⁡φcos⁡ψ+bc+kzzbzfγ˙f+bzaγ˙av-kyfγ˙f+kyaγ˙av,G=gv2cos⁡φ+isin⁡φsin⁡ψkzz-iJxfγ˙f+Jxaγ˙aAv,D=kc-bckzz-iJxfγ˙f+Jxaγ˙aAvδzeiγf,kya=ρSLdCnpaa2A,kc=ρSLcCnδ2A,bx=ρSCa2m,by=ρSCn′2m,bzf=ρSdCzf′′2m,bza=ρSdCza′′2m,bc=ρSCnδ2m,kz=ρSLmz′2A,kzz=ρSL2Cmq2A,kyf=ρSLdCnpaf2A.Coefficients frozen method is taken here, which means that all the aerodynamic coefficients will not change in the near future. So (14) is a linear differential equation, and its analytic solution can be obtained. But here the gravity term will not be considered, because this paper just studies the swerve response of correction control, so the following equation is got:(16)Δ′′+H-iPΔ′-M+iPTΔ=D.All the following research is based on the assumption that the projectile is stable. From (16), we know that the angle motion caused by correction control can be divided into fast and slow modes of oscillation, and the oscillation will decay as the projectile flies downrange, because the real parts of the eigenvalues are negative. So the particular solution is only considered, which is called dynamic equilibrium angle caused by correction control.DefineΔ0c as a particular solution for (16), and(17)Δ0c=c1el1s+c2el2s.l1 and l2 are roots for homogeneous equation, so (18)l1+l2=-H-iP,l1l2=-M+iPT.Let c1′el1s+c2′el2s=0 and differentiate Δ0c. After deducing, we get(19)c1,2′=±Gl1-l2e-l1,2s=±1l1-l2gcos⁡φv2kzz-iJxfγ˙f+Jxaγ˙aAve-l1,2s.Let Q∗=kzz-iJxfγ˙f+Jxaγ˙a/Av. The quantity of Q∗ is small and can be seen as a constant in a small time period. Integrating the c1,2′, we have(20)c1,2=±gQ∗l1-l21-l1,2cos⁡φv2e-l1,2s.Substituting (17) into (16), it gives(21)Δ0c=-kc-bckzz+ibcJxaγ˙a/AvM+iPTδzeiγf.


### 3.2. Swerve Response of Spin-Stability Projectiles

The point mass trajectory model is the first order approximation of the real trajectory, which only takes the gravity as well as the zero yaw axial force in consideration. In the flight, other aerodynamic forces and moments act on the projectile and make the flight contrail diverge from the point mass trajectory. The motion which is perpendicular to the point mass trajectory is called the deviation motion [26].Define the components of the deviation motion asyp and zp, so we have(22)y¨p+iz¨p=Fy4+iFz4m=by+bc+ibzfγ˙f+bzaγ˙avv2Δ+bcv2δzeiγf-gcos⁡φ.Taking the arc length s as argument and taking γ˙f=ωxf=0, it gives(23)yp′′+izp′′=by+bc-ibzaγ˙avΔ+bcδzeiγc-gcos⁡φv2.Neglecting the third term which is small and substituting (21) into (23), it gives(24)vyp+ivzp=∫-by+bc-ibzaγ˙av·kc-bckzz+ibcJxaγ˙a/AvM+iPTδzeiγc+bcδzeiγcds,yp+izp=∬-by+bc-ibzaγ˙av·kc-bckzz+ibcJxaγ˙a/AvM+iPTδzeiγc+bcδzeiγcdsds.vyp, vzp and yp, zp are the velocity and position components of the deviation motion, respectively. γc is the command angle. Equation (24) can be changed into(25)vyp+ivzp=-by+bc-ibzfγ˙f+bzaγ˙av·kc-bckzz+ibcJxaγ˙a/AvM+iPT+bcδzeiγc∫ds,yp+izp=-by+bc-ibzfγ˙f+bzaγ˙av·kc-bckzz+ibcJxaγ˙a/AvM+iPT+bc·δzeiγc∬dsds.The assumption is invoked that velocity and aerodynamic coefficients of the projectile do not change in the small period. Xc is the component of the flying path on thex-axis of the ground frame, and φ is the pitch angle, which is also assuming not change:(26)∫ds=s=Xccos⁡φ,∬dsds=s2=Xccos⁡φ2.Let Con=-by+bc-ibzaγ˙a/vkc-bckzz+ibcJxaγ˙a/Av/M+iPT+bc, and the real and imaginary parts are as follows: (27)Con_real=by+bc-kc+bckzz-bzaγ˙a/vbcJxaγ˙a/AvM+bzaγ˙a/vkc-bckzz-by+bcbcJxaγ˙a/AvPTM2+P2T2+bc,Con_imag=by+bc-kc+bckzz-bzaγ˙a/vbcJxaγ˙a/AvPT+bzaγ˙a/vkc-bckzz-by+bcbcJxaγ˙a/AvMM2+P2T2.Equation (24) can be changed into(28)vyp+ivzp=Xccos⁡φ·δzCon_realcos⁡γc-Con_imagsin⁡γc+iCon_realsin⁡γc+Con_imagcos⁡γc,yp+izp=Xccos⁡φ2·δzCon_realcos⁡γc-Con_imagsin⁡γc+iCon_realsin⁡γc+Con_imagcos⁡γc.So we can get magnitudes and phase angle of the velocity and position of the swerve response as follows:(29)Vp=Xccos⁡φδzCon_real2+Con_imag2,Rp=Xccos⁡φ2δzCon_real2+Con_imag2,ϕp=arctanCon_realsin⁡γc+Con_imagcos⁡γcCon_realcos⁡γc-Con_imagsin⁡γc.Vp and Rp are magnitudes of the velocity and position of the swerve response, whereas ϕp is the phase angle.


### 3.3. Phase Angle Analysis

The steering canards mounted on the fuze have fixed cant angle, and trajectory correction is realized by adjusting the roll angle of the correction part. So the key point of the control for this class of spin-stabilized projectile is the phase angle between command angle and the direction response.Take a certain class of spin-stabilized projectile with fixed canards as example, as is shown in Figure3. Muzzle velocity is 897 m-s−1, and the mass is 45.5 kg. A simulation experiment is conducted for the phase angle analysis.Figure 3
A class of spin-stabilized projectile with fixed canards.The projectile was fired at elevation 45 deg, and standard meteorological condition was taken. In simulation correction control began with 10 s, and the command angle was set at 0 deg, 90 deg, 180 deg, and −90 deg, respectively. The results gotten are shown in Figure4. The four curves have the same changing trend.Figure 4
Curves of phase angle.Defineϕd to be the phase shift, which is the angle between the command angle and the direction of the response, and the curves of ϕd are shown in Figure 5. The four curves have small difference, and when the time t is 42.6 s, the biggest magnitude difference is got, which is about 3 deg.Figure 5
Phase shift.So an assumption is applied, that phase shift for all the command angles is the same one if the state variables of the projectile are given. Since magnitude ofϕp is only relative to velocity and command angle, the phase shift ϕd is a function with Mach number as the argument. Take the method of polynomial fitting (Figure 6), and a formula is got:(30)ϕd=-285Ma4+1638Ma3-3157Ma2+3352Ma-1032,where Ma is on behalf of the Mach number.Figure 6
Polynomial fitting for phase shift.


## 3.1. Dynamic Equilibrium Angle Caused by Correction

When deducing the equation of angle motion, a few assumptions are invoked.(1) The argument is changed from timet to arc length s, and the arc length is defined as follows:(9)s=∫0tvdτ.(2) The attack and sideslip angles are small, so(10)α≈-vy4v,β≈vz4v.(3) Compared tovx4,ωx4, and ωxh, the quantities vy4,vz4,ωy4, and ωz4 are small, so that the total velocity(11)v˙≈v˙x4=-ρSCa2mv2-gsin⁡φcos⁡ψ.Products of small quantities and their derivatives are negligible.(4) The projectile is mass balanced, such that the centers of gravity of both the correction part and the body part lie on the rotational axis of symmetry:(12)Jz=Jy.Neglecting the products of small quantities, the derivation of (10) is that(13)α˙=-Fy4mv+ωz4-v˙vα,β˙=Fz4mv+ωy4-v˙vβ.Let Δ=α-iβ,μ=ωy4+iωz4,Jy=Jz=A; substituting (5) into (13), after a series of deducing, the equation of angle motion is acquired:(14)Δ′′+H-iPΔ′-M+iPTΔ=G+D.G and D are the gravity term and control force term, respectively, and the meaning of the symbols is as follows:(15)H=kzz+by-bx-gv2sin⁡φcos⁡ψ+bc,P=bzfγ˙f+bzaγ˙av+Jxfγ˙f+Jxaγ˙aAv,M=kz-kzzby-bx-gv2sin⁡φcos⁡ψ+bc+Jxfγ˙f+Jxaγ˙abzfγ˙f+bzaγ˙aAv2+kc,PT=Jxfγ˙f+Jxaγ˙aAvby-bx-gv2sin⁡φcos⁡ψ+bc+kzzbzfγ˙f+bzaγ˙av-kyfγ˙f+kyaγ˙av,G=gv2cos⁡φ+isin⁡φsin⁡ψkzz-iJxfγ˙f+Jxaγ˙aAv,D=kc-bckzz-iJxfγ˙f+Jxaγ˙aAvδzeiγf,kya=ρSLdCnpaa2A,kc=ρSLcCnδ2A,bx=ρSCa2m,by=ρSCn′2m,bzf=ρSdCzf′′2m,bza=ρSdCza′′2m,bc=ρSCnδ2m,kz=ρSLmz′2A,kzz=ρSL2Cmq2A,kyf=ρSLdCnpaf2A.Coefficients frozen method is taken here, which means that all the aerodynamic coefficients will not change in the near future. So (14) is a linear differential equation, and its analytic solution can be obtained. But here the gravity term will not be considered, because this paper just studies the swerve response of correction control, so the following equation is got:(16)Δ′′+H-iPΔ′-M+iPTΔ=D.All the following research is based on the assumption that the projectile is stable. From (16), we know that the angle motion caused by correction control can be divided into fast and slow modes of oscillation, and the oscillation will decay as the projectile flies downrange, because the real parts of the eigenvalues are negative. So the particular solution is only considered, which is called dynamic equilibrium angle caused by correction control.DefineΔ0c as a particular solution for (16), and(17)Δ0c=c1el1s+c2el2s.l1 and l2 are roots for homogeneous equation, so (18)l1+l2=-H-iP,l1l2=-M+iPT.Let c1′el1s+c2′el2s=0 and differentiate Δ0c. After deducing, we get(19)c1,2′=±Gl1-l2e-l1,2s=±1l1-l2gcos⁡φv2kzz-iJxfγ˙f+Jxaγ˙aAve-l1,2s.Let Q∗=kzz-iJxfγ˙f+Jxaγ˙a/Av. The quantity of Q∗ is small and can be seen as a constant in a small time period. Integrating the c1,2′, we have(20)c1,2=±gQ∗l1-l21-l1,2cos⁡φv2e-l1,2s.Substituting (17) into (16), it gives(21)Δ0c=-kc-bckzz+ibcJxaγ˙a/AvM+iPTδzeiγf.


## 3.2. Swerve Response of Spin-Stability Projectiles

The point mass trajectory model is the first order approximation of the real trajectory, which only takes the gravity as well as the zero yaw axial force in consideration. In the flight, other aerodynamic forces and moments act on the projectile and make the flight contrail diverge from the point mass trajectory. The motion which is perpendicular to the point mass trajectory is called the deviation motion [26].Define the components of the deviation motion asyp and zp, so we have(22)y¨p+iz¨p=Fy4+iFz4m=by+bc+ibzfγ˙f+bzaγ˙avv2Δ+bcv2δzeiγf-gcos⁡φ.Taking the arc length s as argument and taking γ˙f=ωxf=0, it gives(23)yp′′+izp′′=by+bc-ibzaγ˙avΔ+bcδzeiγc-gcos⁡φv2.Neglecting the third term which is small and substituting (21) into (23), it gives(24)vyp+ivzp=∫-by+bc-ibzaγ˙av·kc-bckzz+ibcJxaγ˙a/AvM+iPTδzeiγc+bcδzeiγcds,yp+izp=∬-by+bc-ibzaγ˙av·kc-bckzz+ibcJxaγ˙a/AvM+iPTδzeiγc+bcδzeiγcdsds.vyp, vzp and yp, zp are the velocity and position components of the deviation motion, respectively. γc is the command angle. Equation (24) can be changed into(25)vyp+ivzp=-by+bc-ibzfγ˙f+bzaγ˙av·kc-bckzz+ibcJxaγ˙a/AvM+iPT+bcδzeiγc∫ds,yp+izp=-by+bc-ibzfγ˙f+bzaγ˙av·kc-bckzz+ibcJxaγ˙a/AvM+iPT+bc·δzeiγc∬dsds.The assumption is invoked that velocity and aerodynamic coefficients of the projectile do not change in the small period. Xc is the component of the flying path on thex-axis of the ground frame, and φ is the pitch angle, which is also assuming not change:(26)∫ds=s=Xccos⁡φ,∬dsds=s2=Xccos⁡φ2.Let Con=-by+bc-ibzaγ˙a/vkc-bckzz+ibcJxaγ˙a/Av/M+iPT+bc, and the real and imaginary parts are as follows: (27)Con_real=by+bc-kc+bckzz-bzaγ˙a/vbcJxaγ˙a/AvM+bzaγ˙a/vkc-bckzz-by+bcbcJxaγ˙a/AvPTM2+P2T2+bc,Con_imag=by+bc-kc+bckzz-bzaγ˙a/vbcJxaγ˙a/AvPT+bzaγ˙a/vkc-bckzz-by+bcbcJxaγ˙a/AvMM2+P2T2.Equation (24) can be changed into(28)vyp+ivzp=Xccos⁡φ·δzCon_realcos⁡γc-Con_imagsin⁡γc+iCon_realsin⁡γc+Con_imagcos⁡γc,yp+izp=Xccos⁡φ2·δzCon_realcos⁡γc-Con_imagsin⁡γc+iCon_realsin⁡γc+Con_imagcos⁡γc.So we can get magnitudes and phase angle of the velocity and position of the swerve response as follows:(29)Vp=Xccos⁡φδzCon_real2+Con_imag2,Rp=Xccos⁡φ2δzCon_real2+Con_imag2,ϕp=arctanCon_realsin⁡γc+Con_imagcos⁡γcCon_realcos⁡γc-Con_imagsin⁡γc.Vp and Rp are magnitudes of the velocity and position of the swerve response, whereas ϕp is the phase angle.


## 3.3. Phase Angle Analysis

The steering canards mounted on the fuze have fixed cant angle, and trajectory correction is realized by adjusting the roll angle of the correction part. So the key point of the control for this class of spin-stabilized projectile is the phase angle between command angle and the direction response.Take a certain class of spin-stabilized projectile with fixed canards as example, as is shown in Figure3. Muzzle velocity is 897 m-s−1, and the mass is 45.5 kg. A simulation experiment is conducted for the phase angle analysis.Figure 3
A class of spin-stabilized projectile with fixed canards.The projectile was fired at elevation 45 deg, and standard meteorological condition was taken. In simulation correction control began with 10 s, and the command angle was set at 0 deg, 90 deg, 180 deg, and −90 deg, respectively. The results gotten are shown in Figure4. The four curves have the same changing trend.Figure 4
Curves of phase angle.Defineϕd to be the phase shift, which is the angle between the command angle and the direction of the response, and the curves of ϕd are shown in Figure 5. The four curves have small difference, and when the time t is 42.6 s, the biggest magnitude difference is got, which is about 3 deg.Figure 5
Phase shift.So an assumption is applied, that phase shift for all the command angles is the same one if the state variables of the projectile are given. Since magnitude ofϕp is only relative to velocity and command angle, the phase shift ϕd is a function with Mach number as the argument. Take the method of polynomial fitting (Figure 6), and a formula is got:(30)ϕd=-285Ma4+1638Ma3-3157Ma2+3352Ma-1032,where Ma is on behalf of the Mach number.Figure 6
Polynomial fitting for phase shift.


## 4. Impact Point Deviation Prediction Based on Perturbation Theory

In this section theory of impact point deviation prediction based on perturbation theory is presented firstly. Then the numerical method and application are introduced. At the same time, for projectiles using GPS receiver as the trajectory measurement tool, a second-order fading memory filter is designed. Finally, prediction accuracy is studied by simulation.


### 4.1. Impact Point Prediction Based on Perturbation Theory

X
0
x
0
,
y
0
,
z
0 and XTxT,yT,zT are the positions of the gun and target, respectively. Given the muzzle velocity, the trajectory impacting the target can be acquired definitely. For unguided projectiles the trajectory is the only one, because the range of elevation of the gun is restricted, and the trajectory is called nominal trajectory. Define XT=Φx,y,z,vx,vy,vz to be function of nominal trajectory, with x as argument and vx,vy,vz,y,z as state variables.During flight disturbances always exit, and the projectile deflects from nominal trajectory, which causes the impact point deviation. Define the impact point of flight path influenced by disturbances to beXImxIm,yIm,zIm. If XIm is close to target XT, perturbation theory can be used to predict the impact point. Xx,y,z is any point on nominal trajectory, and XIm can be derived using Taylor expansion:(31)xIm=xT+∂Φx∂vx,∂Φx∂vy,∂Φx∂vz,∂Φx∂y,∂Φx∂z·Δvx,Δvy,Δvz,Δy,ΔzT+RxX,V,zIm=zT+∂Φz∂vx,∂Φz∂vy,∂Φz∂vz,∂Φz∂y,∂Φz∂z·Δvx,Δvy,Δvz,Δy,ΔzT+RzX,V.Δvx,Δvy,Δvz,Δy,Δz are disturbance magnitudes of state variables when range of the projectile is x, whereas RxX,V and RzX,V are Lagrange remainders. If Taylor expansion meets the accuracy requirement, that is to say, the absolute values of RxX,V and RzX,V are smaller than the given value, (30) can be used to predict the impact point deviation, so we get(32)DL=xIm-xT=∂Φx∂vx,∂Φx∂vy,∂Φx∂vz,∂Φx∂y,∂Φx∂z·Δvx,Δvy,Δvz,Δy,ΔzT,DH=zIm-zT=∂Φz∂vx,∂Φz∂vy,∂Φz∂vz,∂Φz∂y,∂Φz∂z·Δvx,Δvy,Δvz,Δy,ΔzT.DL andDHare the downrange and lateral deviation of the impact point.When using this method, note the following.(1)
The impact pointXIm should be close to the target XT, and the disturbance magnitudes should not be big ones.(2)
Predictive accuracy should meet requirements.


### 4.2. Numerical Method and Application

X
T
=
Φ
x
,
y
,
z
,
v
x
,
v
y
,
v
z is an implicit function. Taking analytic method to study the predictive accuracy is very hard, while numerical method is a useful way. Numerical method is taken in this paper, and application of partial derivative, nominal trajectory is researched.In order to predict the deviation in real time, the guidance system needs to acquire the information of velocity and position; at the same time it should get the partial derivatives and disturbance magnitudes. In application, partial derivatives and nominal trajectory are loaded on the onboard computer prior to flight. The information of velocity and position can be acquired by global position system (GPS) receiver, or inertial measurement unit (IMU). The projectile mentioned above takes GPS receiver.The unguided trajectory whose elevation is 45 deg is used as nominal trajectory, and the trajectory whose elevation is in the neighborhood of 45 deg is used as the disturbance trajectory. The advantage is that the impact point deviation is the same value along the trajectory.


#### 4.2.1. Numerical Computing of Partial Derivatives

Finite difference method is invoked here. Take∂Φx/∂vx and ∂Φz/∂vx as example. Add disturbance Δvx on the state variable vx of any point on the nominal trajectory, and the impact point Xδxδ,yδ,zδ is got. It gives(33)∂Φx∂vx=xδ-xTΔvx,∂Φz∂vx=zδ-zTΔvx.The second and third order partial derivatives are also computed like this.Here velocity step and position step are defined, which are velocity and position disturbance. In this part, how to select the velocity step, position step, and order of the Taylor expansion is presented. Select the trajectory whose elevation is 45.5 deg as disturbance trajectory.The predictive results of downrange deviation using first and second-order partial derivatives are shown in Figure7, when velocity step and position step are 2 m-s−1 and 5 m, and rows of partial derivatives and nominal trajectory are 20 and 75, respectively. Compared with result of first order, result of second-order has big amplitude, and the convergence is slow. So first order partial derivatives is preferred.Figure 7
Predictive results with different order partial derivatives.Figure8 shows the predictive results with different velocity steps and position steps, when rows of partial derivatives and nominal trajectory are 20 and 75, respectively. When position step is 5 m, results are almost the same. But when velocity step is given as 2 m-s−1, results have big difference after range reaches 22 km. That is because the impact point is far away from the target, since magnitude of position step is too big. Here we select that velocity step and position step are 2 m-s−1 and 5 m.Figure 8
Predictive results with different velocity and position step.Table1 shows twenty rows of partial derivatives of nominal trajectory, and values of each line are almost liner. Simulation results show that selecting 20 rows is suitable, since adding rows will not improve the accuracy of prediction.Table 1
Partial derivatives.
Range
∂
Φ
x
/
∂
v
x
∂
Φ
x
/
∂
v
y
∂
Φ
x
/
∂
v
z
∂
Φ
x
/
∂
y
∂
Φ
x
/
∂
z
∂
Φ
z
/
∂
v
x
∂
Φ
z
/
∂
v
y
∂
Φ
z
/
∂
v
z
∂
Φ
z
/
∂
y
∂
Φ
z
/
∂
z
5146.29
26.41
26.48
−4.4
1.18
−0.0013
−0.31
1.25
47.98
0.069
0.99658
6707.75
27.53
25.95
−4.45
1.04
−0.0017
−0.57
1.26
48.6
0.0689
0.99688
8144.93
27.8
25.87
−4.06
0.86
−0.0021
−0.84
1.26
48.38
0.062
0.99718
9487
27.7
25.74
−3.59
0.71
−0.0024
−1.05
1.22
47.5
0.055
0.99747
10753.4
28.7
26.12
−3.33
0.66
−0.0028
−1.09
1.13
46.2
0.055
0.99775
11962.3
30.35
26.06
−2.99
0.62
−0.003
−0.91
1.01
44.2
0.056
0.99801
13128.3
31.0
24.94
−2.96
0.604
−0.0035
−0.71
0.86
41.7
0.0564
0.99825
14260.2
30.7
23.19
−2.19
0.58
−0.0039
−0.46
0.75
39.2
0.057
0.99848
15363.2
29.74
21.79
−1.6
0.57
−0.0042
−0.15
0.73
36.4
0.0565
0.99870
16440.2
28.25
20.2
−1.4
0.55
−0.0045
−0.62
0.81
33.4
0.053
0.99892
17492.6
26.19
18.31
−0.87
0.54
−0.0048
−1.03
0.88
30.5
0.0503
0.99913
18519.1
23.73
16.57
−0.29
0.53
−0.005
−1.01
0.93
27.5
0.0495
0.99930
19518.4
21.6
14.4
−0.33
0.52
−0.005
−0.82
0.84
24.5
0.0495
0.99944
20487.7
19.5
12.42
−0.16
0.51
−0.0058
−0.66
0.76
21.5
0.049
0.999574
21422.9
17.04
10.39
−0.07
0.5
−0.006
−0.54
0.66
18.6
0.0486
0.99968
22319.2
14.62
8.83
−0.15
0.49
−0.006
−0.42
0.59
15.6
0.0479
0.999768
23171.8
12.0
6.82
0.028
0.48
−0.006
−0.33
0.45
12.7
0.0471
0.999838
23975.6
9.27
4.92
−0.05
0.47
−0.007
−0.24
0.32
9.64
0.0463
0.999891
24726.5
6.32
3.42
0.17
0.46
−0.007
−0.16
0.23
6.51
0.0455
0.999926
25421.5
3.03
1.43
−0.004
0.46
−0.007
−0.08
0.086
3.13
0.0449
0.999943


#### 4.2.2. Numerical Computing of nominal Trajectory

Nominal trajectory loaded on the onboard computer is discrete values with rangex as argument. In application standard value of state variables is acquired by interpolation to the nominal trajectory, and the error between standard value and real value will cause predictive error. Adding rows of nominal trajectory to reduce the range interval is an effective way to improve the predictive accuracy.Figure9 shows the results of prediction with different rows of nominal trajectory, when using nominal trajectory as disturbance trajectory. The downrange predictive results change as half sinusoid, and the period is just the sampling period, which means that at the sampling point the predictive error is 0. The bigger the sampling period is, the bigger the predictive error is. When the rows reach 75, the downrange error is less than 0.8 m, and the lateral error is less than 0.1 m, whereas, it just occupies no more than 5 k of RAM.Figure 9
Predictive results with different rows of nominal trajectory.
(a)
Downrange predictive results
(b)
Cross range predictive results


### 4.3. Fading Memory Filter

GPS receiver has measurement error and will cause predictive error. So a filter is necessary to work in the loop to reduce error. Here second-order fading memory filter is taken, and the algorithm is as follows:(34)ΔL^n=ΔL^n-1+ΔL.^n-1Ts+GΔLΔLn∗-ΔL^n-1+ΔL.^n-1Ts,ΔL.^n=ΔL.^n-1+HΔLTsΔLn∗-ΔL^n-1+ΔL.^n-1Ts,HΔL=1-βΔL2,GΔL=1-βΔL2.DL^n and DL^n-1 are estimated values of the variable at the current and last instant, ΔLn∗ is the measurement value, DL.^n and DL.^n-1 are estimated values of first- and second-order derivatives, Ts is sampling instant, βΔL is gain factor, and HΔL and GΔL are gain coefficients.The filter results of the predictive deviation are shown in Figure10, and the results meet the requirements.Figure 10
Results of second-order fading memory filter.
(a)
Downrange filter results
(b)
Cross range filter results


### 4.4. Prediction Accuracy

As is mentioned above, the unguided trajectory whose elevation is 45 deg is used as nominal trajectory, and the trajectory whose elevation is in the neighborhood of 45 deg is used as the disturbance trajectory. Here trajectory with elevation being 45.5 deg is the disturbance trajectory, and its impact point deviation is a constant, as is shown in Figure11. Downrange predictive result reflects the real deviation before adding GPS errors, and the predictive error is not more than 2 m. After adding GPS errors, the downrange predictive results also can meet the accuracy requirement. For lateral prediction, till 40 s the convergence of prediction is got, and the results are aligned with the lateral deviation. Figure 11 presents that the lateral prediction results can describe the deviation; just the errors are a little big, but still not more than 15 m.Figure 11
Results of second-order fading memory filter when fire elevation is 45.5 deg.
(a)
Downrange filter results
(b)
Cross range filter resultsImpact point deviation prediction based on perturbation theory for spin-stabilized projectiles has high prediction accuracy and has small calculation amounts. It is suitable for application on the trajectory correction fuze.


## 4.1. Impact Point Prediction Based on Perturbation Theory

X
0
x
0
,
y
0
,
z
0 and XTxT,yT,zT are the positions of the gun and target, respectively. Given the muzzle velocity, the trajectory impacting the target can be acquired definitely. For unguided projectiles the trajectory is the only one, because the range of elevation of the gun is restricted, and the trajectory is called nominal trajectory. Define XT=Φx,y,z,vx,vy,vz to be function of nominal trajectory, with x as argument and vx,vy,vz,y,z as state variables.During flight disturbances always exit, and the projectile deflects from nominal trajectory, which causes the impact point deviation. Define the impact point of flight path influenced by disturbances to beXImxIm,yIm,zIm. If XIm is close to target XT, perturbation theory can be used to predict the impact point. Xx,y,z is any point on nominal trajectory, and XIm can be derived using Taylor expansion:(31)xIm=xT+∂Φx∂vx,∂Φx∂vy,∂Φx∂vz,∂Φx∂y,∂Φx∂z·Δvx,Δvy,Δvz,Δy,ΔzT+RxX,V,zIm=zT+∂Φz∂vx,∂Φz∂vy,∂Φz∂vz,∂Φz∂y,∂Φz∂z·Δvx,Δvy,Δvz,Δy,ΔzT+RzX,V.Δvx,Δvy,Δvz,Δy,Δz are disturbance magnitudes of state variables when range of the projectile is x, whereas RxX,V and RzX,V are Lagrange remainders. If Taylor expansion meets the accuracy requirement, that is to say, the absolute values of RxX,V and RzX,V are smaller than the given value, (30) can be used to predict the impact point deviation, so we get(32)DL=xIm-xT=∂Φx∂vx,∂Φx∂vy,∂Φx∂vz,∂Φx∂y,∂Φx∂z·Δvx,Δvy,Δvz,Δy,ΔzT,DH=zIm-zT=∂Φz∂vx,∂Φz∂vy,∂Φz∂vz,∂Φz∂y,∂Φz∂z·Δvx,Δvy,Δvz,Δy,ΔzT.DL andDHare the downrange and lateral deviation of the impact point.When using this method, note the following.(1)
The impact pointXIm should be close to the target XT, and the disturbance magnitudes should not be big ones.(2)
Predictive accuracy should meet requirements.


## 4.2. Numerical Method and Application

X
T
=
Φ
x
,
y
,
z
,
v
x
,
v
y
,
v
z is an implicit function. Taking analytic method to study the predictive accuracy is very hard, while numerical method is a useful way. Numerical method is taken in this paper, and application of partial derivative, nominal trajectory is researched.In order to predict the deviation in real time, the guidance system needs to acquire the information of velocity and position; at the same time it should get the partial derivatives and disturbance magnitudes. In application, partial derivatives and nominal trajectory are loaded on the onboard computer prior to flight. The information of velocity and position can be acquired by global position system (GPS) receiver, or inertial measurement unit (IMU). The projectile mentioned above takes GPS receiver.The unguided trajectory whose elevation is 45 deg is used as nominal trajectory, and the trajectory whose elevation is in the neighborhood of 45 deg is used as the disturbance trajectory. The advantage is that the impact point deviation is the same value along the trajectory.


### 4.2.1. Numerical Computing of Partial Derivatives

Finite difference method is invoked here. Take∂Φx/∂vx and ∂Φz/∂vx as example. Add disturbance Δvx on the state variable vx of any point on the nominal trajectory, and the impact point Xδxδ,yδ,zδ is got. It gives(33)∂Φx∂vx=xδ-xTΔvx,∂Φz∂vx=zδ-zTΔvx.The second and third order partial derivatives are also computed like this.Here velocity step and position step are defined, which are velocity and position disturbance. In this part, how to select the velocity step, position step, and order of the Taylor expansion is presented. Select the trajectory whose elevation is 45.5 deg as disturbance trajectory.The predictive results of downrange deviation using first and second-order partial derivatives are shown in Figure7, when velocity step and position step are 2 m-s−1 and 5 m, and rows of partial derivatives and nominal trajectory are 20 and 75, respectively. Compared with result of first order, result of second-order has big amplitude, and the convergence is slow. So first order partial derivatives is preferred.Figure 7
Predictive results with different order partial derivatives.Figure8 shows the predictive results with different velocity steps and position steps, when rows of partial derivatives and nominal trajectory are 20 and 75, respectively. When position step is 5 m, results are almost the same. But when velocity step is given as 2 m-s−1, results have big difference after range reaches 22 km. That is because the impact point is far away from the target, since magnitude of position step is too big. Here we select that velocity step and position step are 2 m-s−1 and 5 m.Figure 8
Predictive results with different velocity and position step.Table1 shows twenty rows of partial derivatives of nominal trajectory, and values of each line are almost liner. Simulation results show that selecting 20 rows is suitable, since adding rows will not improve the accuracy of prediction.Table 1
Partial derivatives.
Range
∂
Φ
x
/
∂
v
x
∂
Φ
x
/
∂
v
y
∂
Φ
x
/
∂
v
z
∂
Φ
x
/
∂
y
∂
Φ
x
/
∂
z
∂
Φ
z
/
∂
v
x
∂
Φ
z
/
∂
v
y
∂
Φ
z
/
∂
v
z
∂
Φ
z
/
∂
y
∂
Φ
z
/
∂
z
5146.29
26.41
26.48
−4.4
1.18
−0.0013
−0.31
1.25
47.98
0.069
0.99658
6707.75
27.53
25.95
−4.45
1.04
−0.0017
−0.57
1.26
48.6
0.0689
0.99688
8144.93
27.8
25.87
−4.06
0.86
−0.0021
−0.84
1.26
48.38
0.062
0.99718
9487
27.7
25.74
−3.59
0.71
−0.0024
−1.05
1.22
47.5
0.055
0.99747
10753.4
28.7
26.12
−3.33
0.66
−0.0028
−1.09
1.13
46.2
0.055
0.99775
11962.3
30.35
26.06
−2.99
0.62
−0.003
−0.91
1.01
44.2
0.056
0.99801
13128.3
31.0
24.94
−2.96
0.604
−0.0035
−0.71
0.86
41.7
0.0564
0.99825
14260.2
30.7
23.19
−2.19
0.58
−0.0039
−0.46
0.75
39.2
0.057
0.99848
15363.2
29.74
21.79
−1.6
0.57
−0.0042
−0.15
0.73
36.4
0.0565
0.99870
16440.2
28.25
20.2
−1.4
0.55
−0.0045
−0.62
0.81
33.4
0.053
0.99892
17492.6
26.19
18.31
−0.87
0.54
−0.0048
−1.03
0.88
30.5
0.0503
0.99913
18519.1
23.73
16.57
−0.29
0.53
−0.005
−1.01
0.93
27.5
0.0495
0.99930
19518.4
21.6
14.4
−0.33
0.52
−0.005
−0.82
0.84
24.5
0.0495
0.99944
20487.7
19.5
12.42
−0.16
0.51
−0.0058
−0.66
0.76
21.5
0.049
0.999574
21422.9
17.04
10.39
−0.07
0.5
−0.006
−0.54
0.66
18.6
0.0486
0.99968
22319.2
14.62
8.83
−0.15
0.49
−0.006
−0.42
0.59
15.6
0.0479
0.999768
23171.8
12.0
6.82
0.028
0.48
−0.006
−0.33
0.45
12.7
0.0471
0.999838
23975.6
9.27
4.92
−0.05
0.47
−0.007
−0.24
0.32
9.64
0.0463
0.999891
24726.5
6.32
3.42
0.17
0.46
−0.007
−0.16
0.23
6.51
0.0455
0.999926
25421.5
3.03
1.43
−0.004
0.46
−0.007
−0.08
0.086
3.13
0.0449
0.999943


### 4.2.2. Numerical Computing of nominal Trajectory

Nominal trajectory loaded on the onboard computer is discrete values with rangex as argument. In application standard value of state variables is acquired by interpolation to the nominal trajectory, and the error between standard value and real value will cause predictive error. Adding rows of nominal trajectory to reduce the range interval is an effective way to improve the predictive accuracy.Figure9 shows the results of prediction with different rows of nominal trajectory, when using nominal trajectory as disturbance trajectory. The downrange predictive results change as half sinusoid, and the period is just the sampling period, which means that at the sampling point the predictive error is 0. The bigger the sampling period is, the bigger the predictive error is. When the rows reach 75, the downrange error is less than 0.8 m, and the lateral error is less than 0.1 m, whereas, it just occupies no more than 5 k of RAM.Figure 9
Predictive results with different rows of nominal trajectory.
(a)
Downrange predictive results
(b)
Cross range predictive results


## 4.2.1. Numerical Computing of Partial Derivatives

Finite difference method is invoked here. Take∂Φx/∂vx and ∂Φz/∂vx as example. Add disturbance Δvx on the state variable vx of any point on the nominal trajectory, and the impact point Xδxδ,yδ,zδ is got. It gives(33)∂Φx∂vx=xδ-xTΔvx,∂Φz∂vx=zδ-zTΔvx.The second and third order partial derivatives are also computed like this.Here velocity step and position step are defined, which are velocity and position disturbance. In this part, how to select the velocity step, position step, and order of the Taylor expansion is presented. Select the trajectory whose elevation is 45.5 deg as disturbance trajectory.The predictive results of downrange deviation using first and second-order partial derivatives are shown in Figure7, when velocity step and position step are 2 m-s−1 and 5 m, and rows of partial derivatives and nominal trajectory are 20 and 75, respectively. Compared with result of first order, result of second-order has big amplitude, and the convergence is slow. So first order partial derivatives is preferred.Figure 7
Predictive results with different order partial derivatives.Figure8 shows the predictive results with different velocity steps and position steps, when rows of partial derivatives and nominal trajectory are 20 and 75, respectively. When position step is 5 m, results are almost the same. But when velocity step is given as 2 m-s−1, results have big difference after range reaches 22 km. That is because the impact point is far away from the target, since magnitude of position step is too big. Here we select that velocity step and position step are 2 m-s−1 and 5 m.Figure 8
Predictive results with different velocity and position step.Table1 shows twenty rows of partial derivatives of nominal trajectory, and values of each line are almost liner. Simulation results show that selecting 20 rows is suitable, since adding rows will not improve the accuracy of prediction.Table 1
Partial derivatives.
Range
∂
Φ
x
/
∂
v
x
∂
Φ
x
/
∂
v
y
∂
Φ
x
/
∂
v
z
∂
Φ
x
/
∂
y
∂
Φ
x
/
∂
z
∂
Φ
z
/
∂
v
x
∂
Φ
z
/
∂
v
y
∂
Φ
z
/
∂
v
z
∂
Φ
z
/
∂
y
∂
Φ
z
/
∂
z
5146.29
26.41
26.48
−4.4
1.18
−0.0013
−0.31
1.25
47.98
0.069
0.99658
6707.75
27.53
25.95
−4.45
1.04
−0.0017
−0.57
1.26
48.6
0.0689
0.99688
8144.93
27.8
25.87
−4.06
0.86
−0.0021
−0.84
1.26
48.38
0.062
0.99718
9487
27.7
25.74
−3.59
0.71
−0.0024
−1.05
1.22
47.5
0.055
0.99747
10753.4
28.7
26.12
−3.33
0.66
−0.0028
−1.09
1.13
46.2
0.055
0.99775
11962.3
30.35
26.06
−2.99
0.62
−0.003
−0.91
1.01
44.2
0.056
0.99801
13128.3
31.0
24.94
−2.96
0.604
−0.0035
−0.71
0.86
41.7
0.0564
0.99825
14260.2
30.7
23.19
−2.19
0.58
−0.0039
−0.46
0.75
39.2
0.057
0.99848
15363.2
29.74
21.79
−1.6
0.57
−0.0042
−0.15
0.73
36.4
0.0565
0.99870
16440.2
28.25
20.2
−1.4
0.55
−0.0045
−0.62
0.81
33.4
0.053
0.99892
17492.6
26.19
18.31
−0.87
0.54
−0.0048
−1.03
0.88
30.5
0.0503
0.99913
18519.1
23.73
16.57
−0.29
0.53
−0.005
−1.01
0.93
27.5
0.0495
0.99930
19518.4
21.6
14.4
−0.33
0.52
−0.005
−0.82
0.84
24.5
0.0495
0.99944
20487.7
19.5
12.42
−0.16
0.51
−0.0058
−0.66
0.76
21.5
0.049
0.999574
21422.9
17.04
10.39
−0.07
0.5
−0.006
−0.54
0.66
18.6
0.0486
0.99968
22319.2
14.62
8.83
−0.15
0.49
−0.006
−0.42
0.59
15.6
0.0479
0.999768
23171.8
12.0
6.82
0.028
0.48
−0.006
−0.33
0.45
12.7
0.0471
0.999838
23975.6
9.27
4.92
−0.05
0.47
−0.007
−0.24
0.32
9.64
0.0463
0.999891
24726.5
6.32
3.42
0.17
0.46
−0.007
−0.16
0.23
6.51
0.0455
0.999926
25421.5
3.03
1.43
−0.004
0.46
−0.007
−0.08
0.086
3.13
0.0449
0.999943


## 4.2.2. Numerical Computing of nominal Trajectory

Nominal trajectory loaded on the onboard computer is discrete values with rangex as argument. In application standard value of state variables is acquired by interpolation to the nominal trajectory, and the error between standard value and real value will cause predictive error. Adding rows of nominal trajectory to reduce the range interval is an effective way to improve the predictive accuracy.Figure9 shows the results of prediction with different rows of nominal trajectory, when using nominal trajectory as disturbance trajectory. The downrange predictive results change as half sinusoid, and the period is just the sampling period, which means that at the sampling point the predictive error is 0. The bigger the sampling period is, the bigger the predictive error is. When the rows reach 75, the downrange error is less than 0.8 m, and the lateral error is less than 0.1 m, whereas, it just occupies no more than 5 k of RAM.Figure 9
Predictive results with different rows of nominal trajectory.
(a)
Downrange predictive results
(b)
Cross range predictive results


## 4.3. Fading Memory Filter

GPS receiver has measurement error and will cause predictive error. So a filter is necessary to work in the loop to reduce error. Here second-order fading memory filter is taken, and the algorithm is as follows:(34)ΔL^n=ΔL^n-1+ΔL.^n-1Ts+GΔLΔLn∗-ΔL^n-1+ΔL.^n-1Ts,ΔL.^n=ΔL.^n-1+HΔLTsΔLn∗-ΔL^n-1+ΔL.^n-1Ts,HΔL=1-βΔL2,GΔL=1-βΔL2.DL^n and DL^n-1 are estimated values of the variable at the current and last instant, ΔLn∗ is the measurement value, DL.^n and DL.^n-1 are estimated values of first- and second-order derivatives, Ts is sampling instant, βΔL is gain factor, and HΔL and GΔL are gain coefficients.The filter results of the predictive deviation are shown in Figure10, and the results meet the requirements.Figure 10
Results of second-order fading memory filter.
(a)
Downrange filter results
(b)
Cross range filter results


## 4.4. Prediction Accuracy

As is mentioned above, the unguided trajectory whose elevation is 45 deg is used as nominal trajectory, and the trajectory whose elevation is in the neighborhood of 45 deg is used as the disturbance trajectory. Here trajectory with elevation being 45.5 deg is the disturbance trajectory, and its impact point deviation is a constant, as is shown in Figure11. Downrange predictive result reflects the real deviation before adding GPS errors, and the predictive error is not more than 2 m. After adding GPS errors, the downrange predictive results also can meet the accuracy requirement. For lateral prediction, till 40 s the convergence of prediction is got, and the results are aligned with the lateral deviation. Figure 11 presents that the lateral prediction results can describe the deviation; just the errors are a little big, but still not more than 15 m.Figure 11
Results of second-order fading memory filter when fire elevation is 45.5 deg.
(a)
Downrange filter results
(b)
Cross range filter resultsImpact point deviation prediction based on perturbation theory for spin-stabilized projectiles has high prediction accuracy and has small calculation amounts. It is suitable for application on the trajectory correction fuze.


## 5. Process of Guidance and Control

For the spin-stabilized projectile mentioned above, the onboard GPS receiver gets the velocity and position information of the real trajectory every 0.1 s and then onboard computer samples the information, predicts impact point deviation, generates command signal, and controls the actuator to make the correction part steady at a setting angle to correct the real trajectory, which is also a disturbance trajectory, as is shown in Figure12. The key points are the command signal generation and strategy of guidance and control.Figure 12
Process of guidance and control.


### 5.1. Command Signal Generation

The objective of correction control is changing the state variables to make the predictive derivation 0 to realize impacting the target precisely, by adjusting the roll angle of steering canards mounted on the correction part. As correction control mechanism is studied in Section3, the pivotal problem to be researched is the relationship between changes of state variables and impact point derivation.As is shown in Table1, factors influencing predictive derivation are velocity and position deviations between the real trajectory and nominal trajectory, which are described in the gound launch frame. The dominating factors of downrange derivation are velocity components deviations on the x-axis and y-axis, and position components deviation on the y-axis, whereas the lateral dominating factors are velocity components deviations on the x-axis and z-axis, and position components deviation on the z-axis. But the changes caused by correction control, called correction values, are presented in the quasi body frame, and they are velocity and position components on the y4-axis and z4-axis, which are defined as Δvy4,Δvz4,Δy4, and Δz4. They need to be transformed and presented in the ground launch frame:(35)ΔvxΔvyΔvz=cos⁡φcos⁡ψsin⁡φcos⁡ψ-sin⁡ψ-sin⁡φcos⁡φ0cos⁡φsin⁡ψsin⁡φsin⁡ψcos⁡ψ0Δvy4Δvz4≈cos⁡φsin⁡φ0-sin⁡φcos⁡φ00010Δvy4Δvz4,ΔxΔyΔz=cos⁡φcos⁡ψsin⁡φcos⁡ψ-sin⁡ψ-sin⁡φcos⁡φ0cos⁡φsin⁡ψsin⁡φsin⁡ψcos⁡ψ0Δy4Δz4≈cos⁡φsin⁡φ0-sin⁡φcos⁡φ00010Δy4Δz4.Δvx,Δvy,Δvz,Δx,Δy, and Δz are correction values presented in ground launch frame. Δx will be neglected, since it is small. Correction control is to make the real trajectory approach nominal trajectory to reduce the predictive derivation by correction values.DL andDH are the predictive impact point deviations of downrange and lateral direction. As is shown in Figure 13, the direction of xD-axis and zD-axis is downrang and lateral direction, respectively. Vector TXim is the predictive derivation, and angle between the vector and zD-axis is (36)ϕD=arctan⁡DLDH.The direction of swerve response for correction control is the opposite direction of ϕD; that is(37)ϕR=-ϕD=-arctan⁡DLDH.Since phase lag ϕd exits, the command signal can be computed as follows:(38)ϕC=-arctan⁡DLDH-ϕd=arctan⁡DLDH+π-ϕd.Figure 13
Sketch map of predictive derivation.


### 5.2. Control Strategy

As expected, Figure14 indicates that control authority decreases with the control instant delay, from when the correction part is set at the given roll angle till the projectile impacts the ground. If correction control begins with 30 s, the largest downrange correction authority from far to target is about 260 m, and from near to target is about 300 m, whereas the lateral correction authority is about 260 m.Figure 14
Correction authority.As is mentioned in Section5, the predictive derivations have high accuracy after 40 s, and the lateral derivation has predictive errors before 40 s, but it can still reflect the sign of the lateral derivation, which means that from the predictive derivation we can know the predictive impact point is on left or right of the target. Here the control strategy is divided into two segments: in ascending segment only lateral correction is invoked, while comprehensive correction is conducted in descending segment. The command signals in the two segments are shown as follows:In ascending segment(39)ϕC=90-ϕz,ifDH<-Sz,ϕC=-90-ϕz,ifDH>Sz.In descending segment(40)ϕC=arctan⁡DLDH+π-ϕd.


### 5.3. Simulation Results

#### 5.3.1. Simulation of the Control Trajectory

In order to validate the effectiveness of the control strategy simulation of control trajectory was conducted with the elevation being 44 deg. From Figures15 and 16, the control trajectory approaches nominal trajectory constantly and impacts the target. Figure 16 indicates that in the lateral plane the control trajectory traverses the nominal trajectory twice. Figures 15 and 16 validate the effectiveness of the control strategy.Figure 15
Range versus altitude.Figure 16
Range versus cross range.Figure17 presents the result of predictive impact point deviation, and it shows that the two curves are close in upon the target in general trend. There is no gyroscope installed on the guidance and control system, so there is no angular feedback. The control force makes the sideslip angle dither, as is shown in Figure 18, and the control trajectory shows a small wobble, which is reflected in Figure 17. The magnitude of sideslip angle is about 10 deg, but after that it declines, which indicates in flight the projectile is kept in stable condition.Figure 17
Predictive results.Figure 18
Sideslip angle.When an unguided projectile mentioned above is fired, range and cross range are all smaller than the two of nominal trajectory, and the downrange deviation takes the dominating part. So the phase angle of swerve response needs to be set in the neighborhood of 0 deg to correct the trajectory. Since phase lag exits, command angle should be set at the position ahead the phase angle of swerve response, as is shown in Figure19.Figure 19
Curve of command angle.


#### 5.3.2. Results of Monte Carlo Targeting

Adding all kinds of disturbances, as is shown in Table2, such as winds, muzzle velocity perturbation, and errors of launching elevation angle, miss distances without guidance and control are shown in Figure 20, which indicates that downrange miss distance is bigger than the lateral one. When guidance and control are taken, the miss distance is much smaller, and CEP is not more than 30 m. Simulation results show that control strategy based on impact point derivation prediction proposed in this paper is suitable for trajectory correction of this class of spin-stabilized projectile.Table 2
Disturbance parameters.
Parameter
Unit
Deviation value
Mass
kg
±0.5
Length
mm
±5
Moment of inertia
%
±4
Muzzle velocity
m/s
±5
Launching elevation angle
deg
±0.06
Launching azimuth angle
deg
±0.02
Wind velocity
m/s
±2
Wind direction
deg
±15Figure 20
Results of Monte Carlo targeting.


## 5.1. Command Signal Generation

The objective of correction control is changing the state variables to make the predictive derivation 0 to realize impacting the target precisely, by adjusting the roll angle of steering canards mounted on the correction part. As correction control mechanism is studied in Section3, the pivotal problem to be researched is the relationship between changes of state variables and impact point derivation.As is shown in Table1, factors influencing predictive derivation are velocity and position deviations between the real trajectory and nominal trajectory, which are described in the gound launch frame. The dominating factors of downrange derivation are velocity components deviations on the x-axis and y-axis, and position components deviation on the y-axis, whereas the lateral dominating factors are velocity components deviations on the x-axis and z-axis, and position components deviation on the z-axis. But the changes caused by correction control, called correction values, are presented in the quasi body frame, and they are velocity and position components on the y4-axis and z4-axis, which are defined as Δvy4,Δvz4,Δy4, and Δz4. They need to be transformed and presented in the ground launch frame:(35)ΔvxΔvyΔvz=cos⁡φcos⁡ψsin⁡φcos⁡ψ-sin⁡ψ-sin⁡φcos⁡φ0cos⁡φsin⁡ψsin⁡φsin⁡ψcos⁡ψ0Δvy4Δvz4≈cos⁡φsin⁡φ0-sin⁡φcos⁡φ00010Δvy4Δvz4,ΔxΔyΔz=cos⁡φcos⁡ψsin⁡φcos⁡ψ-sin⁡ψ-sin⁡φcos⁡φ0cos⁡φsin⁡ψsin⁡φsin⁡ψcos⁡ψ0Δy4Δz4≈cos⁡φsin⁡φ0-sin⁡φcos⁡φ00010Δy4Δz4.Δvx,Δvy,Δvz,Δx,Δy, and Δz are correction values presented in ground launch frame. Δx will be neglected, since it is small. Correction control is to make the real trajectory approach nominal trajectory to reduce the predictive derivation by correction values.DL andDH are the predictive impact point deviations of downrange and lateral direction. As is shown in Figure 13, the direction of xD-axis and zD-axis is downrang and lateral direction, respectively. Vector TXim is the predictive derivation, and angle between the vector and zD-axis is (36)ϕD=arctan⁡DLDH.The direction of swerve response for correction control is the opposite direction of ϕD; that is(37)ϕR=-ϕD=-arctan⁡DLDH.Since phase lag ϕd exits, the command signal can be computed as follows:(38)ϕC=-arctan⁡DLDH-ϕd=arctan⁡DLDH+π-ϕd.Figure 13
Sketch map of predictive derivation.


## 5.2. Control Strategy

As expected, Figure14 indicates that control authority decreases with the control instant delay, from when the correction part is set at the given roll angle till the projectile impacts the ground. If correction control begins with 30 s, the largest downrange correction authority from far to target is about 260 m, and from near to target is about 300 m, whereas the lateral correction authority is about 260 m.Figure 14
Correction authority.As is mentioned in Section5, the predictive derivations have high accuracy after 40 s, and the lateral derivation has predictive errors before 40 s, but it can still reflect the sign of the lateral derivation, which means that from the predictive derivation we can know the predictive impact point is on left or right of the target. Here the control strategy is divided into two segments: in ascending segment only lateral correction is invoked, while comprehensive correction is conducted in descending segment. The command signals in the two segments are shown as follows:In ascending segment(39)ϕC=90-ϕz,ifDH<-Sz,ϕC=-90-ϕz,ifDH>Sz.In descending segment(40)ϕC=arctan⁡DLDH+π-ϕd.


## 5.3. Simulation Results

### 5.3.1. Simulation of the Control Trajectory

In order to validate the effectiveness of the control strategy simulation of control trajectory was conducted with the elevation being 44 deg. From Figures15 and 16, the control trajectory approaches nominal trajectory constantly and impacts the target. Figure 16 indicates that in the lateral plane the control trajectory traverses the nominal trajectory twice. Figures 15 and 16 validate the effectiveness of the control strategy.Figure 15
Range versus altitude.Figure 16
Range versus cross range.Figure17 presents the result of predictive impact point deviation, and it shows that the two curves are close in upon the target in general trend. There is no gyroscope installed on the guidance and control system, so there is no angular feedback. The control force makes the sideslip angle dither, as is shown in Figure 18, and the control trajectory shows a small wobble, which is reflected in Figure 17. The magnitude of sideslip angle is about 10 deg, but after that it declines, which indicates in flight the projectile is kept in stable condition.Figure 17
Predictive results.Figure 18
Sideslip angle.When an unguided projectile mentioned above is fired, range and cross range are all smaller than the two of nominal trajectory, and the downrange deviation takes the dominating part. So the phase angle of swerve response needs to be set in the neighborhood of 0 deg to correct the trajectory. Since phase lag exits, command angle should be set at the position ahead the phase angle of swerve response, as is shown in Figure19.Figure 19
Curve of command angle.


### 5.3.2. Results of Monte Carlo Targeting

Adding all kinds of disturbances, as is shown in Table2, such as winds, muzzle velocity perturbation, and errors of launching elevation angle, miss distances without guidance and control are shown in Figure 20, which indicates that downrange miss distance is bigger than the lateral one. When guidance and control are taken, the miss distance is much smaller, and CEP is not more than 30 m. Simulation results show that control strategy based on impact point derivation prediction proposed in this paper is suitable for trajectory correction of this class of spin-stabilized projectile.Table 2
Disturbance parameters.
Parameter
Unit
Deviation value
Mass
kg
±0.5
Length
mm
±5
Moment of inertia
%
±4
Muzzle velocity
m/s
±5
Launching elevation angle
deg
±0.06
Launching azimuth angle
deg
±0.02
Wind velocity
m/s
±2
Wind direction
deg
±15Figure 20
Results of Monte Carlo targeting.


## 5.3.1. Simulation of the Control Trajectory

In order to validate the effectiveness of the control strategy simulation of control trajectory was conducted with the elevation being 44 deg. From Figures15 and 16, the control trajectory approaches nominal trajectory constantly and impacts the target. Figure 16 indicates that in the lateral plane the control trajectory traverses the nominal trajectory twice. Figures 15 and 16 validate the effectiveness of the control strategy.Figure 15
Range versus altitude.Figure 16
Range versus cross range.Figure17 presents the result of predictive impact point deviation, and it shows that the two curves are close in upon the target in general trend. There is no gyroscope installed on the guidance and control system, so there is no angular feedback. The control force makes the sideslip angle dither, as is shown in Figure 18, and the control trajectory shows a small wobble, which is reflected in Figure 17. The magnitude of sideslip angle is about 10 deg, but after that it declines, which indicates in flight the projectile is kept in stable condition.Figure 17
Predictive results.Figure 18
Sideslip angle.When an unguided projectile mentioned above is fired, range and cross range are all smaller than the two of nominal trajectory, and the downrange deviation takes the dominating part. So the phase angle of swerve response needs to be set in the neighborhood of 0 deg to correct the trajectory. Since phase lag exits, command angle should be set at the position ahead the phase angle of swerve response, as is shown in Figure19.Figure 19
Curve of command angle.


## 5.3.2. Results of Monte Carlo Targeting

Adding all kinds of disturbances, as is shown in Table2, such as winds, muzzle velocity perturbation, and errors of launching elevation angle, miss distances without guidance and control are shown in Figure 20, which indicates that downrange miss distance is bigger than the lateral one. When guidance and control are taken, the miss distance is much smaller, and CEP is not more than 30 m. Simulation results show that control strategy based on impact point derivation prediction proposed in this paper is suitable for trajectory correction of this class of spin-stabilized projectile.Table 2
Disturbance parameters.
Parameter
Unit
Deviation value
Mass
kg
±0.5
Length
mm
±5
Moment of inertia
%
±4
Muzzle velocity
m/s
±5
Launching elevation angle
deg
±0.06
Launching azimuth angle
deg
±0.02
Wind velocity
m/s
±2
Wind direction
deg
±15Figure 20
Results of Monte Carlo targeting.


## 6. Conclusions

Guidance and control strategy for a class of spin-stabilized projectile with 2D trajectory correction fuze is presented in this paper. Based on correction control mechanism study, control strategy using impact point derivation prediction based on perturbation theory is proposed. Simulation results show that the strategy designed is suitable for this class of projectiles, and the miss distance is reduced effectively.



---

*Source: 908304-2015-08-11.xml*