Mathematical Problems in Engineering
Volume 2019 (2019), Article ID 2120745, 11 pages
https://doi.org/10.1155/2019/2120745

Research Article

A Three-Dimensional Cooperative Guidance Law Based on Consensus Theory for Maneuvering Targets

Wenjie Zhang,¹ Xiao Du,² and Qunli Xia¹

¹School of Aerospace Engineering, Beijing Institute of Technology, Beijing 100081, China
²China Academy of Launch Vehicle Technology, Beijing 100076, China

Correspondence should be addressed to Qunli Xia; 1010@bit.edu.cn

Received 27 April 2019; Accepted 25 June 2019; Published 2 July 2019

Academic Editor: Francesco Conte

Copyright © 2019 Wenjie Zhang et al. This is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.

Abstract.

In this paper, a cooperative guidance law based on consensus theory is proposed for multiple flight vehicles against a maneuvering target in a three-dimensional plane. The proposed guidance law has three orientation components: the one along the line-of-sight (LOS) ensures that all flight vehicles reach the target simultaneously, and the other two normal to the LOS in longitudinal and lateral plane guarantee the accurate interception. The target maneuverings are estimated by a finite-time convergence disturbance observer (FTDOB) and are compensated into the kinematic equation to achieve more accurate interception. Using the Lyapunov stability theorem, time-to-go of all flight vehicles’ convergence is proved. Mathematical simulations verify the effectiveness of the proposed cooperative guidance law.

1. Introduction

Consensus theory has an early application in computer science [1]. Recent years, with the development of cooperative guidance, it has been gradually applied to aircrafts. Multiagent systems have huge potential in various applications such as path planning, penetrating, and intercepting [2–6].

Nowadays defense systems have been equipped in most of the important strategic and tactical military targets [7], so it is hard for a traditional single flight vehicle to meet the needs of warfare missions [6]. Modern warfare emphasizes systematization; the communication among different flight vehicles are required. The cooperation between different flight vehicles will enhance the overall combat capability, increase penetration capability, improve the hit probability, etc. Therefore, the research of multiagent cooperative attack has a very important engineering significance.

The core of multiple flight vehicles cooperative attack is to control the impact time consistently. The authors in literature [8] propose an impact time control guidance law (ITCG) in a two-dimensional plane; a time error feedback term is added to the traditional proportional guidance law to accomplish simultaneous arrival. The authors in literature [9] adopt a polynomial form to realize impact time control for a stationary target. A method to control impact time by adjusting proportional navigation coefficient is put forward in literature [10] for a stationary target in a two-dimensional plane. However, the method above requires giving impact time in advance and it is usually hard to get. Therefore, these kinds of methods cannot be regarded as an intelligent multiple flight vehicle cooperative guidance to some degree and they are in fact open-loop cooperative guidance law. On the basis of these studies, the authors in literature [11] propose a two-level cooperative guidance architecture for multi-flight vehicles attack; the architecture is composed of local guidance for each flight vehicle on the lower level and a coordination strategy on the upper level. The coordinate strategy can be realized by decentralized coordination and centralized coordination respectively. Then the impact time is given through the coordinate variable. Therefore there is no need to specify a time in advance. But the lower level for each missile is still using the existing ITCG and the method has certain complexities and limitations.

Actually, most of the above guidance laws are not real closed-loop cooperative guidance laws or only focus on stationary targets or are established in a two-dimensional plane; motivated by this, a closed-loop cooperative guidance law for incepting maneuvering targets in a three-dimensional plane is proposed in this paper based on multiagent consensus theory. A kinematic equation between the flight vehicle and target in a three-dimensional plane is derived and a FTDOB is used to estimate the target maneuvering and compensate in the kinematic equation for accurate interception to maneuvering targets. Through the guidance law, all flight vehicles reach agreement quickly. It is not necessary to preset an impact time, so all of them exchange time-to-go information with each other to accomplish closed-loop cooperative guidance. It is worth pointing out that if one of flight vehicles fails, the system can also work, so the proposed guidance law has strong robustness.

This paper is organized as follows: In Section 2, relative kinematic and cooperative guidance model are described in a three-dimensional coordinate system for a maneuvering target; some important definitions and lemmas are also given. In Section 3, the cooperative guidance problem of multiple flight vehicles is formulated based on consensus theory, and convergence of the system is verified. The results of mathematical simulation are shown in Section 4, and the main simulation results are discussed. Finally, the conclusions are given in Section 5.

2. Preliminary Concepts

2.1. Problem Formulation

