Abstract

This paper proposed an optimal time-varying proportional navigation guidance law based on sequential convex programming. The guidance law can achieve the desired impact angle and impact time with look angle and lateral acceleration constraints. By treating the multiconstraints’ guidance problem as an optimization problem and changing the independent variable to linearize the problem and constraints, the original nonlinear and nonconvex problem is transformed into a series of convex optimization problem so that it can be quickly solved by sequential convex programming. Numerical simulations compared to nonlinear programming and traditional analytical guidance law demonstrate the effectiveness and efficiency of the proposed algorithm. Finally, the proposed guidance law is verified to satisfy different impact time periods and impact angle constraints.

1. Introduction

In modern warfare, the aims of guidance law are not only limited to zero miss distance interception but also required to intercept the target with a certain impact time and impact angle. Impact angle constraint at terminal interception engagement is critical for the homing missile to attack modern warships, tanks, and ballistic missiles, which can increase the effectiveness and lethality of the missile’s warhead and escape the limited defense zone of the target. Impact time constraint is important to facilitate a salvo attack against the advanced close-in weapon system (CIWS). Salvo attacks with impact time and impact angle constraints simultaneously have the advantage to effectively destroy the target.

Guidance law considering impact angle and impact time constraints has been widely studied in past decades. Optimal control theory has been implemented to solve optimal guidance law under impact time and angle constraints [13]. Kim and Zhao have converted guidance law to a polynomial form with respect to the range-to-go, and three coefficients in the polynomial are designed to control the impact time, impact angle, and zero miss distance [4, 5], respectively. Besides, the errors of impact time and angle also have been selected as sliding surface to constraint terminal impact time and angle by sliding-mode control, whereas not optimal [68]. Switched proportional navigation (PN) guidance gain also has been derived to achieve the desired impact time and angle by Harrison [9]. Based on the switched proportional navigation guidance law, Hu [8] proposed a two-stage guidance law by setting a virtual target. In the first stage, nonsingular terminal sliding-mode guidance law is employed to intercept the virtual target with a specific impact angle; then, the proportional navigation guidance law is used to get the desired impact angle. The impact time and the virtual target position are designed by an optimization routine. The optimization process is too complicated to use onboard. To simplify the solving process, He [10] designed a simple decentralized midcourse guidance law for the first stage to get the desired impact time and impact angle for the pure proportional navigation in the second stage. Chen [11] proposed a two-stage impact time constraint guidance law with field-of-view constraint; however, the impact angle is out of control. Kim and Kim [12] proposed a guidance law based on the backstepping method to control impact time with reduced seeker field-of-view constraint.

Besides the previous traditional analytical form of guidance laws, the computational guidance law has been studied in [1315]. In fields of plant entry [16, 17], spacecraft descent guidance [18, 19], rendezvous and proximity [20],orbit transfer problem [21], powered descent and landing [22], trajectory optimization [2325], etc., convex programming has been verified that it can solve nonlinear optimization problem efficiently and accurately. Liu [26] has used convex programming to derive a time-varying PN guidance law for impact angle constraint. To control impact time, Jiang [27] has imported the impact time to kinematic equations so that it can be limited as the impact angle. However, the impact time is linked to the range-to-go, which will lead the impact time to be infinite at the end of optimization engagement and cause the problem infeasible. To overcome the inherent infeasible problem, the impact time in this paper is treated as a separated variable and independent with range-to-go. Different discretization strategies are carried out to avoid the infeasible problem. In summary, the main contributions of this paper can be concluded as follows:(1)The multiconstrained guidance problem is transformed into a convex optimization problem. The differential motion equations, impact angle constraint, look angle constraint, lateral acceleration constraint, and performance index are converted to convex constraints.(2)The impact time is introduced as an independent differential equation, therefore is decoupled with the range-to-go. The flight time is discretized as equality constraints to avoid the influence of range-to-go so that it contributes to the feasibility of convex programming.(3)The sequential convex programming is proposed to calculate the optimal time-varying PN guidance law with impact time and impact angle constraints.

This paper is organized as follows. In section 2, the mathematical formulation and original optimization problem are derived. Then, the original optimization problem is converted and solved by sequential convex programming in Section 3, followed by numerical simulations in Section 4. Finally, Section 5 concludes this work.

2. Problem Formulation

The planar-engagement geometry between a missile and a stationary target is shown in Figure 1, where and denote the missile and target, respectively. is the missile and target relative distance, is the missile velocity, is the lateral acceleration perpendicular to the velocity vector, , , and denote the flight path angle, line-of-sight(LOS) angle, and look angle, respectively, and is the terminal flight path angle. The kinematic equations can be derived as follows [28]:

