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

Authors: Wenjie Zhang; Xiao Du; Qunli Xia
Journal: Mathematical Problems in Engineering
 (2019)

---

## 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.


---

## Body

## 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 Section2, 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 Figure1. OXY is the inertial reference coordinate system; suppose there are n flight vehicles; the subscript ii=1,2,…,n denotes the state variable of the i-th flight vehicle. Mi represents the i-th flight vehicle, and T represents the target. ri,qi are the relative distance and LOS angle between the i-th flight vehicle and the target. Vi,θi,ai denote the speed, flight path angle, and normal acceleration command of the i-th flight vehicle while Vt,θt represent the target speed and target flight path angle.Figure 1
Kinematic geometry.Thei-th flight vehicle’s and target’s relative kinematic equation can be described as(1)r˙i=Vtcos⁡θt-qi-Vicos⁡θi-qi(2)riq˙i=Vtsin⁡θt-qi-Visin⁡θi-qi(3)θ˙i=aiViwhereai represents the acceleration component normal to velocity vector.In the three-dimensional guidance space, the relative motion betweeni-th flight vehicle and target are exhibited in Figure 2. Mixyz is in the inertial reference coordinate system oxyz, and MixLyLzL is in the LOS coordinate system oxLyLzL. qp and qy are the LOS heading angle and LOS azimuth angle, respectively. The acceleration components of the i-th flight vehicle along three orientations of LOS frame are ui=ur,iuq,iuy,i, while for the target they are w=wrwqwy.Figure 2
Relative motion in three-dimensional plane.Define the relative velocity vectors between thei-th flight vehicle and target as follows.(4)Vi=Vr,iVq,iVy,i=r˙iriq˙p,i-riq˙y,icos⁡qp,iIn (4), Vr,i,Vq,i,Vy,i 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.(5)dVidt=ω×Vi+∂Vi∂t=w-uiIn (5), dVi/dt is the derivative of Vi to time in inertial system, ∂Vi/∂t is the derivative of Vi to time in LOS system, and ω is the rotation angular velocity of LOS system to inertial system. The following can be obtained.(6)ω=0-q˙p,iq˙y,icos⁡qp,iq˙p,i0-q˙y,isin⁡qp,i-q˙y,icos⁡qp,iq˙y,isin⁡qp,i0Substituting (6) into (5), we can obtain the following.(7)r¨i-riq˙p,i2-riq˙y,i2cos2qp,i=wr-ur,iriq¨p,i+2r˙iq˙p,i+riq˙y,i2sin⁡qp,icos⁡qp,i=wq-uq,i-riq¨y,icos⁡qp,i-2r˙q˙y,icos⁡qp,i+2r˙q˙p,iq˙y,isin⁡qp,i=wy-uy,iBy combining (7) with (4), the i-th flight vehicle kinematic equation in the LOS coordinate system can be described as follows.(8)r˙iV˙r,iV˙q,iV˙y,i=Vr,iVq,i2ri+Vy,i2ri+wr-ur,i-Vr,iVq,iri-Vy,i2tan⁡qp,iri+wq-uq,i-Vr,iVy,iri-Vy,iVq,itan⁡qp,iri+wy-uy,iIn a salvo attack scenario of multiple flight vehicles to a target, the time-to-go of them should reach agreement. Thei-th flight vehicle’s time-to-go is defined as follows.(9)tgo,i=riVr,iThen there is(10)timp,i=t+tgo,iwheret is the current flight time of i-th flight vehicle and timp,i is the attacking time. We can obtain (11) and (12) by differentiating (9) and (10), respectively.(11)t˙go,i=-1+Vq,i2Vr,i2-riVr,i2ur,i+wr(12)t˙imp,i=1+t˙go,i=Vq,i2Vr,i2-riVr,i2ur,i+wrTo realize simultaneous arrival, each flight vehicle’s time-to-go should be controlled, the control objective is designingur,i to make  tgo,i 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Θ=v,ε,A is used to represent the communication topology, where v=1,2,3,…,n is the nonempty node set, the number of node is rank, and ε⊂v×v=i,j:i,j∈v is the edge set. The weighted adjacency matrix A=aij∈Rn×n, i,j=1,2,3,…,n, where aij is the weight of edge from i to j. The graph is called an undirected graph if and only if i,j∈ε⇔j,i∈ε, and aij=aji>0, aij=0 if i=j. Otherwise, it is called a directed graph. Node j is the neighbor of node i; Ni=j∈v:i,j∈ε,j≠i could denote the neighbor set of node i.Lemma 1 (see [12]).
Ifyi>0i=1,2,…,n and 0<p<1, then there is ∑i=1nyip≤∑i=1nyip.Lemma 2 (see [13]).
L A is the graph Laplacian of ΘA, which is defined by the following.(13)lij=∑k=1,k≠inaik,j=i-aijj≠i
L A has the following properties:
(1) 0 is an eigenvalue ofLA, and 1=1,1,…,1T∈Rn is the corresponding eigenvector.
(2)xTLAx=1/2∑i,j=1naijxj-xi2, because LA is semipositive definiteness, so all eigenvalues of LA are real and not less than zero; that is, 0≤λ1L<λ2L≤…≤λnL.
(3) IfΘA is connected, the second smallest eigenvalue of LA, which is denoted by λ2L, is larger than zero.
(4) The algebraic connectivity ofΘA is equal to minx≠0,1Tx=0⁡xTLAx/xTx>0; therefore, if 1Tx=0,xTLAx≥λ2LAxTx.Lemma 3 (see [14]).
Consider the following system.(14)x˙=fx,t,x∈U0⊂Rn
Suppose that there is a positive definite functionVx which is continuous differentiable; it is defined in a neighborhood of the origin. For the appropriate real numbers c>0 and 0<β<1, there is V˙x+cVβx≤0,x∈U^∖0; then the system could converge to origin in finite time, and the upper bound of the convergence time is satisfied. (15)Tx0≤V1-βx0c1-β
Consider the single-input–single-output (SISO) system as follows:(16)x˙=u+dwhere x is the state variable, u is the control variable, and d represents uncertainty. Assume that d is n-th differentiable and satisfies dn<D, D>0. The uncertainty d in system (16) is estimated by a FTDOB in [15] shown as(17)z˙0=v0+uv0=-λnL1/n+1z0-xn/n+1sgnz0-x+z1z˙1=v1v1=-λn-1L1/nz1-v0n-1/nsgnz1-v0+z2⋮z˙n-1=vn-1vn-1=-λ1L1/2zn-1-vn-21/2sgnzn-1-vn-2+znz˙n=-λ0Lsgnzn-vn-1x^=z0,d^=z1,…,d^n-1=znwhere λi>0i=1,2,…,n is the parameter to be designed and x^,d^,…d^n-1 are the estimations of x,d,…dn-1, 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.(18)σ˙0=-λnL1/n+1σ0n/n+1sgnσ0+σ1σ˙1=-λn-1L1/nσ1-σ˙0n-1/nsgnσ1-σ˙0+σ2⋮σ˙n-1=-λ1L1/2σn-1-σ˙n-21/2sgnσn-1-σ˙n-2+σnσ˙n∈-λ0Lsgnσn-σ˙n-1+-L,L
In (18), σ0=z0-x, σ1=z1-d,…,σn=zn-dn-1 are estimation errors; they are finite-time stable, which means there exists a time constant T>0 making σi=0i=1,2,…,n for all t>T.


