Abstract

This paper presents a computational impact angle control guidance law based on the energy cost weighted by arbitrary functions in order to shape the acceleration command as desired. The optimal guidance problem is established in the impact angle frame and is solved by the Gauss orthogonal collocation method. The proposed guidance law is formulated from the generalized optimal control framework, thus a new guidance law that allows achieving a specific guidance goal can be easily obtained in the way of devising a proper weighting function (smooth, piecewise, nonsmooth, or even discontinuous). This property provides more degrees of freedom in the guidance law design to accomplish a specified guidance objective. A hardware experiment is conducted to evaluate the real-time computational capacity of the proposed computational guidance law. Illustrative examples with several types of weighting functions, including smooth, piecewise, nonsmooth, and discontinuous functions, are provided to demonstrate the advantages and capacity of the proposed guidance law.

1. Introduction

The main goal of designing a guidance law for an interception missile is to obtain a minimum miss distance with respect to a given target. However, to enhance the effect of kill probability, modern tactical missiles are expected not only to intercept the target but also to achieve a desired terminal impact angle [13]. Driven by these practical needs, intercept angle control guidance laws have been growing rapidly and become an important research topic.

In literature, a variety of guidance laws based on modern control theory have been devised to impose desired impact angle constraint, such as optimal guidance laws [48], sliding mode guidance laws [912], three-dimensional guidance laws [1316], and L2 gain-based guidance law [17]. It is known that the guidance laws based on optimal control theory can not only impose optimality in some particular performance indexes such as control effort and miss distance but also handle the terminal constraints easily. Therefore, a variety of efficient guidance laws have been widely reported using optimal control theory. Kim and Grider [18] proposed a suboptimal guidance law for reentry vehicles with a constraint on the body attitude angle at impact, where the guidance problem was formulated as a linear quadratic problem. By solving the energy minimization optimal control problem, Ryoo et al. [19] presented an optimal guidance law with impact angle constraints for both the lag free and the first-order missile systems. Therein, three methods of calculating the time-to-go using to construct the closed form of guidance command were also proposed. An optimal guidance law for impact angle control was developed in [20] for antitank and antiship missiles against maneuvering targets. To improve the survivability and effectiveness of missiles as much as possible, an optimal control based guidance law was proposed in [21] to control impact time and impact angle. By analyzing the dynamics of time-to-go error and introducing an impact time controller, an impact angle and time control guidance law is proposed along the corresponding time-to-go estimation. Based on flight model construction, Zhu et al. [22] presented a cruising guidance law with impact time and angle control, in which the time-to-go estimation is not required.

In the framework of optimal control-based guidance law design, the selection of the cost function is an important issue because the response of state variables and the guidance performance are affected by the cost function. To shape the missile’s trajectory and thus accomplish some specified guidance objectives, various weighted optimal guidance laws with impact angle constraint have been developed. In [2325], a power of time-to-go function was adopted to weight the energy cost function, by which the robustness of the guidance law to external disturbances at the end of the homing phase was improved. For aerodynamically maneuvering ground-to-air missiles, an exponential function was employed for the weighting function of the energy cost in [26], where the penalty for late maneuvers was higher than for earlier ones, and thus the acceleration demand was distributed to compensate for the loss of aerodynamic maneuvering. Similarly, exponential weighting functions were suggested in [27] to shape guidance commands for surface-to-air missiles against high-speed incoming targets. An optimal guidance law providing some degree of freedom to prevent command saturation was devised by Lee et al. [28]. In this study, a Gaussian function was used as a weighting function to alleviate sensitivity with respect to initial heading error. Lee et al. [29] used sinusoidal functions to weight the energy performance index and proposed new guidance laws that generate a small acceleration at both the initial and final time for a stationary or slowly moving target. Xiong et al. [30] proposed an optimal impact angle control guidance law for a missile with time-varying velocity, where the impact angle costs and miss distance were weighted by the variants of hyperbolic tangent function while the energy cost was weighted by a power of time-to-go. This guidance law can produce a small acceleration command at the initial phase of the engagement.