Taking the location where multiple flight vehicles attack against a maneuvering target into consideration, the relative kinematic geometry model is shown in Figure 1. is the inertial reference coordinate system; suppose there are flight vehicles; the subscript denotes the state variable of the -th flight vehicle. represents the -th flight vehicle, and represents the target. are the relative distance and LOS angle between the -th flight vehicle and the target. denote the speed, flight path angle, and normal acceleration command of the -th flight vehicle while represent the target speed and target flight path angle.

Figure 1: Kinematic geometry.

The -th flight vehicle’s and target’s relative kinematic equation can be described as

where represents the acceleration component normal to velocity vector.

In the three-dimensional guidance space, the relative motion between -th flight vehicle and target are exhibited in Figure 2. is in the inertial reference coordinate system , and is in the LOS coordinate system . and are the LOS heading angle and LOS azimuth angle, respectively. The acceleration components of the -th flight vehicle along three orientations of LOS frame are , while for the target they are .

Figure 2: Relative motion in three-dimensional plane.

Define the relative velocity vectors between the -th flight vehicle and target as follows.

In (4), represent the velocity components along and perpendicular to the LOS of the flight vehicle in longitudinal and lateral plane, respectively. We can obtain (5) through differentiating (4) to time.

In (5), is the derivative of to time in inertial system, is the derivative of to time in LOS system, and is the rotation angular velocity of LOS system to inertial system. The following can be obtained.

Substituting (6) into (5), we can obtain the following.

By combining (7) with (4), the -th flight vehicle kinematic equation in the LOS coordinate system can be described as follows.

In a salvo attack scenario of multiple flight vehicles to a target, the time-to-go of them should reach agreement. The -th flight vehicle’s time-to-go is defined as follows.

Then there is

where is the current flight time of -th flight vehicle and is the attacking time. We can obtain (11) and (12) by differentiating (9) and (10), respectively.

To realize simultaneous arrival, each flight vehicle’s time-to-go should be controlled, the control objective is designing to make   converge to zero uniformly so that all flight vehicles attack target simultaneously.

2.2. Theoretical Basis

For multiagent system consensus study, graph theory has been widely used. In the paper, a weighted graph is used to represent the communication topology, where is the nonempty node set, the number of node is rank, and is the edge set. The weighted adjacency matrix , , where is the weight of edge from to . The graph is called an undirected graph if and only if , and , if . Otherwise, it is called a directed graph. Node is the neighbor of node ; could denote the neighbor set of node .

Lemma 1 (see [12]). If and , then there is .

Lemma 2 (see [13]). is the graph Laplacian of , which is defined by the following.

has the following properties:
(1) 0 is an eigenvalue of , and is the corresponding eigenvector.
(2) , because is semipositive definiteness, so all eigenvalues of are real and not less than zero; that is, .
(3) If is connected, the second smallest eigenvalue of , which is denoted by , is larger than zero.
(4) The algebraic connectivity of is equal to ; therefore, if .

Lemma 3 (see [14]). Consider the following system.

Suppose that there is a positive definite function which is continuous differentiable; it is defined in a neighborhood of the origin. For the appropriate real numbers and , there is ; then the system could converge to origin in finite time, and the upper bound of the convergence time is satisfied.

Consider the single-input–single-output (SISO) system as follows:

where is the state variable, is the control variable, and represents uncertainty. Assume that is n-th differentiable and satisfies , . The uncertainty in system (16) is estimated by a FTDOB in [15] shown as

where is the parameter to be designed and are the estimations of , respectively. According to the theory in [15], Lemma 4 is obtained as follows.

Lemma 4. The estimation error dynamics of FTDOB (17) are governed by the following.

In (18), , are estimation errors; they are finite-time stable, which means there exists a time constant making for all .

3. Three-Dimensional Cooperative Guidance Law Design

A salvo attack cooperative guidance law for a maneuvering target is designed in this subsection. The -th flight vehicle’s acceleration command along three orientations of LOS coordinate system are , and , respectively. is given based on the finite-time consensus theory to achieve simultaneous arrival and are given based on traditional proportional guidance law to achieve precise interception.

Firstly, we design to ensure all flight vehicles’ time-to-go reaches agreement.

On the basis of the finite-time convergence theory and multiagent consensus theory, a guidance command along LOS for -th flight vehicle is illustrated as follows.

In (19), , , is the parameter to be designed, is the desired or expected impact time, is a pining gain; if -th flight vehicle can acquire the message of the expected impact time, ; otherwise .

Theorem 5. If multiple flight vehicles’ communication topology is connected, the flight vehicles’ time-to-go will reach agreement through (19).

Proof. is the impact time error; the error dynamics can be written as follows.

Construct the Lyapunov function as follows.

It can be known for proper and , will reach zero in finite time according to Lemma 3, which illustrates that time-to-go of all flight vehicles can reach agreement in finite time.
Differentiating (21) to time, there is

From (22) there is

(23) can be rewritten as