## 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 Figure1. OXY is the inertial reference coordinate system; suppose there are n flight vehicles; the subscript ii=1,2,…,n denotes the state variable of the i-th flight vehicle. Mi represents the i-th flight vehicle, and T represents the target. ri,qi are the relative distance and LOS angle between the i-th flight vehicle and the target. Vi,θi,ai denote the speed, flight path angle, and normal acceleration command of the i-th flight vehicle while Vt,θt represent the target speed and target flight path angle.Figure 1
Kinematic geometry.Thei-th flight vehicle’s and target’s relative kinematic equation can be described as(1)r˙i=Vtcos⁡θt-qi-Vicos⁡θi-qi(2)riq˙i=Vtsin⁡θt-qi-Visin⁡θi-qi(3)θ˙i=aiViwhereai represents the acceleration component normal to velocity vector.In the three-dimensional guidance space, the relative motion betweeni-th flight vehicle and target are exhibited in Figure 2. Mixyz is in the inertial reference coordinate system oxyz, and MixLyLzL is in the LOS coordinate system oxLyLzL. qp and qy are the LOS heading angle and LOS azimuth angle, respectively. The acceleration components of the i-th flight vehicle along three orientations of LOS frame are ui=ur,iuq,iuy,i, while for the target they are w=wrwqwy.Figure 2
Relative motion in three-dimensional plane.Define the relative velocity vectors between thei-th flight vehicle and target as follows.(4)Vi=Vr,iVq,iVy,i=r˙iriq˙p,i-riq˙y,icos⁡qp,iIn (4), Vr,i,Vq,i,Vy,i 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.(5)dVidt=ω×Vi+∂Vi∂t=w-uiIn (5), dVi/dt is the derivative of Vi to time in inertial system, ∂Vi/∂t is the derivative of Vi to time in LOS system, and ω is the rotation angular velocity of LOS system to inertial system. The following can be obtained.(6)ω=0-q˙p,iq˙y,icos⁡qp,iq˙p,i0-q˙y,isin⁡qp,i-q˙y,icos⁡qp,iq˙y,isin⁡qp,i0Substituting (6) into (5), we can obtain the following.(7)r¨i-riq˙p,i2-riq˙y,i2cos2qp,i=wr-ur,iriq¨p,i+2r˙iq˙p,i+riq˙y,i2sin⁡qp,icos⁡qp,i=wq-uq,i-riq¨y,icos⁡qp,i-2r˙q˙y,icos⁡qp,i+2r˙q˙p,iq˙y,isin⁡qp,i=wy-uy,iBy combining (7) with (4), the i-th flight vehicle kinematic equation in the LOS coordinate system can be described as follows.(8)r˙iV˙r,iV˙q,iV˙y,i=Vr,iVq,i2ri+Vy,i2ri+wr-ur,i-Vr,iVq,iri-Vy,i2tan⁡qp,iri+wq-uq,i-Vr,iVy,iri-Vy,iVq,itan⁡qp,iri+wy-uy,iIn a salvo attack scenario of multiple flight vehicles to a target, the time-to-go of them should reach agreement. Thei-th flight vehicle’s time-to-go is defined as follows.(9)tgo,i=riVr,iThen there is(10)timp,i=t+tgo,iwheret is the current flight time of i-th flight vehicle and timp,i is the attacking time. We can obtain (11) and (12) by differentiating (9) and (10), respectively.(11)t˙go,i=-1+Vq,i2Vr,i2-riVr,i2ur,i+wr(12)t˙imp,i=1+t˙go,i=Vq,i2Vr,i2-riVr,i2ur,i+wrTo realize simultaneous arrival, each flight vehicle’s time-to-go should be controlled, the control objective is designingur,i to make  tgo,i 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Θ=v,ε,A is used to represent the communication topology, where v=1,2,3,…,n is the nonempty node set, the number of node is rank, and ε⊂v×v=i,j:i,j∈v is the edge set. The weighted adjacency matrix A=aij∈Rn×n, i,j=1,2,3,…,n, where aij is the weight of edge from i to j. The graph is called an undirected graph if and only if i,j∈ε⇔j,i∈ε, and aij=aji>0, aij=0 if i=j. Otherwise, it is called a directed graph. Node j is the neighbor of node i; Ni=j∈v:i,j∈ε,j≠i could denote the neighbor set of node i.Lemma 1 (see [12]).
Ifyi>0i=1,2,…,n and 0<p<1, then there is ∑i=1nyip≤∑i=1nyip.Lemma 2 (see [13]).
L A is the graph Laplacian of ΘA, which is defined by the following.(13)lij=∑k=1,k≠inaik,j=i-aijj≠i
L A has the following properties:
(1) 0 is an eigenvalue ofLA, and 1=1,1,…,1T∈Rn is the corresponding eigenvector.
(2)xTLAx=1/2∑i,j=1naijxj-xi2, because LA is semipositive definiteness, so all eigenvalues of LA are real and not less than zero; that is, 0≤λ1L<λ2L≤…≤λnL.
(3) IfΘA is connected, the second smallest eigenvalue of LA, which is denoted by λ2L, is larger than zero.
(4) The algebraic connectivity ofΘA is equal to minx≠0,1Tx=0⁡xTLAx/xTx>0; therefore, if 1Tx=0,xTLAx≥λ2LAxTx.Lemma 3 (see [14]).
Consider the following system.(14)x˙=fx,t,x∈U0⊂Rn
Suppose that there is a positive definite functionVx which is continuous differentiable; it is defined in a neighborhood of the origin. For the appropriate real numbers c>0 and 0<β<1, there is V˙x+cVβx≤0,x∈U^∖0; then the system could converge to origin in finite time, and the upper bound of the convergence time is satisfied. (15)Tx0≤V1-βx0c1-β
Consider the single-input–single-output (SISO) system as follows:(16)x˙=u+dwhere x is the state variable, u is the control variable, and d represents uncertainty. Assume that d is n-th differentiable and satisfies dn<D, D>0. The uncertainty d in system (16) is estimated by a FTDOB in [15] shown as(17)z˙0=v0+uv0=-λnL1/n+1z0-xn/n+1sgnz0-x+z1z˙1=v1v1=-λn-1L1/nz1-v0n-1/nsgnz1-v0+z2⋮z˙n-1=vn-1vn-1=-λ1L1/2zn-1-vn-21/2sgnzn-1-vn-2+znz˙n=-λ0Lsgnzn-vn-1x^=z0,d^=z1,…,d^n-1=znwhere λi>0i=1,2,…,n is the parameter to be designed and x^,d^,…d^n-1 are the estimations of x,d,…dn-1, 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.(18)σ˙0=-λnL1/n+1σ0n/n+1sgnσ0+σ1σ˙1=-λn-1L1/nσ1-σ˙0n-1/nsgnσ1-σ˙0+σ2⋮σ˙n-1=-λ1L1/2σn-1-σ˙n-21/2sgnσn-1-σ˙n-2+σnσ˙n∈-λ0Lsgnσn-σ˙n-1+-L,L
In (18), σ0=z0-x, σ1=z1-d,…,σn=zn-dn-1 are estimation errors; they are finite-time stable, which means there exists a time constant T>0 making σi=0i=1,2,…,n for all t>T.


