Abstract
For a two-stage launch miniature shoulder munition steered with a laser beam riding system, the laser beam points to the target with a limited field radius and approximate straight-line spatial path; thus, the munition could not fly into the laser information field after the powered flight. The miniature munition dynamics are established firstly; then, an adaptive multiple power reachable sliding mode controller is presented and adopted to constrain both the trajectory inclination and pitch angle, which makes the munition enter the field and fly under control in the field with desired attitude angles, respectively. Considering the constraints of the incidence angle and the radius of the laser information field, an arctangent function curve is selected as the expected trajectory, and an adaptive multiple power reachable integral sliding mode guidance law is detailed, which makes the munition trajectory approach and converges to the expected curve fastly with limited acceleration. Therefore, the miniature munition flight trajectory is planned and optimized. Convergence and stability are analyzed based on the Lyapunov method. The numerical simulation against the stationary target is performed to fully demonstrate the efficacy of the proposed method.
1. Introduction
In recent years, infantry shoulder munitions are becoming smaller and lighter with the development of advanced materials and MEMS technology. In order to meet the need for urban and close combats in complex environments, various types of lightweight guided munitions have been put forward, such as Spike (U.S. Navy), Pike (Raytheon), and Spike SR (Rafael). These munitions adopt strapdown electrooptical seeker for target acquisition and guidance and enable forces to shoot-and-scoot without exposing their location. The background munition in this paper is different and adopts a laser beam riding steered (LBRS) system, which has more high guidance precision and better antijamming capability [1]. The essence of the LBRS guidance is to measure the position errors of the munition relative to the central point of the laser information field and generate command to control the munition flying along the centerline of the information field [2]. Usually, the munition should be powered during the flight envelope to maintain a stable altitude, which brings a great challenge to the miniature munition that will not enter the field during the initial two-launch stage. The typical guidance mechanism for the beam riding system generally adopts a three-point method, which has the disadvantage that the miss distance will increase because of the lag of measurement deviation error.
Aiming at the uncertainty in the guidance system, the state feedback control technology is presented in [3], and a controller based on global sliding mode control is proposed in [4] to improve the robustness and stability. Aiming at the synchronization problem of uncertain nonlinear systems, a composite nonlinear feedback control method is detailed in [5], and an adaptive global terminal sliding mode control scheme is shown in [6]. Sliding mode control- (SMC-) based guidance and control design methods can be seen in literature for its good performance in response and robustness to parameter change and disturbance [7, 8]. For intercepting a nonmaneuvering target, an optimal sliding mode guidance law is proposed combining optimal theory in [9]. For the impact angle constraint problem, an impact angle control guidance law, a finite-time convergent SMC guidance law, and guidance law considering both impact time and impact angle constraints are presented in [10–14], respectively.
In order to track the expected line-of-sight rate with uncertainty, a robust second-order SMC combined with the backstepping method is designed in [15]. A guidance law for intercepting a constant-velocity target with a desired impact angle is proposed in [16]. In [17], a guidance law based on SMC is used to intercept stationary, uniform, and maneuvering targets at the desired impact angle. In order to design an impact angle constraint terminal guidance law to improve the warhead effect of air-to-ground guided weapons in [18], a variable structure guidance law with pitch/yaw angle constraints is derived, and saturation function is introduced in the reachable guidance law to weaken the system chattering. In [19], a design scheme for integrated guidance and control (IGC) with terminal impact angle constraint based on SMC is proposed. In [20], a continuous robust impact angle constraint guidance law with finite-time convergence is adopted for maneuvering targets with unknown acceleration boundary. In [21], the SMC-based guidance law is used to adaptively control the unknown uncertainty boundary. In [22], an advanced guidance law based on the nonsingular fast terminal SMC scheme and adaptive control is analyzed. To solve the terminal interception of a maneuvering target, an adaptive integral SMC (ISMC) guidance law and the case considering terminal angle constraint are detailed in [23, 24]. Aiming at the high precise guidance problem of a hypersonic vehicle in the gliding phase, considering the complex multiconstraints and uncertainty, a guidance law based on global ISMC is discussed in [25].
Due to the radius limitation of the laser information field and the upper arc trajectory during two-stage launch, the miniature munition with LBRS guidance cannot fly into the laser information field directly at the initial flight stage; thus, the traditional three-point guidance mode is not applicable. In this paper, to overcome the limitation of the traditional LBRS guidance mechanism, based on the above research results, a novel guidance law combined SMC with adaptive multiple power reachable (AMPR) method is proposed to constrain the ballistic inclination and pitch angle and make the munition fly into the laser information field with desired attitude angles. Then, the ISMC with AMPR method is presented to shape the trajectory and approach to the desired curve. The convergence and stability are proved based on the Lyapunov stability theorem.
The remainder of this paper is organized as follows. In the second part, the munition dynamics and the expected flight trajectory are described. In the third part, the piecewise guidance law and the control command based on the adaptive multiple power reachable method and SMC method is detailed. In the fourth part, the stability analysis of the proposed guidance law is performed using the Lyapunov theorem. The simulation results and analysis are discussed in the fifth part, and the conclusion is given finally.
2. Miniature Munition Dynamics and Model
The conventional guidance strategy of the LBRS system is a three-point method; that is, the launch point, munition, and target are always kept in a straight line [26], but it is difficult to achieve for the miniature munition detailed in this paper. Considering the flight trajectory constraint, the flight inclination angle and pitch angle are selected and combined with SMC to design and optimize the guidance law for the whole flight process. The geometric relations for munition, target, and trajectory are described in Figure 1.
2.1. Start-Up and Control Conditions
According to Figure 1, the control of miniature LBRS munition is divided into two stages.
In the first stage, the judgment conditions arewhere is the effective radius of the laser information field and is the centerline height of the laser beam.
In the second stage, the guided munition flies into the laser beam and toward the target, and the judgment conditions are
2.2. Munition Dynamics
The coordinate and attitude of a theoretical miniature LRBS munition model are shown in Figure 2, where the coordinate origin is set in the center of the munition gravity, is the inertial coordinate, is the ballistic coordinate, is the munition body coordinate, and is the flight velocity coordinate; all obey the right-hand rule. The typical diameter and length of this model are 40 mm and 550 mm, respectively.
The translational dynamics of the munition can be expressed aswhere is the angle of attack (AoA), is the sideslip angle, is the ballistic inclination angle, is the ballistic declination angle, and is the velocity inclination angle. The drag , lift , and lateral force can be written as
The rotational dynamics of the munition can be written aswhere
The kinematic equation of the munition can be also written as
Derivation of Equation (8) gives
The first- and second-order derivatives for the inclination angle can be obtained from Equation (3):
Substituting Equation (4) into Equation (11):
wherewhere
Similarly, the pitch angle derivatives can be obtained from Equation (7):
Substituting both Equations (5) and (6) into Equation (16) yieldswhere
2.3. Expected Trajectory Model
Inspiring from Figure 3, an arctangent function is proposed with the form as
This curve decreases rapidly and tends to be gentle with time, where the intersection with the longitudinal axis, the descending height, and the slope of the zero point of the coordinate are determined by , , and , respectively. Thus, the shape of the curve can be shaped using different parameter sets, and the part where the positive transverse axis of arctangent function is a well choice for the terminal trajectory of the miniature LBRS munition.
The expected trajectory curve has the form below after the munition enters the laser beam:where is the initial height, is the final height to be lowered, is the initial trajectory inclination angle, and is the transverse position.
The derivatives of Equation (20) can be calculated as follows:
3. Guidance Law Design
The adaptive multiple power reachable (AMPR) method proportional differential SMC is used to constrain the angle, and the adaptive multiple power reachable integral sliding mode guidance law (AMPR-ISMGL) is used to constrain the trajectory.
3.1. Angle Constraint SMC Guidance Law
In order to make the LBRS munition fly into the laser information field at a constant angle, the inclination angle should be constrained, while the pitch angle should be also limited for small AoA. Thus, select and as the constraint.
Inspired by Reference [27], the sliding mode surface is selected aswhere for adjusting the state approaching speed, which can be determined according to the pole arrangement on the premise that the state dynamic characteristics are far less than the control loop dynamic characteristics.
The derivation expression has the form below:
To avoid the chattering, slow convergence, and unsmooth response of the traditional SMC method, an AMPR guidance law is proposed as follows:where , , , and the value of is
Due to the performance of the exponential function, Equation (24) is mainly affected by and when the system state satisfies and , respectively. When is very small, Equation (24) is mainly determined by . in Equation (25) ensures that the system adaptively changes the exponential parameters once the state satisfies or , thus yielding a faster convergence rate.
Then, the corresponding fin deflection commands can be calculated by Equation (23) and (24):where
When the munition enters the laser beam, let be equal to to suppress the AoA :
Likewise, the deflection commands and can be calculated aswhere and have the form as follows:where , , , and .
3.2. Trajectory-Keeping SMC Guidance Law
The fundamental control strategy of miniature LBRS munition is to use the AMPR-ISMGL to restrain the trajectory to approach the centerline of laser beam quickly and fly along the centerline until hitting the target.
Select the state variables and with state equation:
Then, the integral sliding mode surface is selected as
According to [28], if satisfy the Hurwitz stability criterion, the state feedback control in Equation (33) can stabilize the system for finite time, and , satisfy .
Derivation of Equation (33) gives
Substituting Equation (32) into Equation (34) obtains
Then, the guidance command is given as
Considering the practical application, the main variables in Equation (36) can be analyzed as follows. Wherein, rate , velocity , and acceleration can be directly measured by an inertial measurement unit (IMU). Position information and can be obtained by IMU navigation integration or measured directly by the onboard laser receiver; can be obtained by Equation (20). Similarly, for the variables involved in the angle constraint commands Equations (26) and (29), the ballistic inclination angle is obtained by the tangent value of the velocity component, and the rudder deflection angle can be obtained using the feedback data of the rudder system. Besides, the approaching speed is mainly determined by sliding surface coefficients , , and reaching law coefficients , , , and .
4. Stability Analysis
4.1. Proof of Existence and Accessibility
Theorem 1. For the proposed guidance law Equation (24), the system state can reach the equilibrium point under the control action.
Proof. According to the reachable law expression, the following equation holds:That is, , if and only if , there is .
According to the existence and accessibility conditions of sliding mode reachable law for continuous systems in Ref. [29], if satisfied, the designed control law is existing and reachable; that is, the system state can reach the equilibrium point under the control law Equation (24).
Lemma 2. Lyapunov stability in finite time [30]. For a continuous nonlinear system,where and is an open neighborhood set containing the origin. Given Lyapunov function and real number , that satisfies and , it makeswhere ; then, the origin of the nonlinear system is Lyapunov stable; that is, it is finite-time stable, and the time to reach the origin satisfies .
Let the Lyapunov function as :where , , , and are all positive, , .
is satisfied regardless of the value of . There is a positive constant and , so that
Considering , thus is established.
According to Lemma 2, the proposed control law can guarantee the system finite-time stability. In addition, according to Theorem 1, the sliding surface variable can converge to zero in finite time under the action of the proposed reachable law.
4.2. Stability Analysis of Guidance Law
Based on the aforementioned proof and Lyapunov stability criterion, the solved guidance and control commands can make the designed sliding mode surfaces in Equations (22) and (33) asymptotically stable and further ensure the system converges to stability during finite time in the presence of uncertainty.
Accordingly, it can be seen before the miniature LBRS munition passes through the highest trajectory point and does not enter the laser information field, its attitudes satisfy , , , . Then, when the munition flies in the laser information field until it hits the target, its attitudes satisfy , , , , .
5. Simulation Results and Analysis
The simulation conditions include the guidance parameters shown in Table 1 and the initial munition flight data shown in Table 2.
The saturation function is used instead of for smooth consideration:where is the boundary layer, .
The flight trajectory, velocity, trajectory inclination angle, and normal acceleration are shown in Figures 4 and 5. It can be seen that the trajectory inclination angle quickly approaches the set desired value after passing the highest trajectory point, and the normal acceleration converges to zero after a short oscillation.
The AoA, pitch angle, and pitch rate are shown in Figure 6. The AoA of the miniature LBRS munition is small during the unguided stage and converges to zero quickly once the pitch angle is constrained to the set value and the pitch rate converges to zero quickly, which validates the effectiveness of the proposed adaptive multiple power reachable sliding mode guidance law. The curves of pitch angle deviation and trajectory inclination deviation are shown in Figure 7.
The curves of pitch angle deviation change rate and trajectory inclination angle deviation change rate are shown in Figure 8, both of which quickly converge to zero.
In order to objectively evaluate the ballistic trajectory constraint performance of the algorithm in this paper, the proportional differential sliding mode guidance law (PDSMGL) is also simulated under the same initial conditions. The trajectory comparison curve of guided munition after entering the laser information field is shown in Figure 9. Compared with the traditional PDSMGL, the trajectory using the proposed guidance law in this paper approaches the desired trajectory faster and stably.
The curves of trajectory deviation and rate between real trajectory and desired trajectory are shown in Figure 10. It can be seen that both methods can ensure that the trajectory error tends to zero. The proposed AMPR-ISMGL in this paper has a faster response speed for large sliding mode surface error, while the oscillation near the sliding mode surface is smaller.
6. Conclusion
In this paper, a multiple-power adaptive reachable guidance law based on the SMC method is proposed for a two-stage launch miniature LBRS munition. The pitch angle and trajectory inclination angle are converged to the expectation value quickly once the munition achieves the highest trajectory point, which guarantees the munition entering the desired laser information field. During flight in the laser information field, the ballistic trajectory with the laser beam radius and the terminal parallel constraint is planned based on the arctangent curve, and an AMPR-ISMGL is detailed to shape the trajectory into the desired curve. The trajectory is smooth with deviation converging to zero at the end; compared with PDSMGL, AMPR-ISMGL has faster convergence speed and smaller oscillation, which proves that the guidance law can effectively restrain trajectory and angle. The existence and accessibility of the proposed guidance method are analyzed using the Lyapunov theorem. The simulation results validate that the presented multiple-power sliding mode guidance law is feasible for the guidance and control of the miniature guided munition.
To the best of the authors’ knowledge, there are few results of complex guidance laws for the LBRS system. Because the guidance and control time of the miniature munition system is very short, subsequent research could be focused on the optimization for guidance parameters and approaching speed, as well as the further hardware-in-loop simulation implementation.
Data Availability
There is no website with available data yet.
Conflicts of Interest
The authors declare that they have no conflicts of interest.
Acknowledgments
This work is supported in part by the National Key Research & Development Program under Grant No. 2020YFC1511705 and the National Natural Science Foundation of China under Grant No. 61801032.