Let ; from Lemma 1, there is

As , there is

In (26), is the algebraic connectivity of graph , and is larger than zero when is connected; (19) can then be expressed as

where . Thus, according to Lemma 3, will reach zero in finite time.

The convergence of the guidance law along LOS is proved. Another important assignment is to design acceleration command normal to LOS; this makes precise interception.
The traditional proportional navigation guidance law is adopted in longitudinal and lateral plane as follows:

where is the LOS angular rate of -th flight vehicle in longitudinal plane and is the LOS angular rate of -th flight vehicle in lateral plane.
For the estimation of target maneuverings, from (8) there is

A second-order FTDOB is applied to estimate the target maneuverings in system (31). It can be constructed as

and can be chosen as in literature [15]. The parameter is used to adjust gain to change response speed. From Lemma 4, in finite time; the target maneuverings could be estimated. Therefore, the -th flight vehicle’s kinematic equation is changed as

Remark. Equation (35) can be rewritten as

where , , ; for and , this is a kind of target maneuvering compensation based on traditional proportional guidance, like augmented proportional navigation in literature [16]. Through (35) or (36), the guidance law could accomplish accurate interception for maneuvering targets.

4. Simulation Results

In order to reveal the performance of the proposed guidance law, a salvo attack from three flight vehicles to a maneuvering target is considered in this subsection. The three attacking flight vehicles exchange time-to-go messages with each other and add them in the proposed guidance law. The communication topology between the three flight vehicles is exhibited in Figure 3, in which the communication is connected; that is, , if .

Figure 3: Communication topology.

The weighted adjacency matrix between the three flight vehicles can be obtained from Figure 3.

The initial conditions for the three flight vehicles and target are illustrated in Table 1.

Table 1: Initial parameters of flight vehicles and target.

Object
Location
Flight path angle
Velocity

(m)
(°)
(m/s)

Vehicle1
(0,6000,100)
40
300

Vehicle2
(0,3000,0)
30
300

Vehicle3
(0,1000,-100)
20
300

Target
(8000,0,0)
0
10

The parameters in the simulation are designed as , , , . , . The target acceleration components along three orientations of LOS are , , . Parameter is divided into two cases. For , the impact time of all flight vehicles is uncertain, and for , all flight vehicles fly in a designated time.

Then simulation results are obtained for .

Figures 4 and 5 display longitudinal and lateral trajectory curves of flight vehicles and target, respectively. The three flight vehicles start off from different locations, and they all hit the maneuvering target. Figure 6 shows flight vehicles-to-target distance curve versus time. At the beginning, they are diverse, flight vehicle 1 has the longest distance, and flight vehicle 3 has the shortest. Through the proposed cooperative guidance law, distances of three flight vehicles to target reach agreement and converge to zero at the same time, which means they all hit the target simultaneously; the impact time is 33.06s. Figures 7 and 8 display the flight vehicles’ impact time and time-to-go curves versus time. At the beginning, they are greatly different which is consistent with distance difference. Flight vehicle 1 has maximal impact time and time-to-go while flight vehicle 3 has the minimum ones. Through the multiagent consensus theory, they finally reach agreement in around 1.5s; the convergence rate is relatively fast. Figures 9–11 show the control command along three orientations of LOS. The command will not converge to zero for maneuvering target. Figures 12–14 display the estimation of target maneuvering; they all have a relatively accurate estimation for target maneuvering.

Figure 4: Longitudinal trajectory curves between flight vehicles and the target.

Figure 5: Lateral trajectory curves between flight vehicles and the target.

Figure 6: Flight vehicle-to-target distance curves.

Figure 7: Impact time curves of flight vehicles.

Figure 8: Time-to-go curves of flight vehicles.

Figure 9: Acceleration command curves along LOS of flight vehicles.

Figure 10: Acceleration command curves perpendicular to LOS in longitudinal plane of flight vehicles.

Figure 11: Acceleration command curves perpendicular to LOS in lateral plane of flight vehicles.

Figure 12: Estimation of target maneuvering curves along LOS.

Figure 13: Estimation of target maneuvering curves perpendicular to LOS in longitudinal plane.

Figure 14: Estimation of target maneuvering curves perpendicular to LOS in lateral plane.

For , all flight vehicles will fly in a designated time. We choose the expected impact time as ; simulation results are shown as follows.

From Figures 15–24, it can be observed that the flight vehicles also reach agreement under the designed cooperative guidance law and hit the target simultaneously in the designated time, 40s. The time-to-go converges uniformly in around 4s. The target maneuvering can be estimated accurately.

Figure 15: Longitudinal trajectory curves between flight vehicles and the target.

Figure 16: Lateral trajectory curves between flight vehicles and the target.

Figure 17: Flight vehicle-to-target distance curves.

