A Three-Dimensional Cooperative Guidance Law Based on Consensus Theory for Maneuvering Targets
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.
Consensus theory has an early application in computer science . 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 , so it is hard for a traditional single flight vehicle to meet the needs of warfare missions . 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  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  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  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  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.
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 .
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.
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
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 ). If and , then there is .
Lemma 2 (see ). 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 ). 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  shown aswhere is the parameter to be designed and are the estimations of , respectively. According to the theory in , 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 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 second-order FTDOB is applied to estimate the target maneuverings in system (31). It can be constructed asand can be chosen as in literature . 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 . 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 .
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 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.
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.
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.
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.
This work was supported in part by the Joint Equipment Fund of the Ministry of Education (No. 6141A02022340).
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, multi-vehicle 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