In such previous works, for achieving the specified guidance purpose, particular weighting functions were introduced to shape the missile’s trajectory or to distribute the acceleration demand during the engagement. Recently, generalized optimal impact angle guidance laws have been developed by using various approaches. In [31], the generalized formulations of optimal guidance laws were provided by solving optimal control problems with a generalized performance index, which showed that any positive function can be used as a weighting function. In [32], by taking into account the dynamic lag effect and the velocity variation, a more practical generalized optimal guidance law was proposed. In [33], the generalized guidance command is determined in a closed-loop feedback form by solving a linear quadratic optimal control problem with the energy consumption weighted by an arbitrary positive function. The above methods analytically studied the solution to the generalized optimal guidance problem, but mainly considered smooth weighting functions. If the weighting function can be devised arbitrarily (for instance, piecewise, nonsmooth, and discontinuous), the flexibility of guidance law design can be significantly increased. Consequently, this paper provides an alternative approach to solve optimal control problem with arbitrary weighting functions from a computational perspective. The main contributions of this paper are summarized as follows: (1)A computational optimal guidance law that has the command shaping capacity is proposed by using the collocation method. The proposed guidance law is formulated from the generalized optimal control framework and a new guidance law that allows achieving a specific guidance goal can be easily obtained by devising a proper weighting function. In addition, the proposed guidance law can be easily extended to the dynamic lag system. The real-time computational capacity of the proposed approach is evaluated on a microprocessor(2)The results presented are the first attempts in literature to introduce piecewise weighting functions. Owing to the elegant characteristics of piecewise functions, several guidance operational goals, such as providing small acceleration command at the initial time or at the final time or both at the initial time and final time, can be easily accomplished by using one single weighting function. However, in previous studies, to accomplish the aforementioned guidance goals several distinct weighting functions are required to designed specifically(3)The proposed guidance has the capacity to easily tackle piecewise, nonsmooth, and discontinuous weighting functions, which can provide more degrees of freedom in the guidance law design to accomplish a specified guidance objective. Therefore, hybrid functions that consist of different forms of functions during different guidance phases can be considered for the weighting function of energy cost, which can take advantages of various weighting functions during the entire guidance process and thus hold the potential to significantly enhance the guidance performance

This paper is organized as follows. The engagement kinematics and problem formulation of optimal guidance law are described in Section 2. The derivation of optimal guidance law is presented in Section 3. Section 4 presents the hardware experiment and numerical simulation results. Conclusions are presented in Section 5.

2. Problem Formulation

Consider the engagement geometry for a stationary or a slowly moving target shown in Figure 1. In this geometry, M and T denote the missile and target, respectively. , , and denote the velocity, flight path angle, and normal acceleration of the missile, respectively. and represent the line-of-sight (LOS) angle and desired impact angle, respectively. The coordinate system denotes the inertial reference frame, while the coordinate system represents the impact angle frame. The frame is fixed with the target and is rotated from by the desired impact angle . and denote the fight path angle of missile and LOS angle in the impact angle frame TXfYf and are expressed as

It’s seen from Equation (1) that can be regarded as the impact angle error. From Figure 1, the equations of motion for the engagement in impact angle frame are given by. where represents the lateral distance perpendicular to the desired impact direction. Under the assumption that is constant and is small, Equation (2) can be linearized as

From Equation (3), the linearized engagement kinematics can be rewritten in a compact form as follows where

Note that the linearized kinematics (4) has been widely implemented to devise guidance laws with various constraints in many literatures [19, 24, 28, 29, 31, 32].

It can be seen from Figure 1 that if the missile velocity vector coincides with the axis , namely, and , then the impact angle interception will be guaranteed. Therefore, the terminal constraint for an interception and impact angle control are given by where denotes the final time of engagement. Now, consider the following finite-time optimal control problem: determine the control that minimizes the cost function subject to Equation (4).