## 3. Three-Dimensional Cooperative Guidance Law Design

A salvo attack cooperative guidance law for a maneuvering target is designed in this subsection. Thei-th flight vehicle’s acceleration command along three orientations of LOS coordinate system are ur,i,uq,i, and uy,i, respectively. ur,i is given based on the finite-time consensus theory to achieve simultaneous arrival and uq,i,uy,i are given based on traditional proportional guidance law to achieve precise interception.Firstly, we designur,i 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 fori-th flight vehicle is illustrated as follows.(19)ur,i=-Vr,i2ri∑j=1naijsigαtgo,j-tgo,i-bisigαtimp,i-timp∗In (19), sigαtgo,j-tgo,i=sgntgo,j-tgo,i·tgo,j-tgo,iα, 0<α<1, is the parameter to be designed, timp∗ is the desired or expected impact time, bi is a pining gain; if i-th flight vehicle can acquire the message of the expected impact time, bi>0; otherwise bi=0.Theorem 5.
If multiple flight vehicles’ communication topologyΘ=v,ε,A is connected, the flight vehicles’ time-to-go will reach agreement through (19).Proof.
e i = t i m p , i - t i m p ∗ is the impact time error; the error dynamics can be written as follows.(20)e˙i=t˙imp,t=∑j=1naijsigαtgo,j-tgo,i-bisigtimp,i-timp∗α
Construct the Lyapunov function as follows.(21)Vt=12∑i=1nei2
It can be known for properβ and c, Vt 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(22)V˙t=∑i=1neie˙i=∑i=1nei∑j=1naijsigαtgo,j-tgo,i-bisig⁡timp,i-timp∗α=∑i=1nei∑j=1naijsigαej-ei-bisigαei=12∑i=1nei∑j=1naijsigαej-ei+12∑i=1nei∑j=1naijsigαej-ei-∑i=1nbieiα+1=12∑i,j=1naijei-ejsigαei-ej-∑i=1nbieiα+1=-12∑i,j=1naijej-eiα+1-∑i=1nbieiα+1=-12∑i,j=1naij2/α+1ej-ei2α+1/2-∑i=1nbieiα+1≤0
From (22) there is(23)V˙t≤-12∑i,j=1,i≠jnaij2/α+1ej-ei2α+1/2≤-12∑i,j=1,i≠jnaij2/α+1ej-ei2α+1/2
(23) can be rewritten as(24)V˙t≤-12∑i,j=1,i≠jnaij2/α+1ej-ei2VtVtα+1/2
LetB=aij2/α+1∈Rn×n; from Lemma 1, there is (25)∑i,j=1,i≠jnaij2/α+1ej-ei2=2eTLBe
As1Te=0, there is(26)∑i,j=1,i≠jnaij2/α+1ej-ei2Vt=2eTLBe1/2eTe≥2λ2LBeTe1/2eTe=4λ2LB
In (26), λ2LB is the algebraic connectivity of graph ΘB, and λ2LB is larger than zero when ΘB is connected; (19) can then be expressed as(27)V˙t≤-124λ2LBVtα+1/2=-2αKα+1/2Vα+1/2twhere K=λ2LB. Thus, according to Lemma 3, Vt will reach zero in finite time.(28)Treach≤21-αV1-α/201-αKα+1/2
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:(29)uq,i=NVr,iq˙p,i,N=3(30)uy,i=NVr,iq˙y,i,N=3
whereq˙p,i is the LOS angular rate of i-th flight vehicle in longitudinal plane and q˙y,i is the LOS angular rate of i-th flight vehicle in lateral plane.
For the estimation of target maneuverings, from (8) there is (31)V˙r,i=Vq,i2ri+Vy,i2ri+wr-ur,iV˙q,i=-Vr,iVq,iri-Vy,i2tan⁡qp,iri+wq-uq,iV˙y,i=-Vr,iVy,iri-Vy,iVq,itan⁡qp,iri+wy-uy,i
A second-order FTDOB is applied to estimate the target maneuveringsw=wrwqwy in system (31). It can be constructed as(32)z˙01=v01+Vq,i2ri+Vy,i2ri-ur,iv01=-λ21L11/3z01-Vr,i2/3sgn⁡z01-Vr,i+z11z˙11=v11v11=-λ11L11/2z11-v011/2sgn⁡z11-v01+z21z˙21=-λ01L1sgn⁡z21-v11(33)z˙02=v02-Vr,iVq,iri-Vy,i2tan⁡qp,iri-uq,iv02=-λ22L21/3z02-Vq,i2/3sgn⁡z02-Vq,i+z12z˙12=v12v12=-λ12L21/2z12-v021/2sgn⁡z12-v02+z22z˙22=-λ02L2sgn⁡z22-v12(34)z˙03=v03-Vr,iVy,iri-Vy,iVq,itan⁡qp,iri-uy,iv03=-λ23L31/3z03-Vy,i2/3sgn⁡z03-Vy,i+z13z˙13=v13v13=-λ13L31/2z13-v031/2sgn⁡z13-v03+z23z˙23=-λ03L3sgn⁡z23-v13
andλi can be chosen as in literature [15]. The parameter L is used to adjust gain to change response speed. From Lemma 4, z11→wrz12→wqz13→wy in finite time; the target maneuverings could be estimated. Therefore, the i-th flight vehicle’s kinematic equation is changed as(35)V˙r,i=Vq,i2ri+Vy,i2ri+z11-ur,iV˙q,i=-Vr,iVq,iri-Vy,i2tan⁡qp,iri+z12-uq,iV˙y,i=-Vr,iVy,iri-Vy,iVq,itan⁡qp,iri+z13-uy,iRemark. Equation (35) can be rewritten as (36)V˙r,i=Vq,i2ri+Vy,i2ri+ur,i∗V˙q,i=-Vr,iVq,iri-Vy,i2tan⁡qp,iri+uq,i∗V˙y,i=-Vr,iVy,iri-Vy,iVq,itan⁡qp,iri+z13+uy,i∗where ur,i∗=-ur.i+z11, uq,i∗=uq,i-z12, uy,i∗=uy,i-z13; for uq,i∗ and uy,i∗, 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 Figure3, in which the communication is connected; that is, aij=1, if i≠j.Figure 3
Communication topology.The weighted adjacency matrix between the three flight vehicles can be obtained from Figure3. (37)A=011101110The initial conditions for the three flight vehicles and target are illustrated in Table1.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 10The parameters in the simulation are designed asα=0.5, λ0i=1.1, λ1i=1.5, λ2i=2. i=1,2,3, L=4. The target acceleration components along three orientations of LOS are wr=0.5, wq=1, wy=0.1. Parameter b is divided into two cases. For b=0, the impact time of all flight vehicles is uncertain, and for b=2, all flight vehicles fly in a designated time.Then simulation results are obtained forb=0.Figures4 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.Forb=2, all flight vehicles will fly in a designated time. We choose the expected impact time as timp∗=40s; simulation results are shown as follows.From Figures15–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.



---

*Source: 2120745-2019-07-02.xml*