Research Article  Open Access
A ThreeDimensional Cooperative Guidance Law Based on Consensus Theory for Maneuvering Targets
Abstract
In this paper, a cooperative guidance law based on consensus theory is proposed for multiple flight vehicles against a maneuvering target in a threedimensional plane. The proposed guidance law has three orientation components: the one along the lineofsight (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 finitetime convergence disturbance observer (FTDOB) and are compensated into the kinematic equation to achieve more accurate interception. Using the Lyapunov stability theorem, timetogo 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 twodimensional 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 twodimensional 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 openloop cooperative guidance law. On the basis of these studies, the authors in literature [11] propose a twolevel cooperative guidance architecture for multiflight 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 closedloop cooperative guidance laws or only focus on stationary targets or are established in a twodimensional plane; motivated by this, a closedloop cooperative guidance law for incepting maneuvering targets in a threedimensional plane is proposed in this paper based on multiagent consensus theory. A kinematic equation between the flight vehicle and target in a threedimensional 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 timetogo information with each other to accomplish closedloop 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 threedimensional 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.
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 threedimensional 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 .
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 timetogo of them should reach agreement. The th flight vehicle’s timetogo 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 timetogo 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 singleinput–singleoutput (SISO) system as follows:where is the state variable, is the control variable, and represents uncertainty. Assume that is nth differentiable and satisfies , . The uncertainty in system (16) is estimated by a FTDOB in [15] shown aswhere 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 finitetime stable, which means there exists a time constant making for all .
3. ThreeDimensional 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 finitetime 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’ timetogo reaches agreement.
On the basis of the finitetime 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’ timetogo 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 timetogo of all flight vehicles can reach agreement in finite time.
Differentiating (21) to time, there isFrom (22) there is(23) can be rewritten asLet ; from Lemma 1, there is As , there isIn (26), is the algebraic connectivity of graph , and is larger than zero when is connected; (19) can then be expressed aswhere . 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 secondorder FTDOB is applied to estimate the target maneuverings in system (31). It can be constructed asand 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 timetogo 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 .
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.

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 vehiclestotarget 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 timetogo curves versus time. At the beginning, they are greatly different which is consistent with distance difference. Flight vehicle 1 has maximal impact time and timetogo 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.
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 timetogo converges uniformly in around 4s. The target maneuvering can be estimated accurately.
5. Conclusions
Based on multiagent consensus theory, the paper designs a guidance law for cooperative attack which accomplishes a simultaneous arrival in a threedimensional 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 timetogo 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. View at: Publisher Site  MathSciNet
 M. H. Degroot, “Reaching a consensus,” Journal of the American Statistical Association, vol. 69, no. 345, pp. 118–121, 1974. View at: Publisher Site  Google Scholar
 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. View at: Google Scholar
 J. Wohletz, “Cooperative, dynamic mission control for uncertain, multivehicle autonomous systems,” in Proceedings of the IEEE Conference on Decision and Control, pp. 1–10, 2002. View at: Google Scholar
 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. View at: Google Scholar
 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. View at: Google Scholar
 P. Zarchan, “Tactical and strategic missile guidance,” in Progress in Astronautics and Aeronautics, vol. 157, AIAA, Washington, DC, USA, 1994. View at: Google Scholar
 I.S. Jeon, J.I. Lee, and M.J. Tahk, “Impacttimecontrol guidance law for antiship missiles,” IEEE Transactions on Control Systems Technology, vol. 14, no. 2, pp. 260–266, 2006. View at: Publisher Site  Google Scholar
 I. Jeon and J. Lee, “Impacttimecontrol guidance law with constraints on seeker look angle,” IEEE Transactions on Aerospace and Electronic Systems, vol. 53, no. 10, pp. 2621–2627, 2017. View at: Publisher Site  Google Scholar
 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. View at: Publisher Site  Google Scholar
 S. Zhao and R. Zhou, “Cooperative guidance for multimissile salvo attack,” Chinese Journal of Aeronautics, vol. 21, no. 6, pp. 533–539, 2008. View at: Publisher Site  Google Scholar
 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. View at: Publisher Site  Google Scholar  MathSciNet
 R. OlfatiSaber and R. M. Murray, “Consensus problems in networks of agents with switching topology and timedelays,” IEEE Transactions on Automatic Control, vol. 49, no. 9, pp. 1520–1533, 2004. View at: Publisher Site  Google Scholar  MathSciNet
 S. P. Bhat and D. S. Bernstein, “Continuous finitetime stabilization of the translational and rotational double integrators,” IEEE Transactions on Automatic Control, vol. 43, no. 5, pp. 678–682, 1998. View at: Publisher Site  Google Scholar  MathSciNet
 A. Levant, “Higherorder sliding modes, differentiation and outputfeedback control,” International Journal of Control, vol. 76, no. 910, pp. 924–941, 2003. View at: Publisher Site  Google Scholar  MathSciNet
 V. Garber, “Optimum intercept laws for accelerating targets,” AIAA Journal, vol. 6, no. 11, pp. 2196–2198, 1968. View at: Publisher Site  Google Scholar
Copyright
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.