Here, is the initial time of engagement, is a positive definite matrix and is used to control the terminal states of the missile, is a weighting function. Note that, to guarantee the impact angle interception, the value of the matrix should be selected as large as possible.

3. Derivation of Optimal Guidance Law

3.1. Optimal Solution Using the Gauss Orthogonal Collocation Method

In this section, the Gauss orthogonal collocation method is taken to solve the finite-time optimal control problem as shown in Equation (7). The Hamiltonian function of the optimal control problem is where denotes the costate and satisfies the following adjoint equation with the transversality condition

From the minimum principle, it is necessary that which yields the following optimal control

Substituting Equation (12) into Equation (4), and combining with the adjoint Equation (9) yields the following two-point boundary-value problem (TPBVP)

To implement the Gauss orthogonal collocation method, the time interval in Equation (13) should be transformed to . By using the following affine transformation

Equation (13) can be transformed into

The Gauss orthogonal collocation method to solve the optimal control problem Equation (7) is to discretize and transcribe the two-point boundary-value problem into a set of algebraic equations by approximating the state and costate trajectories via interpolating polynomials. The state is approximated using a basis of Lagrange interpolating polynomials, where are defined as

Note that the boundary point, -1, and the Gauss points, , are used to construct the approximation of . Differentiating the expression in Equation (16) gives

Because the initial value of is unknown, whereas the terminal value of is known and given by

Therefore, the Gauss points, , and the boundary point, 1, are used to construct the approximation of as follows where () are defined as

Differentiating the expression in Equation (20) gives

The terminal value of the state, , can be obtained in terms and via the Gauss quadrature [34]. where are the Gaussian weights and can be calculated offline. Substituting Equation (23) into Equation (19) yields

Denote , , , and ; Substituting Equation (24) into Equation (22) and including Equation (18) yields where and .

As proven in [35], the differential approximation matrices, , , , and have the following relationships:

The elements of the differential approximation matrix can be determined offline by

Consequently, the elements of the matrices , , and can be obtained offline via Equation (26).

Denote , . Equation (25) can be rewritten as where and is an zero matrix, is an identity matrix. By denoting and , Equation (28) can be expressed into the following compact form

Solving for and in Equation (35) gives the solution to the two-point boundary-value problem (15) as

From (36) the costate at the Gauss points can be directly determined from the initial state value . However, the Gauss points do not contain the boundary points, therefore, Equation (36) cannot provide the initial value of the costate, . Because the terminal value of the costate, , is given in (24), therefore, can be calculated via the following Gauss quadrature [34].

According to Equations (12), (36), and (37), the optimal control at the boundary points as well as the Gauss points is obtained as

It is very important to note that the preceding derivation does not impose any constraint on and the form of the equations are identical for , , and , indicating that the proposed method can easily and directly handle different and complex weighting functions without any modification. This property makes the guidance law design very flexible to accomplish the specified objective. In other words, arbitrary positive function can be used as a weighting function, thus the penalty for maneuvers can be adjusted accordingly by tuning the shape of the weighting function in order to achieve some specific guidance objective. In addition, it should be also noted that in our method, the optimal control is obtained without any explicit integration or construction of transition matrices, but only by solving algebraic equations.

3.2. Guidance Law Implementation

Note that the optimal solution obtained in Section 3.1 is open-loop for the guidance problem. To obtain the closed-loop solution, the receding-horizon technique is implemented. The receding-horizon length is chosen as the time-to-go (i.e., the time remaining to interception, and denoted as ), which is approximated by . Consequently, the final time of engagement can be expressed as . The procedure for implementing the proposed guidance law with impact angle constraint can be summarized as follows. (1)Initial number of the Gauss points, , and set (2)Solve the sequence of TPBVP (a)Calculate the time-to-go, (b)Calculate the matrices and , and solve Equation (36).(c)Update the control () using the solution from step 2b and Equation (38).(3)Apply the control input at the current time at the first discretization point, , to the missile’s dynamics and update the missile’s states at the next time(4)Repeat steps 2-3 until intercepting the target