Note that , , and are positive if measured counterclockwise from the reference line, otherwise are negative. The proportional navigation calls for the LOS angular rate for calculating the missile lateral acceleration, that is,where in standard PN guidance law, the gain is constant. Then, the look angle can be derived as follows:

In sum, the kinematic equations of missile under the PN guidance law are given as

In contrast to the standard PN guidance law with a constant PN gain, we design a time-varying PN gain to not only satisfy all the missile physical constraints and trajectory constraints, which will be discussed later, but also minimize the energy consumption. To distinguish between the proposed PN gain and standard PN gain, the PN gain is expressed as

A general energy performance index is considered as follows for the energy optimization problem:

The physical constraints and trajectory constraints must be satisfied in the problem which includes the following:(1)Kinematics constrains: they are given in kinematic equation (4) with initial conditions , , and .(2)Field of view constraint: to accurately intercept the target, the target must be locked by the seeker during the intercept engagement. Due to the physical limitation of the seeker’s field of view, the field of view constraint is described as follows:where is an acceptable magnitude of the look angle [29,30].(3)Acceleration constraint: the maneuverability of missile is limited by the aerodynamic and physical characteristics, an the lateral acceleration is bounded aswhere is the maximum lateral acceleration.(4)Terminal constraints: to impact the target at the specified time and angle, we require , , and . The look angle is required to make sure the missile terminal velocity directly points to the target, which is equivalent to . Therefore, the terminal constraints are

According to the performance index and constrains, the optimal problem can be stated as Problem : minimize .

Subject to equations (4), (7), (8), and (9), the solution to Problem will give optimal PN guidance gain ; then, the missile lateral acceleration is . Because the precise analytical solution to this nonlinear problem is not available, computational guidance is implemented here to acquire the PN guidance gain. For practical use onboard, the numerical-solution process must be reliable and converges fast. These requirements motivate us to solve the optimization problem using the sequential second-order cone convex programming (SOCP) algorithm [31].

3. Numerical Solution by Sequential SOCP

To transform Problem into the sequential SOCP problem, the kinematic equations must be discretized as linear equations, and the integrated performance index must be discretized for numerical integration; meanwhile, all nonconvex constraints must transform into convex constraints.

First, we convert the nonlinear kinematic equation (4) into linear equations. To begin with, we set the missile and target relative distance as an independent variable instead of time . Note that is monotone decreasing due to the look angle limitation . Equation (4) can be rewritten as [26]

For simplicity, we define

Then, equation (10) becomeswhere is the state vector, and

Note that this form is still nonlinear, but it is a control-affine system, and it can be easily transformed into a linear system in [32]. The main idea of this method is partly linearized control-affine system based on small-disturbance linearization. Let be the th successful solution; then, we convert equation (13) to the following partially linearized system:where and

Besides, a trust region must be added to maintain the validity of proposed linearization:where is a constant vector, and the inequality is applied componentwise.

Next, with as the independent variable, the nonlinear performance index becomeswhere . The equivalent form of the performance index can be reformulated aswhere is a slack variable, and

Now, the performance index (18) can be linear discretization. The inequality constraint (19) can be approximated by a “lagging” technique:where .

For the nonlinear acceleration constraint in equation (8), we can approximate it withwhere . The look angle constraint in equation (7) becomes

For the time constraint, through the first equation in equation (4), we can get the derivative of with respect to as follows:

Substituting equation (11) into equation (23) yields

Finally, the terminal constraint becomes

Before the numerical solution through sequential convex programming, the kinematic equation (14) and time constraint equation (24) must be discretized by the trapezoidal rule aswhere is the discretization step length and is the discretization number.

In this problem, the kinematic equation (14) and time constraint equation (24) will be discretized at uniformly distributed discretized points in ; then, the step length is . Therefore, the kinematic equation (14) can be discretized and rearranged aswhere the coefficients are

As the same with equation (14), the time constraints can be discretized as

Besides, the performance index equation (18) is discretized as