Figure 18: Time-to-go curves of flight vehicles.

Figure 19: Acceleration command curves along LOS of flight vehicles.

Figure 20: Acceleration command curves perpendicular to LOS in longitudinal plane of flight vehicles.

Figure 21: Acceleration command curves perpendicular to LOS in lateral plane of flight vehicles.

Figure 22: Estimation of target maneuvering curves along LOS.

Figure 23: Estimation of target maneuvering curves perpendicular to LOS in longitudinal plane.

Figure 24: Estimation of target maneuvering curves perpendicular to LOS in lateral plane.

5. Conclusions

Based on multiagent consensus theory, the paper designs a guidance law for cooperative attack which accomplishes a simultaneous arrival in a three-dimensional plane for maneuvering targets. The target acceleration components along three orientations of LOS coordinate system are estimated by FTDOB, and they are compensated in the kinematic equation. The flight vehicles’ acceleration components along the LOS are designed through consensus theory. The convergence is verified by Lyapunov stability theorem. However, for the acceleration perpendicular to the LOS in longitudinal and lateral plane, the traditional proportional navigation guidance law is applied. Simulation results show that the target maneuvering estimators have a fast convergence speed, so they could estimate target maneuverings rapidly and accurately. And all flight vehicles accomplish precise interception for the maneuvering target simultaneously, and the time-to-go of them converges uniformly quickly, which demonstrates the effectiveness of the cooperative guidance law.

Data Availability

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

Conflicts of Interest

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

Acknowledgments

This work was supported in part by the Joint Equipment Fund of the Ministry of Education (No. 6141A02022340).

References

N. A. Lynch, Distributed Algorithms, Morgan Kaufman Publisher, San Francisco, Calif, USA, 1997.

M. H. Degroot, “Reaching a consensus,” Journal of the American Statistical Association, vol. 69, no. 345, pp. 118–121, 1974.

P. R. Chandler, S. Rasmussen, and M. Pachter, “UAV cooperative path planning,” in Proceedings of the AIAA Guidance, Navigation, and Control Conference and Exhibit 2000, pp. 14–17, 2000.

J. Wohletz, “Cooperative, dynamic mission control for uncertain, multi-vehicle autonomous systems,” in Proceedings of the IEEE Conference on Decision and Control, pp. 1–10, 2002.

C. Schumacher and P. R. Chandler, “Task allocation for wide area search munitions via network flow optimization,” in Proceedings of the AIAA Guidance, Navigation, and Control Conference and Exhibit 2001, 2001.

A. Richards, J. Bellingham, M. Tillerson, and J. How, “Coordination and control of multiple UAVs,” in Proceedings of the AIAA Guidance, Navigation, and Control Conference and Exhibit 2002, 2002.

P. Zarchan, “Tactical and strategic missile guidance,” in Progress in Astronautics and Aeronautics, vol. 157, AIAA, Washington, DC, USA, 1994.

I.-S. Jeon, J.-I. Lee, and M.-J. Tahk, “Impact-time-control guidance law for anti-ship missiles,” IEEE Transactions on Control Systems Technology, vol. 14, no. 2, pp. 260–266, 2006.

I. Jeon and J. Lee, “Impact-time-control guidance law with constraints on seeker look angle,” IEEE Transactions on Aerospace and Electronic Systems, vol. 53, no. 10, pp. 2621–2627, 2017.

I.-S. Jeon, J.-I. Lee, and M.-J. Tahk, “Homing guidance law for cooperative attack of multiple missiles,” Journal of Guidance, Control, and Dynamics, vol. 33, no. 1, pp. 275–280, 2010.

S. Zhao and R. Zhou, “Cooperative guidance for multimissile salvo attack,” Chinese Journal of Aeronautics, vol. 21, no. 6, pp. 533–539, 2008.

W. Ren and R. W. Beard, “Consensus seeking in multiagent systems under dynamically changing interaction topologies,” IEEE Transactions on Automatic Control, vol. 50, no. 5, pp. 655–661, 2005.

R. Olfati-Saber and R. M. Murray, “Consensus problems in networks of agents with switching topology and time-delays,” IEEE Transactions on Automatic Control, vol. 49, no. 9, pp. 1520–1533, 2004.

S. P. Bhat and D. S. Bernstein, “Continuous finite-time stabilization of the translational and rotational double integrators,” IEEE Transactions on Automatic Control, vol. 43, no. 5, pp. 678–682, 1998.

A. Levant, “Higher-order sliding modes, differentiation and output-feedback control,” International Journal of Control, vol. 76, no. 9-10, pp. 924–941, 2003.

V. Garber, “Optimum intercept laws for accelerating targets,” AIAA Journal, vol. 6, no. 11, pp. 2196–2198, 1968.