For complex weighting functions, the proposed method can easily obtain the optimal control via solving a set of algebraic equations and does not require any explicit propagation techniques (e.g. the backward sweep method). In addition, the derivation of the proposed guidance law does not rely on the concrete form of the weighting function, such that arbitrary positive function can be used as a weighting function. We will show later that complex weighting functions (smooth, piecewise, nonsmooth, and even discontinuous) can be easily employed in the proposed guidance law.

4. Hardware Experiment and Simulation Results

In this section, we will first evaluate the real-time computational capacity of the proposed guidance law, and then demonstrate its guidance performance under various weighting functions. The homing conditions for the simulations are given in Table 1.

4.1. Evaluation of Real-Time Computational Capacity

To assess the time-consuming property and the real-time computational capacity of the proposed guidance law, a hardware experimental platform based on the ARM Cortex-M7 processor is addressed in this section. The guidance law is performed on a STM32 Nucleo-F767ZI development board. The hardware experimental platform is shown in Figure 2. The microcontroller (STM32F767ZIT6U) used in the development board is based on the high-performance ARM Cortex-M7 32-bit RISC core operating at up to 216 MHz frequency, and features a floating-point unit (FPU) which supports ARM double-precision and single-precision processing instructions. To implement the guidance law on the hardware platform, the STM32Cube MX software is used to generate the HAL-based embedded project of IAR compiler. All the matrix operations needed in the guidance law are carried out using the corresponding C functions provided by CMSIS DSP library, which is a built-in suite of common signal processing functions.

In the test, the compiler’s code optimization of IAR is turned on and off, respectively, while the mode of single-precision FPU is turned on all the time. Table 2 summarizes the computation time of the proposed guidance law in one computation loop. It is seen that the computation time increases as the discretization point increases. The compiler optimization for the embedded code is helpful to reduce the computation time. By turning on the compiler optimization mode of IAR and selecting a proper number of discretization points, the computational time can be reduced to a satisfactory level, which means the proposed guidance law is computationally viable for onboard implementation. In addition, it is expected that the computation time will be further reduced by using other high performance processors (for instance, DSP and FPGA).

4.2. Performance of the Proposed Guidance Law

In this subsection, numerical examples are performed to illustrate the performance of the proposed guidance law. The initial conditions for the following simulation scenarios are listed in Table 1. In these simulations, five different types of weighting functions, including continuous, piecewise, nonsmooth, and discontinuous functions, are employed to demonstrate the capacity and the performance of the proposed guidance law. The number of the Gauss points, , is selected to be 15. is chosen to be [, ]T.

4.2.1. Case 1: Gaussian and Sinusoidal Weighting Functions

In this case, we take the Gaussian weighting function and the sinusoidal weighting function, which were originally presented in [28, 29], as an example to demonstrate that the proposed guidance law has the capacity to tackle existing weighting functions easily. The Gaussian weighting function and the sinusoidal weighting function are as follows:

is adopted to shape the specific guidance command: introducing a small acceleration at the initial time. While is adopted to shape the specific guidance command: introducing a small acceleration at the initial and final time. In this case, we set as for . The profiles of and are shown in Figure 3. As can be seen, the weighting profile of approaches zero values at the initial time, while the weighting profile of approaches zero values at the initial time and the final time. Detailed descriptions for and can be referred to [28, 29].