In summary, problem can be approximated as follows: Problem : minimize equation (30), subject to equations 20)–(22, (25), (27), and (29).

This problem can be efficiently solved by convex optimization algorithm because it is a SOCP problem, which is mathematically defined in [33].

Because Problem is an approximation to Problem , sequential convex-programming is proposed here to get the solution to approach the exact solution problem . The procedures are described as follows:(1)Set . Initialize the states , , , , , and . Note that the initial states in the convex optimization algorithm need not satisfy the constraints, so we can generate by linear interpolating between the initial condition and the final condition.(2)For . Compute the -dependent parameters in equations (15), (28), and (29) using . Then, Problem can be solved with the initial states and the preceding calculated parameters. Therefore, we can get a solution .(3)Check the convergence condition:where is a prescribed tolerance value for convergency. If the preceding convergence condition is satisfied, go to step 4; otherwise, set and go to step 2.(4)The solution to Problem is found to be and .

Remarks. (1)According to equation (27), when discretizing the state equations, the parameters of the last point may be quite small or big to cause problem infeasible due to so that we can use the Euler rule instead of the trapezoidal rule at the last point.(2)The initial states need not satisfy all the constraints in Problem , but different initial states will influence the iteration times to converge in sequential convex programming. The more accurate it is to the trust region, the fewer iteration times it costs.(3)A theoretical proof of the convergence of the sequential convex programming still needs works due to the presence of various constraints and nonlinear kinematics. Lu and Liu [20] and Wang [34] provided several examples of the convergence of sequential convex programming. The numerical simulations in Section 4 show the convergence and effectiveness of the proposed algorithm.(4)The proposed method requires no time-to-go information compared to the traditional analytical optimal guidance law. The approximation error of time-to-go degrades the performance index.The schematic diagram of the proposed method is summarized in Figure 2. The main idea of this approach is to transfer the nonconvex guidance problem to a sequential SOCP problem and use sequential convex programming to solve the sequential SOCP problem until convergence to obtain the optimal time-varying proportional navigation guidance law.

4. Numerical Simulation

In this section, firstly, we will verify the convergence and effectiveness of the proposed sequential convex programming algorithm compared to a nonlinear-programming solver. Next, we will show the super performance of the proposed guidance law to the traditional analytical optimal guidance law. Finally, we will show the effectiveness of the proposed guidance law for different impact times and angles.

To begin with, we set trust region as in equation (16) and convergence condition as in equation (31). The simulations are implemented in MATLAB R2017b on a laptop computer equipped with Intel Core i5−8250 U 1.6 GHz and 8 GB RAM. Convex programming problems are solved using MOSEK [35] in CVX [36].

A vertical interception engagement of a ground-launched missile is considered as follows. The missile and target initial relative distance . The missile velocity is a constant . The initial look angle is , and the initial LOS angle is . In addition, the field of view constraint is , and lateral acceleration constraint is .

4.1. The Effectiveness of Proposed Sequential Convex Programming

In this part, we set the impact time as and impact angle as . To validate the optimality and convergence of the proposed algorithm, the independent software GPOPS [37] is selected to directly solve the original Problem .

The performance index values of the proposed algorithm in each iteration are shown in Figure 3. It indicates that the sequential algorithm converges in 9 steps with interpolation initial states for the problem. More quantitative results of the converging process are shown in Table 1. If looser tolerance is used, fewer steps will be needed for convergence. In each step, it costs about 0.3–0.5 s CPU time. In sum, the algorithm costs 4.21 s to solve Problem , while the GPOPS costs 92.31 s to solve the original Problem . The efficiency of the proposed algorithm illustrates that the proposed algorithm has the potential to use onboard.

Figure 4 presents the PN guidance gains, trajectory profiles, lateral acceleration profiles, LOS angle profiles, look angle profiles, and performance index values obtained by the proposed algorithm and GPOPS, respectively. It can be seen that the guidance gain obtained by the proposed algorithm successfully achieves the desired impact time and impact angle, furthermore, satisfies all the constraints. The very similar solution obtained by GPOPS validates the optimality of the proposed algorithm. In the last several seconds, the obtained PN guidance gain is different from GPOPS, and it may be caused by several potential reasons, such as the linearization and approximation of kinematic dynamics and different discretization strategies. The GPOPS employs the hp-adaptive Radau Pseudospectral method to approximate the kinematics. The main idea of GPOPS is to use orthogonal polynomial to approximate the control variable and states at the Legendre–Gauss–Radau points. The inherent drawback of polynomial approximation is not suitable for the nonsmooth problem. The linearization and discretization in this paper are based on the kinematics of the guidance problem. Generally speaking, the proposed method is faster than GPOPS for the guidance optimization problem and needs no initial guesses.

To further demonstrate the performance of the proposed algorithm with different initial states, we take two different initial trajectories to trigger the proposed algorithm. The initial condition 1 is the interpolation trajectory, and the initial condition 2 is the proportional navigation guidance trajectory with guidance gain 3. The initial condition 1 takes 9 steps to converge, while initial condition 2 takes 10. The look angle and LOS angle profiles of these two initial conditions are present in Figure 5. Figure 5(d) indicates that the initial trajectory of the proposed algorithm need not satisfy the constraint. The proposed algorithm relaxes the requirements for the initial trajectory.

4.2. Compared to Traditional Optimal Guidance Law

To show the difference between the proposed guidance law with the traditional analytical guidance law, numerical simulation results are compared with those obtained by a guidance law based on the optimality of error dynamics (GOED) [3]. The analytical form of the guidance law is expressed as follows:where is the time-to-go, which is estimated by the second equation, and denotes the current flight time. Note that the gain is a designed parameter that should be sufficiently large to enable a successful impact time constraint. According to the result in KIM [38], the guidance gain should be set as . The performance index of GOED is the same as equation (6). It can be seen from the simulation results in [3] that the bigger the value is selected, the larger the performance index value is obtained. Therefore, we set to get the smallest performance index value. The field of view constraint is set as .The other parameters are the same as the previous case.

The PN guidance gains, trajectory profiles, lateral acceleration profiles, LOS angle profiles, look angle profiles, and performance index values obtained by the proposed algorithm and GOED guidance law are shown in Figure 6, respectively. Obviously, both algorithms can satisfy the impact time and impact angle constraints, which mean that the two methods achieve the desired impact angle at the desired impact time. While the look angle profiles in Figure 6(e) show that the traditional GOED guidance law cannot satisfy the look angle constraint. The proposed algorithm can maintain the look angle will not exceed the maximum look angle constraint. Figure 6(c) presents the required lateral acceleration of GOED is larger than the proposed algorithm at the start of the engagement, which is caused by the error of the time-to-go estimation. The performance index values in Figure 6(f) indicate that the proposed algorithm needs less control energy than the GOED guidance law. To sum up, the proposed algorithm not only satisfies the look angle constraint but also has less energy consumption.

Compared to the traditional guidance law, the proposed optimal guidance law utilizes large computational resources to optimize the total trajectory to satisfy the constraint and increase the performance of guidance law. Therefore, it requires the missile to have sufficient computational ability onboard. The traditional guidance law is easy to realize but has to sacrifice some performance. With the development of computer science, the proposed computational guidance law will be employed to enhance the performance of guidance law.

4.3. Effectiveness of Different Impact Times and Angles

To verify the effectiveness of the proposed algorithm for different impact times and impact angles, we set the different impact times as and different impact angles as . Figure 7 shows the PN guidance gains, trajectory profiles, lateral acceleration profiles, LOS angle profiles, look angle profiles, and performance index values obtained by the proposed algorithm for different impact times. It can be seen from Figure 7(b) that the trajectory needs to be higher for a longer time to intercept the target, which leads to larger lateral acceleration to change the flight path angle and finally requires more control effort. Furthermore, the look angle constraint is satisfied in all cases. Figure 8 shows the PN guidance gains, trajectory profiles, lateral acceleration profiles, LOS angle profiles, look angle profiles, and performance index values obtained by the proposed algorithm for different impact angles. Figure 8(c) illustrates that the larger impact angle requires smaller lateral acceleration at the beginning of the engagement and requires bigger lateral acceleration at the end of the engagement to achieve the desired impact angle. The curvature of trajectory in Figure 8(b) proves that larger impact angle calls for smaller lateral acceleration at the beginning of interception engagement because the curvature of the first half trajectory changes smoothly and larger lateral acceleration at the end because of the fast curvature alters of second-half trajectory. Therefore, it results in the curvature changes of look angle, LOS angle, and performance index value during the interception engagement. In summary, the proposed algorithm can generate different PN guidance gains for achieving different impact times and impact angles under all constraints.

5. Conclusion

In this paper, a sequential convex programming algorithm is developed for time-varying PN guidance law design under impact time and impact angle constraints, as well as field-of-view and acceleration limits. This guidance problem is formulated as a nonlinear optimization problem and then as linearized and discretized to be solved by sequential convex programming. Numerical simulations are compared with GPOPS and GOED guidance law to validate the convergence and optimality of the proposed algorithm. Furthermore, simulation results prove that the proposed algorithm can generate optimal time-varying guidance law to achieve different impact times and impact angles.

Data Availability

The data used to support the findings of this study are included within the article.

Conflicts of Interest

The authors declare that there are no conflicts of interest regarding the publication of this paper.

Acknowledgments

This work was supported by the National Natural Science Foundation of China under Grant U1613225.