For comparison purposes, the impact angle control optimal guidance law called OGL that is presented in [19] is also applied in the simulation. Figures 4 and 5 show the intercept trajectories and guidance commands for various weighting functions. The proposed approach can easily tackle the Gaussian weighting function and the sinusoidal weighting function, and successfully provide zero miss distance with the desired impact angle for all cases as shown in Figures 4(a) and 5(a). The guidance commands are clearly shaped by different weighting functions as shown in Figures 4(b) and 5(b). Specifically, the command of OGL approaches a nonzero value at both the initial and final time. This profile may result in an abrupt change of guidance command at the initial time and a performance degradation at the final time under the presences of external disturbances. However, the Gaussian weighting generates a small acceleration command at the initial time compared with OGL, while the sinusoidal weighting function always generates zero initial command and also converges to a zero value as the missile approaches a target. These properties can improve the guidance command, alleviating sensitivity with respect to initial heading error, or improving the lethality of the warhead and guaranteeing operational margin to cope with external disturbances in the vicinity of target. The above results are consistent with the analyses in [28, 29]. Since the proposed guidance law is formulated from the generalized optimal control framework, the existing weighting functions (e.g., Gaussian and sinusoidal) can be easily incorporated into the proposed approach for achieving various guidance goals.

4.2.2. Case 2: Sigmoid-Based Weighting Function

In this case, we constructed a new kind of piecewise weighting function based on the sigmoid function as where are designed parameters. According to selections of the designed parameters (i.e., ), various weighting profiles can be generated. Table 3 provides three kind of combinations of , and the corresponding profiles of are shown in Figure 6.

As seen in Figure 6, can be utilized to shape the specific guidance command: providing small acceleration command at the initial time () or at the final time () or both at the initial and final time () by simply tuning the parameters . As can be seen, by adopting a piecewise function, the guidance objectives of the Gaussian weighting function and the sinusoidal weighting function can be easily achieved by using a single weighting function .

Figure 7 shows the intercept trajectories and guidance commands for with different parameters as listed in Table 3. As shown in Figure 7(a), the proposed guidance law can successfully provide zero miss distance with the desired impact angle for all cases. In Figure 7(b), the guidance command provided by the proposed guidance law is flexibly shaped by simply tuning the designed parameters (i.e., ) of . requires small acceleration demands at the final time, which is desired for ensuring the acceleration margin to cope with unanticipated circumstances at the terminal phase. requires small acceleration demands at the initial time, which is desired for alleviating the sensitivity against the initial heading error and is helpful for smooth guidance handover from a midcourse phase to a homing phase. While can simultaneously satisfy both recommended guidance properties of and .

The intercept trajectories and guidance commands for various initial flight path angles with the desired impact angle as under the weighting functions , , and are depicted in Figures 810. The simulation results show that although the proposed method is derived in the linear system equations, it can be applied to nonlinear engagement cases with a wide range of initial flight path angle sets. In addition, different guidance objectives can be clearly observed with different weighting functions.

The profile of can be further shaped by tuning parameters and as illustrated in Figure 11. The corresponding intercept trajectories and guidance commands are illustrated in Figure 12. As can be seen, the duration of the achieved small guidance command at the initial and final time decrease as decreases, meanwhile the energy expenditure in the middle portion of the engagement decreases. Therefore, for practical guidance applications there is a tradeoff between the energy expenditure and the requirement of small acceleration command in the initial and final phase of the engagement. In addition, through appropriate choices in the design parameters, and , the missile’s trajectory and command profile can be further shaped as desired.

The above simulations show that the proposed method can provide various shapes of the guidance command according to appropriate choices of the weighting functions. Most importantly, our method does not need to make any modifications for each new weighting function. This advantage provides more degrees of freedom in the guidance law design with specified guidance objectives. We will show that the proposed guidance law can easily consider nonsmooth or even discontinuous weighting functions in the following cases.

4.2.3. Case 3: Nonsmooth Weighting Function

In this case, we construct a nonsmooth weighting function that consists of a sigmoid function and a Gaussian function as

By selecting the designed parameters as and , the profile of is illustrated in Figure 13. As shown in Figure 13, the weighting function of is expected to provide small acceleration demands at the initial time and the final time, which is similar to and . However, different from and , is nonsmooth at . This kind of nonsmooth weighting function has not been discussed in previous studies. The main purpose that we design this weighting function is to assess the capacity of the proposed guidance in solving complex weighting functions.

Figures 14 and 15 show the engagement trajectories and guidance commands for the OGL and the proposed guidance law weighted by . Although the weighting function is nonsmooth, the proposed guidance can also successfully satisfy the terminal constraints for interception as provided in Figures 14(a) and 15(a). From Figures 14(b) and 15(b), the guidance commands of the proposed guidance law start from small values and also converge to small values as the missile approaches the target. These simulation results are similar to those for and , since the profile of is similar to those of and . It can be seen from the above results that the proposed guidance is able to handle nonsmooth weighting functions easily, which provides more degrees of freedom in the design of weighting functions.

4.2.4. Case 4: Discontinuous Weighting Function

In this case, we take a discontinuous weighting function as an example to further demonstrate the capacity of the proposed guidance in solving complex weighting functions. The discontinuous weighting function is chosen as

The profile of is shown in Figure 16. is a switching function and is discontinuous at and . This kind of weighting function has not been considered in previous studies. Simulation results are depicted in Figures 17 and 18. As can be seen, the guidance law can successfully provide zero miss distance with the desired impact angle for all cases. However, due to discontinuities in the weighting function, abrupt command changes are occurred during the engagement. From a practical standpoint, the discontinuous function (43) may not be a good candidate for the design of weighting function. However, this case is mainly used to validate the capacity of the proposed guidance law, and has demonstrated that the proposed guidance can handle the discontinuous weighting function easily. This property makes it possible to design different weighting functions in different engagement phases in order to achieve some specific guidance operational goals, which provides a huge degree of freedom in shaping guidance commands. By using the proposed approach, a new guidance law that allows achieving a specific guidance goal can be easily obtained by devising a proper weighting function (smooth, nonsmooth, or even discontinuous).

4.2.5. Case 5: Extension to the First-Order Lag System

Although the proposed guidance law is derived for the lag-free missile system in Section 3, our approach can be easily extended to handle the guidance problem with dynamic lag effect. Suppose that the missile autopilot model is a first-order delay system: where and denote the guidance command and autopilot time delay constant, respectively. Consequently, for the first-order lag missile system, the whole derivation in Section 3 does not require any modification but simply set Equation (5) as , , , and . Then the corresponding matrix is chosen to be [, , 0]T. Figure 19 provides the guidance performance of the proposed guidance law to the first-order lag system for the weighting function with the initial flight path angle as and the desired impact angle as . From this figure, we observe that the proposed guidance law can successfully intercept the target for all cases and there is a time delay between the command and response.

5. Conclusions

In this paper, a new computational impact angle control homing guidance law is investigated based on the energy cost weighted by arbitrary functions (smooth, nonsmooth, or even discontinuous), which has the command shaping capacity as desired. By virtue of the Gauss orthogonal collocation method, the optimal control is obtained by solving a set of algebraic equations. The real-time computational capacity of the proposed guidance law is evaluated on a microprocessor. Several types of weighting functions, including smooth, piecewise, nonsmooth, and discontinuous functions, have been tested to evaluate the capacity of the proposed guidance law. Simulation results show that the proposed guidance law can provide various shapes of the guidance command according to appropriate choices of the weighting functions. In addition, profiting from the adoption of a piecewise function, the guidance command shape that provides small acceleration demands at the initial phase, or at the terminal phase, or both at the initial and terminal phases can be easily achieved by using the proposed approach with just one single weighting function. The proposed guidance law is formulated from the generalized optimal control framework and a new guidance law that allows achieving a specific guidance goal can be easily obtained by devising a proper weighting function (smooth, nonsmooth, or even discontinuous), providing more degrees of freedom in the guidance law design with specified guidance goals.

Data Availability

The data that support the findings of this study are available from the corresponding author upon reasonable request.

Conflicts of Interest

The authors declared no potential conflicts of interest with respect to the research, authorship, and/or publication of this article.

Acknowledgments

This research has been supported by the Natural Science Foundation of Jiangsu Province (No. BK20200498) and the National Natural Science Foundation of China (No. 52202475).