[go: up one dir, main page]

CN108008736A - Aircraft cooperative control method, device, computer-readable recording medium and terminal - Google Patents

Aircraft cooperative control method, device, computer-readable recording medium and terminal Download PDF

Info

Publication number
CN108008736A
CN108008736A CN201711164429.4A CN201711164429A CN108008736A CN 108008736 A CN108008736 A CN 108008736A CN 201711164429 A CN201711164429 A CN 201711164429A CN 108008736 A CN108008736 A CN 108008736A
Authority
CN
China
Prior art keywords
msub
mrow
aircraft
different positions
same time
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201711164429.4A
Other languages
Chinese (zh)
Other versions
CN108008736B (en
Inventor
王向华
杨其伟
秦娇
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shandong University of Science and Technology
Original Assignee
Shandong University of Science and Technology
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Shandong University of Science and Technology filed Critical Shandong University of Science and Technology
Priority to CN201711164429.4A priority Critical patent/CN108008736B/en
Publication of CN108008736A publication Critical patent/CN108008736A/en
Application granted granted Critical
Publication of CN108008736B publication Critical patent/CN108008736B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10Simultaneous control of position or course in three dimensions
    • G05D1/101Simultaneous control of position or course in three dimensions specially adapted for aircraft

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Feedback Control In General (AREA)
  • Traffic Control Systems (AREA)

Abstract

公开了飞行器协同控制方法、装置、计算机可读存储介质及终端,属于飞行控制技术领域。该方法包括:获取从不同位置起飞、同时参与飞行任务的飞行器的法向加速度an,i,使得:各飞行器的视线角λi在指定的收敛时间Tc内趋于指定的角度,各飞行器的视线角速率λi在指定的收敛时间Tc内趋于0直至等于0;获取从不同位置起飞、同时参与飞行任务的飞行器的切向加速度at,i,使得:各飞行器的协同误差ξi在时间Ts内趋于0直至等于0;根据法向加速度an,i、切向加速度at,i,对各从不同位置起飞、同时参与飞行任务的飞行器进行控制,使得各飞行器同时降落至同一指定的落点。该装置、介质、终端用于执行该方法。其使得多个飞行器以预先规定的参数执行飞行任务,逻辑过程更加简单。

Disclosed are an aircraft cooperative control method, device, computer-readable storage medium and terminal, belonging to the field of flight control technology. The method includes: obtaining the normal acceleration a n,i of the aircraft taking off from different positions and participating in the flight mission at the same time, so that: the line-of-sight angle λ i of each aircraft tends to the specified angle within the specified convergence time T c , and each aircraft The line-of-sight angular rate λ i tends to 0 until it is equal to 0 within the specified convergence time T c ; obtain the tangential acceleration at ,i of the aircraft that take off from different positions and participate in the flight mission at the same time, so that: the collaborative error ξ of each aircraft i tends to 0 until it is equal to 0 within the time T s ; according to the normal acceleration a n,i and the tangential acceleration a t,i , control the aircraft that take off from different positions and participate in the flight mission at the same time, so that each aircraft simultaneously Landing to the same designated landing point. The device, medium and terminal are used to execute the method. It enables multiple aircraft to perform flight missions with pre-specified parameters, and the logic process is simpler.

Description

飞行器协同控制方法、装置、计算机可读存储介质及终端Aircraft cooperative control method, device, computer-readable storage medium and terminal

技术领域technical field

本发明涉及飞行控制技术领域,特别涉及一种飞行器协同控制方法、装置、计算机可读存储介质。The present invention relates to the technical field of flight control, in particular to an aircraft cooperative control method, device, and computer-readable storage medium.

背景技术Background technique

针对飞行器的控制通常是应用雷达等设备视线的,在这种情况下,同一控制信号和/或控制条件通常只能控制单一飞行器,而在多个飞行器协同动作的过程中,由于控制逻辑相对复杂,控制条件呈现多样化,因此,现有技术中,针对多个飞行器协同动作的过程控制相对较难以视线,或者视线相对复杂。The control of aircraft is usually based on the line of sight of equipment such as radar. In this case, the same control signal and/or control condition can usually only control a single aircraft. In the process of coordinated action of multiple aircraft, due to the relatively complicated control logic , the control conditions are diversified. Therefore, in the prior art, the process control for the coordinated action of multiple aircraft is relatively difficult to see, or the line of sight is relatively complicated.

发明内容Contents of the invention

有鉴于此,本发明提供了一种飞行器协同控制方法、装置、计算机可读存储介质,其能够使得多个飞行器以预先规定的参数执行飞行任务,并且,逻辑过程更加简单,从而更加适于实用。In view of this, the present invention provides an aircraft cooperative control method, device, and computer-readable storage medium, which can enable multiple aircraft to perform flight tasks with pre-specified parameters, and the logic process is simpler, so it is more suitable for practical use .

为了达到上述第一个目的,本发明提供的飞行器协同控制方法的技术方案如下:In order to achieve the above-mentioned first object, the technical scheme of the aircraft cooperative control method provided by the present invention is as follows:

本发明提供的飞行器协同控制方法包括以下步骤:The aircraft cooperative control method provided by the present invention comprises the following steps:

获取从不同位置起飞、同时参与飞行任务的飞行器的法向加速度an,i,使得:各所述从不同位置起飞、同时参与飞行任务的飞行器的视线角λi在指定的收敛时间Tc内趋于指定的角度,各所述从不同位置起飞、同时参与飞行任务的飞行器的视线角速率在指定的收敛时间Tc内趋于0直至等于0;Obtain the normal acceleration a n,i of the aircraft taking off from different positions and participating in the flight mission at the same time, so that: the line-of-sight angle λ i of the aircraft taking off from different positions and participating in the flight mission at the same time is within the specified convergence time T c Tend to the specified angle, the line-of-sight angular rate of the aircraft taking off from different positions and participating in the flight mission at the same time Tend to 0 until equal to 0 within the specified convergence time Tc ;

获取从不同位置起飞、同时参与飞行任务的飞行器的切向加速度at,i,使得:各所述从不同位置起飞、同时参与飞行任务的飞行器的协同误差ξi在时间Ts内趋于0直至等于0;Obtain the tangential acceleration at, i of the aircraft taking off from different positions and participating in the flight mission at the same time, so that: the collaborative error ξ i of the aircraft taking off from different positions and participating in the flight mission at the same time tends to 0 within the time T s until equal to 0;

根据所述法向加速度an,i、所述切向加速度at,i,对各所述从不同位置起飞、同时参与飞行任务的飞行器进行控制,使得各所述从不同位置起飞、同时参与飞行任务的飞行器同时降落至同一指定的落点;According to the normal acceleration a n,i and the tangential acceleration at,i , each of the aircraft that takes off from different positions and participates in flight missions at the same time is controlled so that each of the aircraft that takes off from different positions and participates in flight missions at the same time The aircraft of the mission land at the same designated landing point at the same time;

其中,in,

Tc为预先指定的收敛时间,对于不同的飞行器,Tc取不同的值;T c is the pre-specified convergence time, for different aircraft, T c takes different values;

式中,kξ、ρξ为常数,其中,kξ>0,0<ρξ<1;λ2为拉普拉斯矩阵的最小非零特征值,拉普拉斯矩阵定义为在i=j时在i≠j时lij=-aij,其中ai,j是用来描述飞行器之间通讯拓扑的邻接矩阵的元。其中,表示第i个飞行器的协同变量,ri表示第i个飞行器和目标之间的相对距离,VM,i为第i个飞行器的速度。表示第j个飞行器的协同变量。 In the formula, k ξ and ρ ξ are constants, among them, k ξ >0, 0<ρ ξ <1; λ 2 is the Laplace matrix The smallest nonzero eigenvalue of , the Laplacian matrix is defined as when i=j l ij =-a ij when i≠j, where a i, j is the adjacency matrix used to describe the communication topology between aircraft Yuan. in, Represents the collaborative variable of the i-th aircraft, r i represents the relative distance between the i-th aircraft and the target, V M, i is the speed of the i-th aircraft. Denotes the covariate of the jth vehicle.

本发明提供的飞行器协同控制方法还可采用以下技术措施进一步实现。The aircraft cooperative control method provided by the present invention can also be further realized by adopting the following technical measures.

作为优选,As a preference,

当各所述从不同位置起飞、同时参与飞行任务的飞行器的飞行时间小于指定的收敛时间Tc时:When the flight time of each of the aircraft taking off from different positions and participating in the flight mission is less than the specified convergence time Tc :

各所述从不同位置起飞、同时参与飞行任务的飞行器的视线角λi趋近于指定的降落角度 The line-of-sight angle λ i of the aircraft taking off from different positions and participating in the flight mission at the same time tends to the specified landing angle

各所述从不同位置起飞、同时参与飞行任务的飞行器的视线角速率在指定的收敛时间Tc内趋于0;The line-of-sight angular velocity of the aircraft taking off from different positions and participating in the flight mission at the same time tends to 0 within the specified convergence time Tc ;

当各所述从不同位置起飞、同时参与飞行任务的飞行器的飞行时间大于或等于指定的收敛时间Tc时:When the flight time of each of the aircraft taking off from different positions and participating in the flight mission is greater than or equal to the specified convergence time Tc :

各所述从不同位置起飞、同时参与飞行任务的飞行器的视线角λi等于指定的降落角度 The line-of-sight angle λ i of each of the aircraft taking off from different positions and participating in the flight mission at the same time is equal to the specified landing angle

各所述从不同位置起飞、同时参与飞行任务的飞行器的视线角速率等于0。The line-of-sight angular velocity of the aircraft taking off from different positions and participating in the flight mission at the same time is equal to 0.

作为优选,所述法向加速度an,i的计算公式为:As preferably, the calculation formula of the normal acceleration a n, i is:

公式(1)中:In formula (1):

k0>2、kσ、ρσ为常数,其中,kσ>0,0<ρσ<1,k 0 >2, k σ and ρ σ are constants, among them, k σ >0, 0<ρ σ <1,

sgn(·)是一个符号函数,γM,i分别表示第i个飞行器的航向角,Vr,i和Vλ,i分别是水平和垂直于视线的相对速度分量,ri表示第i个飞行器和目标之间的相对距离;sgn( ) is a sign function, γ M, i represent the heading angle of the i-th aircraft, V r, i and V λ, i are the relative velocity components horizontally and vertically to the line of sight, r i represents the i-th aircraft the relative distance between the aircraft and the target;

g(xi,i,ti)和σi的表达式中的xi,i的第一个下标表示第i个状态量,i=1,2;第二个下标表示的第i个飞行器,i=1,…,n,In the expressions of g(xi , i , t i ) and σ i , the first subscript of x i, i indicates the i-th state quantity, i=1, 2; the second subscript indicates the i-th aircraft, i=1,...,n,

其中tgo,i=Tc-ti where t go,i =T c -t i ;

作为优选,As a preference,

当各所述从不同位置起飞、同时参与飞行任务的飞行器的飞行时间小于时间Ts时:When the flight time of each of the aircraft taking off from different positions and participating in the flight mission is less than time T s :

各所述从不同位置起飞、同时参与飞行任务的飞行器的协同误差ξi趋于0;The collaborative errors ξ i of the aircraft that take off from different positions and participate in the flight mission at the same time tend to 0;

当各所述从不同位置起飞、同时参与飞行任务的飞行器的飞行时间大于或者等于时间Ts时:When the flight time of each of the aircraft taking off from different positions and participating in the flight mission is greater than or equal to time T s :

各所述从不同位置起飞、同时参与飞行任务的飞行器的协同误差ξi等于0。The collaborative error ξi of each of the aircraft taking off from different positions and participating in the flight mission at the same time is equal to 0.

作为优选,所述切向加速度at,i的计算公式为:As preferably, the calculation formula of the tangential acceleration at, i is:

公式(2)中:In formula (2):

sgn(·)是一个符号函数,sgn( ) is a symbolic function,

为协同误差,表示第i个飞行器的协同变量与相邻飞行器的协同变量之间的差别; is the collaborative error, which represents the difference between the collaborative variable of the i-th aircraft and the collaborative variable of adjacent aircraft;

kξ、ρξ为常数,其中,kξ>0,0<ρξ<1。k ξ and ρ ξ are constants, where k ξ >0, 0<ρ ξ <1.

为了达到上述第二个目的,本发明提供的飞行器协同控制装置的技术方案如下:In order to achieve the above-mentioned second purpose, the technical scheme of the aircraft cooperative control device provided by the present invention is as follows:

本发明提供的飞行器协同控制装置包括:The aircraft cooperative control device provided by the present invention includes:

法向加速度获取模块,用于获取从不同位置起飞、同时参与飞行任务的飞行器的法向加速度an,i,使得:各所述从不同位置起飞、同时参与飞行任务的飞行器的视线角λi在指定的收敛时间Tc内趋于指定的角度,各所述从不同位置起飞、同时参与飞行任务的飞行器的视线角速率在指定的收敛时间Tc内趋于0直至等于0;The normal acceleration acquisition module is used to obtain the normal acceleration a n,i of the aircraft taking off from different positions and participating in the flight mission at the same time, so that: the line-of-sight angle λ i of each aircraft taking off from different positions and participating in the flight mission at the same time Tend to the specified angle within the specified convergence time Tc , the line-of-sight angular velocity of each aircraft taking off from different positions and participating in the flight mission at the same time Tend to 0 until equal to 0 within the specified convergence time Tc ;

切向加速度获取模块,用于获取从不同位置起飞、同时参与飞行任务的飞行器的切向加速度at,i,使得:各所述从不同位置起飞、同时参与飞行任务的飞行器的协同误差ξi在时间Ts内趋于0直至等于0;The tangential acceleration acquisition module is used to obtain the tangential acceleration at, i of the aircraft taking off from different positions and participating in the flight mission at the same time, so that: the collaborative error ξ i of the aircraft taking off from different positions and participating in the flight mission at the same time Tend to 0 until equal to 0 in time T s ;

控制模块,用于根据从所述法向加速度获取模块获取的法向加速度an,i和从所述切向加速度获取模块获取的切向加速度at,i,对各所述从不同位置起飞、同时参与飞行任务的飞行器进行控制,使得各所述从不同位置起飞、同时参与飞行任务的飞行器同时降落至同一指定的落点;A control module, for taking off from different positions according to the normal acceleration a n, i obtained from the normal acceleration obtaining module and the tangential acceleration at, i obtained from the tangential acceleration obtaining module 1. Control the aircraft that participate in the flight mission at the same time, so that the aircraft that take off from different positions and participate in the flight mission at the same time land to the same designated landing point at the same time;

其中,in,

Tc为预先指定的收敛时间,对于不同的飞行器,Tc取不同的值;T c is the pre-specified convergence time, for different aircraft, T c takes different values;

式中,kξ、ρξ为常数,其中,kξ>0,0<ρξ<1;λ2为拉普拉斯矩阵的最小非零特征值,拉普拉斯矩阵定义为在i=j时在i≠j时lij=-aij,其中ai,j是用来描述飞行器之间通讯拓扑的邻接矩阵的元。其中,表示第i个飞行器的协同变量,ri表示第i个飞行器和目标之间的相对距离,VM,i为第i个飞行器的速度。表示第j个飞行器的协同变量。 In the formula, k ξ and ρ ξ are constants, among them, k ξ >0, 0<ρ ξ <1; λ 2 is the Laplace matrix The smallest nonzero eigenvalue of , the Laplacian matrix is defined as when i=j l ij =-a ij when i≠j, where a i, j is the adjacency matrix used to describe the communication topology between aircraft Yuan. in, Represents the collaborative variable of the i-th aircraft, r i represents the relative distance between the i-th aircraft and the target, V M, i is the speed of the i-th aircraft. Denotes the covariate of the jth vehicle.

本发明提供的飞行器协同控制装置还可采用以下技术措施进一步实现。The aircraft cooperative control device provided by the present invention can also be further realized by adopting the following technical measures.

作为优选,As a preference,

所述法向加速度获取模块执行的计算公式为:The calculation formula executed by the normal acceleration acquisition module is:

公式(1)中:In formula (1):

k0>2、kσ、ρσ为常数,其中,kσ>0,0<ρσ<1,k 0 >2, k σ and ρ σ are constants, among them, k σ >0, 0<ρ σ <1,

sgn(·)是一个符号函数,γM,i分别表示第i个飞行器的航向角,Vr,i和Vλ,i分别是水平和垂直于视线的相对速度分量,ri表示第i个飞行器和目标之间的相对距离;sgn( ) is a sign function, γ M, i represent the heading angle of the i-th aircraft, V r, i and V λ, i are the relative velocity components horizontally and vertically to the line of sight, r i represents the i-th aircraft the relative distance between the aircraft and the target;

g(xi,i,ti)和σi的表达式中的xi,i的第一个下标表示第i个状态量,i=1,2;第二个下标表示的第i个飞行器,i=1,…,n,In the expressions of g(xi , i , t i ) and σ i , the first subscript of x i, i indicates the i-th state quantity, i=1, 2; the second subscript indicates the i-th aircraft, i=1,...,n,

其中tgo,i=Tc-ti where t go,i =T c -t i ;

作为优选,As a preference,

所述切向加速度获取模块执行的计算公式为:The calculation formula executed by the tangential acceleration acquisition module is:

公式(2)中:In formula (2):

sgn(·)是一个符号函数,sgn( ) is a symbolic function,

为协同误差,表示第i个飞行器的协同变量与相邻飞行器的协同变量之间的差别。 is the collaborative error, which represents the difference between the collaborative variable of the i-th aircraft and the collaborative variable of adjacent aircraft.

kξ、ρξ为常数,其中,kξ>0,0<ρξ<1。k ξ and ρ ξ are constants, where k ξ >0, 0<ρ ξ <1.

本发明提供的飞行器协同控制装置还可采用以下技术措施进一步实现。The aircraft cooperative control device provided by the present invention can also be further realized by adopting the following technical measures.

作为优选,As a preference,

所述法向加速度获取模块执行的计算公式为:The calculation formula executed by the normal acceleration acquisition module is:

公式(1)中:In formula (1):

k0>2、kσ、ρσ为常数,其中,kσ>0,0<ρσ<1,k 0 >2, k σ and ρ σ are constants, among them, k σ >0, 0<ρ σ <1,

sgn(·)是一个符号函数,sgn( ) is a symbolic function,

g(xi,i,ti)中的xi,i的第一个下标表示第i个状态量,i=1,2;第二个下标表示的第i个飞行器,i=1,…,n,In g(xi , i , t i ), the first subscript of x i, i represents the i-th state quantity, i=1, 2; the second subscript represents the i-th aircraft, i=1 ,...,n,

作为优选,As a preference,

所述切向加速度获取模块执行的计算公式为:The calculation formula executed by the tangential acceleration acquisition module is:

公式(2)中:In formula (2):

sgn(·)是一个符号函数,sgn( ) is a symbolic function,

为协同误差,表示第i个飞行器的协同变量与相邻飞行器的协同变量之间的差别; is the collaborative error, which represents the difference between the collaborative variable of the i-th aircraft and the collaborative variable of adjacent aircraft;

κξ、ρξ为常数,其中,κξ>0,0<ρξ<1。κ ξ and ρ ξ are constants, where κ ξ >0, 0<ρ ξ <1.

为了达到上述第三个目的,本发明提供的计算机可读存储介质的技术方案如下:In order to achieve the above-mentioned third purpose, the technical solution of the computer-readable storage medium provided by the present invention is as follows:

本发明提供的计算机可读存储介质所述计算机可读存储介质上存储有飞行器协同控制程序,所述飞行器协同控制程序被处理器执行时视线本发明提供的飞行器协同控制方法的步骤。In the computer-readable storage medium provided by the present invention, an aircraft cooperative control program is stored on the computer-readable storage medium, and when the aircraft cooperative control program is executed by a processor, the steps of the aircraft cooperative control method provided by the present invention are seen.

为了达到上述第四个目的,本发明提供的终端的技术方案如下:In order to achieve the above fourth objective, the technical solution of the terminal provided by the present invention is as follows:

本发明提供的终端包括处理器、存储器及存储在所述存储器上并可在所述处理其上运行的飞行器协同控制程序,所述飞行器协同控制程序被所述处理器执行时视线本发明提供的飞行器协同控制方法的步骤。The terminal provided by the present invention includes a processor, a memory, and an aircraft cooperative control program that is stored on the memory and can run on the processor. When the aircraft cooperative control program is executed by the processor, it can see the The steps of the aircraft cooperative control method.

本发明提供的飞行器协同控制方法、装置、计算机可读存储介质及终端能够使得多个飞行器以预先规定的参数执行飞行任务,其首先获取各从不同位置起飞、同时参与飞行任务的飞行器的法向加速度an,i、切向加速度at,i,然后,根据各法向加速度an,i、切向加速度at,i,对各所述从不同位置起飞、同时参与飞行任务的飞行器进行控制,使得各所述从不同位置起飞、同时参与飞行任务的飞行器同时降落至同一指定的落点,并且,逻辑过程更加简单。The aircraft cooperative control method, device, computer-readable storage medium, and terminal provided by the present invention can enable multiple aircraft to perform flight missions with pre-specified parameters, which first obtains the normal direction of each aircraft that takes off from different positions and participates in the flight mission at the same time Acceleration a n,i , tangential acceleration a t,i , then, according to each normal acceleration a n,i , tangential acceleration at,i , carry out a test for each aircraft that takes off from different positions and participates in the flight mission at the same time The control makes each of the aircraft taking off from different positions and simultaneously participating in the flight mission land to the same designated landing point at the same time, and the logic process is simpler.

附图说明Description of drawings

通过阅读下文优选实施方式的详细描述,各种其他的优点和益处对于本领域普通技术人员将变得清楚明了。附图仅用于示出优选实施方式的目的,而并不认为是对本发明的限制。而且在整个附图中,用相同的参考符号表示相同的部件。在附图中:Various other advantages and benefits will become apparent to those of ordinary skill in the art upon reading the following detailed description of the preferred embodiment. The drawings are only for the purpose of illustrating a preferred embodiment and are not to be considered as limiting the invention. Also throughout the drawings, the same reference numerals are used to designate the same components. In the attached picture:

图1为本发明实施例一提供的飞行器协同控制方法的步骤流程图;FIG. 1 is a flow chart of the steps of the aircraft cooperative control method provided by Embodiment 1 of the present invention;

图2为本发明实施例二提供的飞行器协同控制装置中各模块之间的信号流向关系示意图;2 is a schematic diagram of the signal flow relationship between modules in the aircraft cooperative control device provided by Embodiment 2 of the present invention;

图3为n个从不同位置起飞、同时参与飞行任务的飞行器同时降落至同一指定的落点的示意图;Fig. 3 is a schematic diagram of n aircraft taking off from different positions and simultaneously participating in flight missions landing to the same designated landing point at the same time;

图4为飞行器飞行的几何模型示意图;Fig. 4 is the schematic diagram of the geometric model of aircraft flight;

图5为当飞行器为5个时的通讯拓扑示意图;Fig. 5 is a schematic diagram of the communication topology when there are five aircraft;

图6a为第一个飞行器利用本发明实施例一提供的飞行器协同控制方法条件下的状态量-时间关系曲线图;Fig. 6a is a state quantity-time relationship curve diagram under the condition that the first aircraft utilizes the aircraft cooperative control method provided by Embodiment 1 of the present invention;

图6b为第一个飞行器利用本发明实施例一提供的飞行器协同控制方法条件下的切向加速度-时间关系曲线图;Fig. 6b is a tangential acceleration-time curve diagram under the condition that the first aircraft utilizes the aircraft cooperative control method provided by Embodiment 1 of the present invention;

图6c为第一个飞行器利用本发明实施例一提供的飞行器协同控制方法条件下的法向加速度-时间关系曲线图;Fig. 6c is a normal acceleration-time curve diagram under the condition that the first aircraft utilizes the aircraft cooperative control method provided by Embodiment 1 of the present invention;

图7a为5个飞行器在利用本发明实施例一提供的飞行器协同控制方法条件下的相对距离-时间关系曲线图;Fig. 7a is a graph of relative distance-time relationship of 5 aircrafts under the condition of using the aircraft cooperative control method provided by Embodiment 1 of the present invention;

图7b为5个飞行器在利用本发明实施例一提供的飞行器协同控制方法条件下的协同误差-时间关系曲线图;Fig. 7b is a curve diagram of cooperative error-time relationship of 5 aircrafts under the condition of using the aircraft cooperative control method provided by Embodiment 1 of the present invention;

图7c为5个飞行器在利用本发明实施例一提供的飞行器协同控制方法条件下的协同变量-时间关系曲线图;Fig. 7c is a curve diagram of cooperative variable-time relationship of 5 aircrafts under the condition of using the aircraft cooperative control method provided by Embodiment 1 of the present invention;

图7d为5个飞行器在利用本发明实施例一提供的飞行器协同控制方法条件下的轨迹-时间关系曲线图。Fig. 7d is a trajectory-time relationship graph of 5 aircrafts under the condition of using the aircraft cooperative control method provided in Embodiment 1 of the present invention.

具体实施方式Detailed ways

本发明为解决现有技术存在的问题,提供一种飞行器协同控制方法、装置、计算机可读存储介质,其能够使得多个飞行器以预先规定的参数执行飞行任务,并且,逻辑过程更加简单,从而更加适于实用。In order to solve the problems existing in the prior art, the present invention provides an aircraft cooperative control method, device, and computer-readable storage medium, which can enable multiple aircraft to perform flight tasks with pre-specified parameters, and the logic process is simpler, thereby more practical.

为更进一步阐述本发明为达成预定发明目的所采取的技术手段及功效,以下结合附图及较佳实施例,对依据本发明提出的飞行器协同控制方法、装置、计算机可读存储介质及终端,其具体实施方式、结构、特征及其功效,详细说明如后。在下述说明中,不同的“一实施例”或“实施例”指的不一定是同一实施例。此外,一或多个实施例中的特征、结构、或特点可由任何合适形式组合。In order to further explain the technical means and effects of the present invention to achieve the intended purpose of the invention, the following, in conjunction with the accompanying drawings and preferred embodiments, will discuss the aircraft cooperative control method, device, computer-readable storage medium and terminal proposed according to the present invention. Its specific implementation, structure, feature and effect thereof are described in detail as follows. In the following description, different "one embodiment" or "embodiment" do not necessarily refer to the same embodiment. Furthermore, the features, structures, or characteristics of one or more embodiments may be combined in any suitable manner.

本文中术语“和/或”,仅仅是一种描述关联对象的关联关系,表示可以存在三种关系,例如,A和/或B,具体的理解为:可以同时包含有A与B,可以单独存在A,也可以单独存在B,能够具备上述三种任一种情况。The term "and/or" in this article is just an association relationship describing associated objects, which means that there can be three relationships, for example, A and/or B. The specific understanding is: A and B can be included at the same time, and A and B can be included separately. A exists, B may exist alone, and any of the above three situations can be met.

实施例一Embodiment one

参见附图1,本发明实施例一提供的飞行器协同控制方法包括以下步骤:Referring to accompanying drawing 1, the aircraft cooperative control method provided by Embodiment 1 of the present invention includes the following steps:

步骤S1:获取从不同位置起飞、同时参与飞行任务的飞行器的法向加速度an,i,使得:各从不同位置起飞、同时参与飞行任务的飞行器的视线角λi在指定的收敛时间Tc内趋于指定的角度,各从不同位置起飞、同时参与飞行任务的飞行器的视线角速率在指定的收敛时间Tc内趋于0直至等于0;Step S1: Obtain the normal acceleration a n,i of the aircraft taking off from different positions and participating in the flight mission at the same time, so that: the line-of-sight angle λ i of the aircraft taking off from different positions and participating in the flight mission at the specified convergence time T c tends to the specified angle, the line-of-sight angular rate of the aircraft taking off from different positions and participating in the flight mission at the same time Tend to 0 until equal to 0 within the specified convergence time Tc ;

步骤S2:获取从不同位置起飞、同时参与飞行任务的飞行器的切向加速度at,i,使得:各从不同位置起飞、同时参与飞行任务的飞行器的协同误差ξi在时间Ts内趋于0直至等于0;Step S2: Obtain the tangential acceleration at, i of the aircraft taking off from different positions and participating in the flight mission at the same time, so that: the collaborative error ξ i of the aircraft taking off from different positions and participating in the flight mission at the same time tends to 0 until equal to 0;

步骤S3:根据法向加速度an,i、切向加速度at,i,对各从不同位置起飞、同时参与飞行任务的飞行器进行控制,使得各从不同位置起飞、同时参与飞行任务的飞行器同时降落至同一指定的落点;Step S3: According to the normal acceleration a n,i and the tangential acceleration at,i , control the aircraft that take off from different positions and participate in the flight mission at the same time, so that the aircraft that take off from different positions and participate in the flight mission at the same time Landing to the same designated landing point;

其中,in,

Tc为预先指定的收敛时间,对于不同的飞行器,Tc取不同的值;T c is the pre-specified convergence time, for different aircraft, T c takes different values;

式中,kξ、ρξ为常数,其中,kξ>0,0<ρξ<1;λ2为拉普拉斯矩阵的最小非零特征值,拉普拉斯矩阵定义为在i=j时在i≠j时lij=-aij,其中ai,j是用来描述飞行器之间通讯拓扑的邻接矩阵的元。其中,表示第i个飞行器的协同变量,ri表示第i个飞行器和目标之间的相对距离,VM,i为第i个飞行器的速度。表示第j个飞行器的协同变量。 In the formula, k ξ and ρ ξ are constants, among them, k ξ >0, 0<ρ ξ <1; λ 2 is the Laplace matrix The smallest nonzero eigenvalue of , the Laplacian matrix is defined as when i=j l ij =-a ij when i≠j, where a i, j is the adjacency matrix used to describe the communication topology between aircraft Yuan. in, Represents the collaborative variable of the i-th aircraft, r i represents the relative distance between the i-th aircraft and the target, V M, i is the speed of the i-th aircraft. Denotes the covariate of the jth vehicle.

其中,in,

当各从不同位置起飞、同时参与飞行任务的飞行器的飞行时间小于指定的收敛时间Tc时:When the flight time of the aircraft taking off from different positions and participating in the flight mission at the same time is less than the specified convergence time Tc :

各从不同位置起飞、同时参与飞行任务的飞行器的视线角λi趋近于指定的降落角度 The line-of-sight angle λ i of the aircraft taking off from different positions and participating in the flight mission at the same time tends to the specified landing angle

各从不同位置起飞、同时参与飞行任务的飞行器的视线角速率在指定的收敛时间Tc内趋于0;The line-of-sight angular velocity of the aircraft taking off from different positions and participating in the flight mission at the same time tends to 0 within the specified convergence time Tc ;

当各从不同位置起飞、同时参与飞行任务的飞行器的飞行时间大于或等于指定的收敛时间Tc时:When the flight time of the aircraft taking off from different positions and participating in the flight mission at the same time is greater than or equal to the specified convergence time Tc :

各从不同位置起飞、同时参与飞行任务的飞行器的视线角λi等于指定的降落角度 The line-of-sight angle λ i of the aircraft taking off from different positions and participating in the flight mission at the same time is equal to the specified landing angle

各从不同位置起飞、同时参与飞行任务的飞行器的视线角速率等于0。The line-of-sight angular velocity of the aircraft taking off from different positions and participating in the flight mission at the same time is equal to 0.

其中,法向加速度an,i的计算公式为:Among them, the calculation formula of normal acceleration a n,i is:

公式(1)中:In formula (1):

k0>2、kσ、ρσ为常数,其中,kσ>0,0<ρσ<1,k 0 >2, k σ and ρ σ are constants, among them, k σ >0, 0<ρ σ <1,

sgn(·)是一个符号函数,γM,i分别表示第i个飞行器的航向角,Vr,i和Vλ,i分别是水平和垂直于视线的相对速度分量,ri表示第i个飞行器和目标之间的相对距离;sgn( ) is a sign function, γ M, i represent the heading angle of the i-th aircraft, V r, i and V λ, i are the relative velocity components horizontally and vertically to the line of sight, r i represents the i-th aircraft the relative distance between the aircraft and the target;

g(xi,i,ti)和σi的表达式中的xi,i的第一个下标表示第i个状态量,i=1,2;第二个下标表示的第i个飞行器,i=1,…,n,In the expressions of g(xi , i , t i ) and σ i , the first subscript of x i, i indicates the i-th state quantity, i=1, 2; the second subscript indicates the i-th aircraft, i=1,...,n,

其中tgo,i=Tc-ti where t go,i =T c -t i ;

其中,in,

当各从不同位置起飞、同时参与飞行任务的飞行器的飞行时间小于时间Ts时:When the flight time of the aircraft taking off from different positions and participating in the flight mission at the same time is less than the time T s :

各从不同位置起飞、同时参与飞行任务的飞行器的协同误差ξi趋于0;The collaborative error ξ i of the aircraft taking off from different positions and participating in the flight mission at the same time tends to 0;

当各从不同位置起飞、同时参与飞行任务的飞行器的飞行时间大于或者等于时间Ts时:When the flight time of the aircraft taking off from different positions and participating in the flight mission at the same time is greater than or equal to the time T s :

各从不同位置起飞、同时参与飞行任务的飞行器的协同误差ξi等于0。The collaborative error ξi of the aircraft that take off from different positions and participate in the flight mission at the same time is equal to 0.

其中,切向加速度at,i的计算公式为:Among them, the calculation formula of tangential acceleration at, i is:

公式(2)中:In formula (2):

sgn(·)是一个符号函数,sgn( ) is a symbolic function,

为协同误差,表示第i个飞行器的协同变量与相邻飞行器的协同变量之间的差别。 is the collaborative error, which represents the difference between the collaborative variable of the i-th aircraft and the collaborative variable of adjacent aircraft.

kξ、ρξ为常数,其中,kξ>0,0<ρξ<1。k ξ and ρ ξ are constants, where k ξ >0, 0<ρ ξ <1.

实施例二Embodiment two

参见附图2,本发明实施例二提供的飞行器协同控制装置包括:Referring to accompanying drawing 2, the aircraft cooperative control device provided by Embodiment 2 of the present invention includes:

法向加速度获取模块,用于获取从不同位置起飞、同时参与飞行任务的飞行器的法向加速度an,i,使得:各从不同位置起飞、同时参与飞行任务的飞行器的视线角λi在指定的收敛时间Tc内趋于指定的角度,各从不同位置起飞、同时参与飞行任务的飞行器的视线角速率在指定的收敛时间Tc内趋于0直至等于0;The normal acceleration acquisition module is used to obtain the normal acceleration a n,i of the aircraft taking off from different positions and participating in the flight mission at the same time, so that: the line-of-sight angle λ i of the aircraft taking off from different positions and participating in the flight mission at the same time is specified tends to the specified angle within the convergence time Tc , the line-of-sight angular velocity of the aircraft that take off from different positions and participate in the flight mission at the same time Tend to 0 until equal to 0 within the specified convergence time Tc ;

切向加速度获取模块,用于获取从不同位置起飞、同时参与飞行任务的飞行器的切向加速度at,i,使得:各从不同位置起飞、同时参与飞行任务的飞行器的协同误差ξi在时间Ts内趋于0直至等于0;The tangential acceleration acquisition module is used to obtain the tangential acceleration at, i of the aircraft taking off from different positions and participating in the flight mission at the same time, so that: the collaborative error ξ i of the aircraft taking off from different positions and participating in the flight mission at the same time T s tends to 0 until it is equal to 0;

控制模块,用于根据从法向加速度获取模块获取的法向加速度an,i和从切向加速度获取模块获取的切向加速度at,i,对各从不同位置起飞、同时参与飞行任务的飞行器进行控制,使得各从不同位置起飞、同时参与飞行任务的飞行器同时降落至同一指定的落点;The control module is used for, according to the normal acceleration a n, i obtained from the normal acceleration obtaining module and the tangential acceleration at, i obtained from the tangential acceleration obtaining module, for taking off from different positions and participating in the flight mission at the same time The aircraft is controlled so that the aircraft that take off from different positions and participate in the flight mission at the same time land at the same designated landing point at the same time;

其中,in,

Tc为预先指定的收敛时间,对于不同的飞行器,Tc取不同的值;T c is the pre-specified convergence time, for different aircraft, T c takes different values;

式中,kξ、ρξ为常数,其中,kξ>0,0<ρξ<1;λ2为拉普拉斯矩阵的最小非零特征值,拉普拉斯矩阵定义为在i=j时在i≠j时lij=-aij,其中ai,j是用来描述飞行器之间通讯拓扑的邻接矩阵的元。其中,表示第i个飞行器的协同变量,ri表示第i个飞行器和目标之间的相对距离,VM,i为第i个飞行器的速度。表示第j个飞行器的协同变量。 In the formula, k ξ and ρ ξ are constants, among them, k ξ >0, 0<ρ ξ <1; λ 2 is the Laplace matrix The smallest nonzero eigenvalue of , the Laplacian matrix is defined as when i=j l ij =-a ij when i≠j, where a i, j is the adjacency matrix used to describe the communication topology between aircraft Yuan. in, Represents the collaborative variable of the i-th aircraft, r i represents the relative distance between the i-th aircraft and the target, V M, i is the speed of the i-th aircraft. Denotes the covariate of the jth vehicle.

其中,in,

法向加速度获取模块执行的计算公式为:The calculation formula executed by the normal acceleration acquisition module is:

公式(1)中:In formula (1):

k0>2、kσ、ρσ为常数,其中,kσ>0,0<ρσ<1,k 0 >2, k σ and ρ σ are constants, among them, k σ >0, 0<ρ σ <1,

sgn(·)是一个符号函数,γM,i分别表示第i个飞行器的航向角,Vr,i和Vλ,i分别是水平和垂直于视线的相对速度分量,ri表示第i个飞行器和目标之间的相对距离;sgn( ) is a sign function, γ M, i represent the heading angle of the i-th aircraft, V r, i and V λ, i are the relative velocity components horizontally and vertically to the line of sight, r i represents the i-th aircraft the relative distance between the aircraft and the target;

g(xi,i,ti)和σi的表达式中的xi,i的第一个下标表示第i个状态量,i=1,2;第二个下标表示的第i个飞行器,i=1,…,n,In the expressions of g(xi , i , t i ) and σ i , the first subscript of x i, i indicates the i-th state quantity, i=1, 2; the second subscript indicates the i-th aircraft, i=1,...,n,

其中tgo,i=Tc-ti where t go,i =T c -t i ;

其中,in,

切向加速度获取模块执行的计算公式为:The calculation formula executed by the tangential acceleration acquisition module is:

公式(2)中:In formula (2):

sgn(·)是一个符号函数,sgn( ) is a symbolic function,

为协同误差,表示第i个飞行器的协同变量与相邻飞行器的协同变量之间的差别。 is the collaborative error, which represents the difference between the collaborative variable of the i-th aircraft and the collaborative variable of adjacent aircraft.

kξ、ρξ为常数,其中,kξ>0,0<ρξ<1。k ξ and ρ ξ are constants, where k ξ >0, 0<ρ ξ <1.

其中,in,

法向加速度获取模块执行的计算公式为:The calculation formula executed by the normal acceleration acquisition module is:

公式(1)中:In formula (1):

k0>2、kσ、ρσ为常数,其中,kσ>0,0<ρσ<1,k 0 >2, k σ and ρ σ are constants, among them, k σ >0, 0<ρ σ <1,

sgn(·)是一个符号函数,γM,i分别表示第i个飞行器的航向角,Vr,i和Vλ,i分别是水平和垂直于视线的相对速度分量,ri表示第i个飞行器和目标之间的相对距离;sgn( ) is a sign function, γ M, i represent the heading angle of the i-th aircraft, V r, i and V λ, i are the relative velocity components horizontally and vertically to the line of sight, r i represents the i-th aircraft the relative distance between the aircraft and the target;

g(xi,i,ti)和σi的表达式中的xi,i的第一个下标表示第i个状态量,i=1,2;第二个下标表示的第i个飞行器,i=1,…,n,In the expressions of g(xi , i , t i ) and σ i , the first subscript of x i, i indicates the i-th state quantity, i=1, 2; the second subscript indicates the i-th aircraft, i=1,...,n,

其中tgo,i=Tc-ti where t go,i =T c -t i ;

其中,in,

切向加速度获取模块执行的计算公式为:The calculation formula executed by the tangential acceleration acquisition module is:

公式(2)中:In formula (2):

sgn(·)是一个符号函数,sgn( ) is a symbolic function,

为协同误差,表示第i个飞行器的协同变量与相邻飞行器的协同变量之间的差别。 is the collaborative error, which represents the difference between the collaborative variable of the i-th aircraft and the collaborative variable of adjacent aircraft.

kξ、ρξ为常数,其中,kξ>0,0<ρξ<1。k ξ and ρ ξ are constants, where k ξ >0, 0<ρ ξ <1.

实施例三Embodiment Three

本发明实施例三提供的计算机可读存储介质计算机可读存储介质上存储有飞行器协同控制程序,飞行器协同控制程序被处理器执行时视线本发明实施例一提供的飞行器协同控制方法的步骤。The computer-readable storage medium provided by the third embodiment of the present invention stores the aircraft cooperative control program on the computer-readable storage medium. When the aircraft cooperative control program is executed by the processor, the steps of the aircraft cooperative control method provided by the first embodiment of the present invention are seen.

实施例四Embodiment Four

本发明实施例四提供的终端包括处理器、存储器及存储在存储器上并可在处理其上运行的飞行器协同控制程序,飞行器协同控制程序被处理器执行时视线本发明实施例一提供的飞行器协同控制方法的步骤。The terminal provided by the fourth embodiment of the present invention includes a processor, a memory, and an aircraft cooperative control program stored on the memory and capable of running on the processor. When the aircraft cooperative control program is executed by the processor, the aircraft cooperative control program provided by the first embodiment of the present invention The steps of the control method.

本发明实施例一提供的飞行器协同控制方法、实施例二提供的飞行器系统控制装置、实施例三提供的计算机可读存储介质及实施例四提供的终端能够使得多个飞行器以预先规定的参数执行飞行任务,其首先获取各从不同位置起飞、同时参与飞行任务的飞行器的法向加速度an,i、切向加速度at,i,然后,根据各法向加速度an,i、切向加速度at,i,对各所述从不同位置起飞、同时参与飞行任务的飞行器进行控制,使得各所述从不同位置起飞、同时参与飞行任务的飞行器同时降落至同一指定的落点,并且,逻辑过程更加简单。The aircraft cooperative control method provided in Embodiment 1 of the present invention, the aircraft system control device provided in Embodiment 2, the computer-readable storage medium provided in Embodiment 3, and the terminal provided in Embodiment 4 can enable multiple aircraft to execute with predetermined parameters Flight mission, which first obtains the normal acceleration a n,i and tangential acceleration a t,i of the aircraft taking off from different positions and participating in the flight mission at the same time, and then, according to each normal acceleration a n,i , tangential acceleration a t, i , control each of the aircraft that take off from different positions and participate in the flight mission at the same time, so that each of the aircraft that takes off from different positions and participate in the flight mission simultaneously lands at the same designated landing point, and the logic The process is simpler.

实施例五Embodiment five

如图3所示,考虑n个飞行器在垂直剖面上攻击静止的目标。本发明的主要目的是为了让所有飞行器同时攻击静止目标As shown in Figure 3, consider n aircraft attacking a stationary target on a vertical profile. The main purpose of the present invention is to allow all aircraft to attack stationary targets simultaneously

如图4所示构建第i个飞行器和目标之间的相对运动几何模型。As shown in Figure 4, the relative motion geometric model between the i-th aircraft and the target is constructed.

其中,Mi和T分别表示第i个飞行器和目标;VM,i、ai、和γM,i分别表示飞行器的速度、加速度和飞行器的航向角。λi表示视线角。ri表示第i个飞行器和目标之间的相对距离。根据图4可以得到Among them, M i and T represent the i-th aircraft and the target respectively; V M,i , a i , and γ M,i represent the velocity, acceleration and heading angle of the aircraft, respectively. λi represents the line of sight angle. r i represents the relative distance between the i-th aircraft and the target. According to Figure 4, it can be obtained

其中,Vr,i和Vλ,i分别是水平和垂直于视线的相对速度分量。at,i和an,i为水平和垂直飞行器速度方向的加速度分量。where Vr,i and Vλ ,i are the relative velocity components horizontally and perpendicularly to the line of sight, respectively. a t, i and a n, i are the acceleration components in the horizontal and vertical vehicle velocity directions.

为了视线所有飞行器同时到达的目的,用图的邻接矩阵来描述所有飞行器之间的通讯拓扑,定义aii=0并且如果第i个飞行器与第j个飞行器有信息的交互,则aij=1,否则aij=0。For the purpose of simultaneous arrival of all aircraft in line of sight, the adjacency matrix of To describe the communication topology between all aircraft, define a ii =0 and if the i-th aircraft has information interaction with the j-th aircraft, then a ij =1, otherwise a ij =0.

定义协同误差其中ri和VM,i分别表示第i个飞行器的相对距离和速度。协同误差定义为它表示第i个飞行器和它的邻飞行器的协同变量不同。Defining Collaborative Error Among them, r i and V M, i represent the relative distance and speed of the i-th aircraft, respectively. The collaborative error is defined as It means that the covariate between the i-th aircraft and its neighbors is different.

其中,in,

a.法向加速度设计a. Normal acceleration design

因为对于所有参与攻击的飞行器来说,法向加速度是相同的,所以为了简化,可以忽略下标i。设计法向加速度可以使得飞行器以指定的攻击角度进行拦截目标。Since the normal acceleration is the same for all attacking vehicles, the subscript i can be ignored for simplicity. Designing the normal acceleration can make the aircraft intercept the target at a specified attack angle.

把x1=λ-λ*和作为状态向量,Put x 1 =λ-λ* and as a state vector,

设计变量作为系统的状态函数,其中tgo=Tc-t,Tc为预先指定的收敛时间,对于不同的飞行器,Tc可以取不同的值。k0>2。design variable As a state function of the system, where t go =T c -t, T c is the pre-specified convergence time, for different aircraft, T c can take different values. k 0 >2.

设计的法向加速度为The designed normal acceleration is

其中,in,

k0>2、kσ、ρσ为常数,其中,kσ>0,0<ρσ<1,k 0 >2, k σ and ρ σ are constants, among them, k σ >0, 0<ρ σ <1,

sgn(·)是一个符号函数,γM,i分别表示第i个飞行器的航向角,Vr,i和Vλ,i分别是水平和垂直于视线的相对速度分量,ri表示第i个飞行器和目标之间的相对距离;sgn( ) is a sign function, γ M, i represent the heading angle of the i-th aircraft, V r, i and V λ, i are the relative velocity components horizontally and vertically to the line of sight, r i represents the i-th aircraft the relative distance between the aircraft and the target;

g(xi,i,ti)和σi的表达式中的xi,i的第一个下标表示第i个状态量,i=1,2;第二个下标表示的第i个飞行器,i=1,…,n,In the expressions of g(xi , i , t i ) and σ i , the first subscript of x i, i indicates the i-th state quantity, i=1, 2; the second subscript indicates the i-th aircraft, i=1,...,n,

其中tgo,i=Tc-ti where t go,i =T c -t i ;

b.切向加速度设计b. Tangential acceleration design

设计切向加速度为The design tangential acceleration is

其中,sgn(·)是一个符号函数,Among them, sgn( ) is a symbolic function,

为协同误差,表示第i个飞行器的协同变量与相邻飞行器的协同变量之间的差别; is the collaborative error, which represents the difference between the collaborative variable of the i-th aircraft and the collaborative variable of adjacent aircraft;

kξ、ρξ为常数,其中,kξ>0,0<ρξ<1。k ξ and ρ ξ are constants, where k ξ >0, 0<ρ ξ <1.

总之,整个制导律的设计包括两个部分:In summary, the design of the entire guidance law consists of two parts:

法向加速度:设计an,i使得在t→Tc时,在t≥Tc Normal acceleration: design a n, i such that when t→T c , and when t≥Tc and

切向加速度:设计at,i使得在t→Ts时,ξi→0;在t≥Ts时,ξi=0Tangential acceleration: design a t, i so that when t→T s , ξ i →0; when t≥T s , ξ i =0

以下是对一种带攻击角度约束的齐射攻击协同控制方法的验证:The following is the verification of a cooperative control method for salvo attack with attack angle constraints:

假设五个飞行器从不同的位置攻击一个静止的物体,五个飞行器的初始条件如表1所示:Assuming that five aircraft attack a stationary object from different positions, the initial conditions of the five aircraft are shown in Table 1:

表1飞行器初始条件Table 1 Initial conditions of aircraft

注:目标的位置为(5000,0)Note: The position of the target is (5000, 0)

五个飞行器的通讯拓扑如图3所示,其中,仿真参数表2所示:The communication topology of the five aircraft is shown in Figure 3, and the simulation parameters are shown in Table 2:

表2五个飞行器的仿真参数Table 2 Simulation parameters of five aircraft

第一个飞行器的状态xi,1=1,2、切向加速度at和法向加速度an如图6a、6b、6c所示。The state x i,1 =1,2, the tangential acceleration at and the normal acceleration a n of the first aircraft are shown in Figures 6a, 6b and 6c.

五个飞行器的相对距离r(t)、协同变量协同误差ξ(t)和飞行器的轨迹如图7a、7b、7c、7d所示,根据图7a、7b、7c、7d,通过本发明实施例一提供的飞行器协同控制方法,能够使得5个从不同位置起飞、同时参与飞行任务的飞行器M1、M2、M3、M4、M5同时降落至同一指定的落点。The relative distance r(t) of the five aircraft, covariates The coordinated error ξ(t) and the trajectory of the aircraft are shown in Figures 7a, 7b, 7c, and 7d. According to Figures 7a, 7b, 7c, and 7d, the aircraft coordinated control method provided by Embodiment 1 of the present invention can make five slaves The aircrafts M1, M2, M3, M4 and M5 that took off from different positions and participated in the flight mission simultaneously landed at the same designated landing point.

尽管已描述了本发明的优选实施例,但本领域内的技术人员一旦得知了基本创造性概念,则可对这些实施例作出另外的变更和修改。所以,所附权利要求意欲解释为包括优选实施例以及落入本发明范围的所有变更和修改。While preferred embodiments of the invention have been described, additional changes and modifications to these embodiments can be made by those skilled in the art once the basic inventive concept is appreciated. Therefore, it is intended that the appended claims be construed to cover the preferred embodiment as well as all changes and modifications which fall within the scope of the invention.

显然,本领域的技术人员可以对本发明进行各种改动和变型而不脱离本发明的精神和范围。这样,倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内,则本发明也意图包含这些改动和变型在内。Obviously, those skilled in the art can make various changes and modifications to the present invention without departing from the spirit and scope of the present invention. Thus, if these modifications and variations of the present invention fall within the scope of the claims of the present invention and their equivalent technologies, the present invention also intends to include these modifications and variations.

Claims (10)

1.一种飞行器协同控制方法,其特征在于,包括以下步骤:1. A kind of aircraft cooperative control method, is characterized in that, comprises the following steps: 获取从不同位置起飞、同时参与飞行任务的飞行器的法向加速度an,i,使得:各所述从不同位置起飞、同时参与飞行任务的飞行器的视线角λi在指定的收敛时间Tc内趋于指定的角度,各所述从不同位置起飞、同时参与飞行任务的飞行器的视线角速率在指定的收敛时间Tc内趋于0直至等于0;Obtain the normal acceleration a n,i of the aircraft taking off from different positions and participating in the flight mission at the same time, so that: the line-of-sight angle λ i of the aircraft taking off from different positions and participating in the flight mission at the same time is within the specified convergence time T c Tend to the specified angle, the line-of-sight angular rate of the aircraft taking off from different positions and participating in the flight mission at the same time Tend to 0 until equal to 0 within the specified convergence time Tc ; 获取从不同位置起飞、同时参与飞行任务的飞行器的切向加速度at,i,使得:各所述从不同位置起飞、同时参与飞行任务的飞行器的协同误差ξi在时间Ts内趋于0直至等于0;Obtain the tangential acceleration a t,i of the aircraft taking off from different positions and participating in the flight mission at the same time, so that: the collaborative error ξ i of the aircraft taking off from different positions and participating in the flight mission at the same time tends to 0 within the time T s until equal to 0; 根据所述法向加速度an,i、所述切向加速度at,i,对各所述从不同位置起飞、同时参与飞行任务的飞行器进行控制,使得各所述从不同位置起飞、同时参与飞行任务的飞行器同时降落至同一指定的落点;According to the normal acceleration a n,i and the tangential acceleration at,i , each of the aircraft that takes off from different positions and participates in flight missions at the same time is controlled so that each of the aircraft that takes off from different positions and participates in flight missions at the same time The aircraft of the mission land at the same designated landing point at the same time; 其中,in, Tc为预先指定的收敛时间,对于不同的飞行器,Tc取不同的值;T c is the pre-specified convergence time, for different aircraft, T c takes different values; 式中,κξ、ρξ为常数,其中,kξ<0,0<ρξ<1;λ2为拉普拉斯矩阵的最小非零特征值,拉普拉斯矩阵定义为在i=j时在i≠j时lij=-aij,其中ai,j是用来描述飞行器之间通讯拓扑的邻接矩阵的元。其中,表示第i个飞行器的协同变量,ri表示第i个飞行器和目标之间的相对距离,VM,i为第i个飞行器的速度。表示第j个飞行器的协同变量。 In the formula, κ ξ and ρ ξ are constants, among them, k ξ <0, 0<ρ ξ <1; λ 2 is the Laplace matrix The smallest nonzero eigenvalue of , the Laplacian matrix is defined as when i=j l ij =-a ij when i≠j, where a i, j is the adjacency matrix used to describe the communication topology between aircraft Yuan. in, Represents the collaborative variable of the i-th aircraft, r i represents the relative distance between the i-th aircraft and the target, V M, i is the speed of the i-th aircraft. Denotes the covariate of the jth aircraft. 2.根据权利要求1所述的飞行器协同控制方法,其特征在于,2. The aircraft cooperative control method according to claim 1, characterized in that, 当各所述从不同位置起飞、同时参与飞行任务的飞行器的飞行时间小于指定的收敛时间Tc时:When the flight time of each of the aircraft taking off from different positions and participating in the flight mission is less than the specified convergence time Tc : 各所述从不同位置起飞、同时参与飞行任务的飞行器的视线角λi趋近于指定的降落角度 The line-of-sight angle λ i of the aircraft taking off from different positions and participating in the flight mission at the same time tends to the specified landing angle 各所述从不同位置起飞、同时参与飞行任务的飞行器的视线角速率在指定的收敛时间Tc内趋于0;The line-of-sight angular velocity of the aircraft taking off from different positions and participating in the flight mission at the same time tends to 0 within the specified convergence time Tc ; 当各所述从不同位置起飞、同时参与飞行任务的飞行器的飞行时间大于或等于指定的收敛时间Tc时:When the flight time of each of the aircraft taking off from different positions and participating in the flight mission is greater than or equal to the specified convergence time Tc : 各所述从不同位置起飞、同时参与飞行任务的飞行器的视线角λi等于指定的降落角度 The line-of-sight angle λ i of each of the aircraft taking off from different positions and participating in the flight mission at the same time is equal to the specified landing angle 各所述从不同位置起飞、同时参与飞行任务的飞行器的视线角速率等于0。The line-of-sight angular velocity of the aircraft taking off from different positions and participating in the flight mission at the same time is equal to 0. 3.根据权利要求2所述的飞行器协同控制方法,其特征在于,所述法向加速度an,i的计算公式为:3. aircraft cooperative control method according to claim 2, is characterized in that, described normal acceleration a n, the computing formula of i is: <mrow> <msub> <mi>a</mi> <mrow> <mi>n</mi> <mo>,</mo> <mi>i</mi> </mrow> </msub> <mo>=</mo> <mo>-</mo> <mfrac> <msub> <mi>r</mi> <mi>i</mi> </msub> <mrow> <mi>cos</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;lambda;</mi> <mi>i</mi> </msub> <mo>-</mo> <msub> <mi>&amp;gamma;</mi> <mrow> <mi>M</mi> <mo>,</mo> <mi>i</mi> </mrow> </msub> <mo>)</mo> </mrow> </mrow> </mfrac> <mo>&amp;lsqb;</mo> <mfrac> <mrow> <mn>2</mn> <msub> <mi>V</mi> <mrow> <mi>r</mi> <mo>,</mo> <mi>i</mi> </mrow> </msub> <msub> <mi>V</mi> <mrow> <mi>&amp;lambda;</mi> <mo>,</mo> <mi>i</mi> </mrow> </msub> </mrow> <msubsup> <mi>r</mi> <mi>i</mi> <mn>2</mn> </msubsup> </mfrac> <mo>-</mo> <mfrac> <mrow> <mi>sin</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;lambda;</mi> <mi>i</mi> </msub> <mo>-</mo> <msub> <mi>&amp;gamma;</mi> <mrow> <mi>M</mi> <mo>,</mo> <mi>i</mi> </mrow> </msub> <mo>)</mo> </mrow> </mrow> <msub> <mi>r</mi> <mi>i</mi> </msub> </mfrac> <msub> <mi>a</mi> <mrow> <mi>t</mi> <mo>,</mo> <mi>i</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>k</mi> <mn>0</mn> </msub> <mi>g</mi> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mrow> <mi>i</mi> <mo>,</mo> <mi>i</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>t</mi> <mi>i</mi> </msub> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mi>k</mi> <mi>&amp;sigma;</mi> </msub> <msup> <mrow> <mo>|</mo> <msub> <mi>&amp;sigma;</mi> <mi>i</mi> </msub> <mo>|</mo> </mrow> <msub> <mi>&amp;rho;</mi> <mi>&amp;sigma;</mi> </msub> </msup> <mi>sgn</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;sigma;</mi> <mi>i</mi> </msub> <mo>)</mo> </mrow> <mo>&amp;rsqb;</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow> <mrow><msub><mi>a</mi><mrow><mi>n</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>=</mo><mo>-</mo><mfrac><msub><mi>r</mi><mi>i</mi></msub><mrow><mi>cos</mi><mrow><mo>(</mo><msub><mi>&amp;lambda;</mi><mi>i</mi></msub><mo>-</mo><msub><mi>&amp;gamma;</mi><mrow><mi>M</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>)</mo></mrow></mrow></mfrac><mo>&amp;lsqb;</mo><mfrac><mrow><mn>2</mn><msub><mi>V</mn>mi><mrow><mi>r</mi><mo>,</mo><mi>i</mi></mrow></msub><msub><mi>V</mi><mrow><mi>&amp;lambda;</mi><mo>,</mo><mi>i</mi></mrow></msub></mrow><msubsup><mi>r</mi><mi>i</mi><mn>2</mn></msubsup></mfrac><mo>-</mo><mfrac><mrow><mi>sin</mi><mrow><mo>(</mo><msub><mi>&amp;lambda;</mi><mi>i</mi></msub><mo>-</mo><msub><mi>&amp;gamma;</mi><mrow><mi>M</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>)</mo></mrow></mrow><msub><mi>r</mi><mi>i</mi></msub></mfrac><msub><mi>a</mi><mrow><mi>t</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>-</mo><msub><mi>k</mi><mn>0</mn></msub><mi>g</mi><mrow><mo>(</mo><msub><mi>x</mi><mrow><mi>i</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>,</mo><msub><mi>t</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>-</mo><msub><mi>k</mi><mi>&amp;sigma;</mi></msub><msup><mrow><mo>|</mo><msub><mi>&amp;sigma;</mi><mi>i</mi></msub><mo>|</mo></mrow><msub><mi>&amp;rho;</mi><mi>&amp;sigma;</mi></msub></msup><mi>sgn</mi><mrow><mo>(</mo><msub><mi>&amp;sigma;</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>&amp;rsqb;</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow> 公式(1)中:In formula (1): k0>2、kσ、ρσ为常数,其中,kσ>0,0<ρσ<1,k 0 >2, k σ and ρ σ are constants, among them, k σ >0, 0<ρ σ <1, sgn(·)是一个符号函数,γM,i分别表示第i个飞行器的航向角,Vr,i和Vλ,i分别是水平和垂直于视线的相对速度分量,ri表示第i个飞行器和目标之间的相对距离;sgn( ) is a sign function, γ M, i represent the heading angle of the i-th aircraft, V r, i and V λ, i are the relative velocity components horizontally and vertically to the line of sight, r i represents the i-th aircraft the relative distance between the aircraft and the target; g(xi,i,ti)和σi的表达式中的xi,i的第一个下标表示第i个状态量,i=1,2;第二个下标表示的第i个飞行器,i=1,…,n,In the expressions of g(xi , i , t i ) and σ i , the first subscript of x i, i indicates the i-th state quantity, i=1, 2; the second subscript indicates the i-th aircraft, i=1,...,n, 其中tgo,i=Tc-ti where t go,i =T c -t i ; <mrow> <msub> <mi>&amp;sigma;</mi> <mi>i</mi> </msub> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>x</mi> <mrow> <mn>2</mn> <mo>,</mo> <mi>i</mi> </mrow> </msub> <mo>+</mo> <mfrac> <msub> <mi>k</mi> <mn>0</mn> </msub> <msub> <mi>t</mi> <mrow> <mi>g</mi> <mi>o</mi> <mo>,</mo> <mi>i</mi> </mrow> </msub> </mfrac> <msub> <mi>x</mi> <mrow> <mn>1</mn> <mo>,</mo> <mi>i</mi> </mrow> </msub> <mo>,</mo> </mrow> </mtd> <mtd> <mrow> <mn>0</mn> <mo>&amp;le;</mo> <msub> <mi>t</mi> <mi>i</mi> </msub> <mo>&lt;</mo> <msub> <mi>T</mi> <mi>c</mi> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>x</mi> <mrow> <mn>2</mn> <mo>,</mo> <mi>i</mi> </mrow> </msub> <mo>,</mo> </mrow> </mtd> <mtd> <mrow> <msub> <mi>t</mi> <mi>i</mi> </msub> <mo>&amp;GreaterEqual;</mo> <msub> <mi>T</mi> <mi>c</mi> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>.</mo> </mrow> <mrow><msub><mi>&amp;sigma;</mi><mi>i</mi></msub><mo>=</mo><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><msub><mi>x</mi><mrow><mn>2</mn><mo>,</mo><mi>i</mi></mrow></msub><mo>+</mo><mfrac><msub><mi>k</mi><mn>0</mn></msub><msub><mi>t</mi><mrow><mi>g</mi><mi>o</mi><mo>,</mo><mi>i</mi></mrow></msub></mfrac><msub><mi>x</mi><mrow><mn>1</mn><mo>,</mo><mi>i</mi></mrow></msub><mo>,</mo></mrow></mtd><mtd><mrow><mn>0</mn><mo>&amp;le;</mo><msub><mi>t</mi><mi>i</mi></msub><mo>&lt;</mo><msub><mi>T</mi><mi>c</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>x</mi><mrow><mn>2</mn><mo>,</mo><mi>i</mi></mrow></msub><mo>,</mo></mrow></mtd><mtd><mrow><msub><mi>t</mi><mi>i</mi></msub><mo>&amp;GreaterEqual;</mo><msub><mi>T</mi><mi>c</mi></msub></mrow></mtd></mtr></mtable></mfenced><mo>.</mo></mrow> 4.根据权利要求1所述的飞行器协同控制方法,其特征在于,4. The aircraft cooperative control method according to claim 1, characterized in that, 当各所述从不同位置起飞、同时参与飞行任务的飞行器的飞行时间小于时间Ts时:When the flight time of each of the aircraft taking off from different positions and participating in the flight mission is less than time T s : 各所述从不同位置起飞、同时参与飞行任务的飞行器的协同误差ξi趋于0;The collaborative errors ξ i of the aircraft that take off from different positions and participate in the flight mission at the same time tend to 0; 当各所述从不同位置起飞、同时参与飞行任务的飞行器的飞行时间大于或者等于时间Ts时:When the flight time of each of the aircraft taking off from different positions and participating in the flight mission is greater than or equal to time T s : 各所述从不同位置起飞、同时参与飞行任务的飞行器的协同误差ξi等于0。The collaborative error ξi of each of the aircraft taking off from different positions and participating in the flight mission at the same time is equal to 0. 5.根据权利要求4所述的飞行器协同控制方法,其特征在于,所述切向加速度at,i的计算公式为:5. aircraft cooperative control method according to claim 4, is characterized in that, described tangential acceleration at, the computing formula of i is: <mrow> <msub> <mi>a</mi> <mrow> <mi>t</mi> <mo>,</mo> <mi>i</mi> </mrow> </msub> <mo>=</mo> <mo>-</mo> <mfrac> <msubsup> <mi>V</mi> <mrow> <mi>M</mi> <mo>,</mo> <mi>i</mi> </mrow> <mn>2</mn> </msubsup> <msub> <mi>r</mi> <mi>i</mi> </msub> </mfrac> <msub> <mi>k</mi> <mi>&amp;xi;</mi> </msub> <msup> <mrow> <mo>|</mo> <msub> <mi>&amp;xi;</mi> <mi>i</mi> </msub> <mo>|</mo> </mrow> <msub> <mi>&amp;rho;</mi> <mi>&amp;xi;</mi> </msub> </msup> <mi>sgn</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;xi;</mi> <mi>i</mi> </msub> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </mrow> <mrow><msub><mi>a</mi><mrow><mi>t</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>=</mo><mo>-</mo><mfrac><msubsup><mi>V</mi><mrow><mi>M</mi><mo>,</mo><mi>i</mi></mrow><mn>2</mn></msubsup><msub><mi>r</mi><mi>i</mi></msub></mfrac><msub><mi>k</mi><mi>&amp;xi;</mi></msub><msup><mrow><mo>|</mo><msub><mi>&amp;xi;</mi><mi>i</mi></msub><mo>|</mo></mrow><msub><mi>&amp;rho;</mi><mi>&amp;xi;</mi>mi></msub></msup><mi>sgn</mi><mrow><mo>(</mo><msub><mi>&amp;xi;</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow> 公式(2)中:In formula (2): sgn(·)是一个符号函数,sgn( ) is a symbolic function, 为协同误差,表示第i个飞行器的协同变量与相邻飞行器的协同变量之间的差别; is the collaborative error, which represents the difference between the collaborative variable of the i-th aircraft and the collaborative variable of adjacent aircraft; kξ、ρξ为常数,其中,kξ>0,0<ρξ<1。k ξ and ρ ξ are constants, where k ξ >0, 0<ρ ξ <1. 6.一种飞行器协同控制装置,其特征在于,包括:6. An aircraft cooperative control device, characterized in that it comprises: 法向加速度获取模块,用于获取从不同位置起飞、同时参与飞行任务的飞行器的法向加速度an,i,使得:各所述从不同位置起飞、同时参与飞行任务的飞行器的视线角λi在指定的收敛时间Tc内趋于指定的角度,各所述从不同位置起飞、同时参与飞行任务的飞行器的视线角速率在指定的收敛时间Tc内趋于0直至等于0;The normal acceleration acquisition module is used to obtain the normal acceleration a n,i of the aircraft taking off from different positions and participating in the flight mission at the same time, so that: the line-of-sight angle λ i of each aircraft taking off from different positions and participating in the flight mission at the same time Tend to the specified angle within the specified convergence time Tc , the line-of-sight angular velocity of each aircraft taking off from different positions and participating in the flight mission at the same time Tend to 0 until equal to 0 within the specified convergence time Tc ; 切向加速度获取模块,用于获取从不同位置起飞、同时参与飞行任务的飞行器的切向加速度at,i,使得:各所述从不同位置起飞、同时参与飞行任务的飞行器的协同误差ξi在时间Ts内趋于0直至等于0;The tangential acceleration acquisition module is used to obtain the tangential acceleration at, i of the aircraft taking off from different positions and participating in the flight mission at the same time, so that: the collaborative error ξ i of the aircraft taking off from different positions and participating in the flight mission at the same time Tend to 0 until equal to 0 in time T s ; 控制模块,用于根据从所述法向加速度获取模块获取的法向加速度an,i和从所述切向加速度获取模块获取的切向加速度at,i,对各所述从不同位置起飞、同时参与飞行任务的飞行器进行控制,使得各所述从不同位置起飞、同时参与飞行任务的飞行器同时降落至同一指定的落点;A control module, for taking off from different positions according to the normal acceleration a n, i obtained from the normal acceleration obtaining module and the tangential acceleration at, i obtained from the tangential acceleration obtaining module 1. Control the aircraft that participate in the flight mission at the same time, so that the aircraft that take off from different positions and participate in the flight mission at the same time land to the same designated landing point at the same time; 其中,in, Tc为预先指定的收敛时间,对于不同的飞行器,Tc取不同的值;T c is the pre-specified convergence time, for different aircraft, T c takes different values; 式中,kξ、ρξ为常数,其中,kξ>0,0<ρξ<1;λ2为拉普拉斯矩阵的最小非零特征值,拉普拉斯矩阵定义为在i=j时在i≠j时lij=-aij,其中ai,j是用来描述飞行器之间通讯拓扑的邻接矩阵的元。其中,表示第i个飞行器的协同变量,ri表示第i个飞行器和目标之间的相对距离,VM,i为第i个飞行器的速度,表示第j个飞行器的协同变量。 In the formula, k ξ and ρ ξ are constants, among them, k ξ >0, 0<ρ ξ <1; λ 2 is the Laplace matrix The smallest nonzero eigenvalue of , the Laplacian matrix is defined as when i=j l ij =-a ij when i≠j, where a i, j is the adjacency matrix used to describe the communication topology between aircraft Yuan. in, Indicates the collaborative variable of the i-th aircraft, r i indicates the relative distance between the i-th aircraft and the target, V M, i is the speed of the i-th aircraft, Denotes the covariate of the jth aircraft. 7.根据权利要求6所述的飞行器协同控制装置,其特征在于,7. The aircraft cooperative control device according to claim 6, characterized in that, 所述法向加速度获取模块执行的计算公式为:The calculation formula executed by the normal acceleration acquisition module is: <mrow> <msub> <mi>a</mi> <mrow> <mi>n</mi> <mo>,</mo> <mi>i</mi> </mrow> </msub> <mo>=</mo> <mo>-</mo> <mfrac> <msub> <mi>r</mi> <mi>i</mi> </msub> <mrow> <mi>cos</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;lambda;</mi> <mi>i</mi> </msub> <mo>-</mo> <msub> <mi>&amp;gamma;</mi> <mrow> <mi>M</mi> <mo>,</mo> <mi>i</mi> </mrow> </msub> <mo>)</mo> </mrow> </mrow> </mfrac> <mo>&amp;lsqb;</mo> <mfrac> <mrow> <mn>2</mn> <msub> <mi>V</mi> <mrow> <mi>r</mi> <mo>,</mo> <mi>i</mi> </mrow> </msub> <msub> <mi>V</mi> <mrow> <mi>&amp;lambda;</mi> <mo>,</mo> <mi>i</mi> </mrow> </msub> </mrow> <msubsup> <mi>r</mi> <mi>i</mi> <mn>2</mn> </msubsup> </mfrac> <mo>-</mo> <mfrac> <mrow> <mi>sin</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;lambda;</mi> <mi>i</mi> </msub> <mo>-</mo> <msub> <mi>&amp;gamma;</mi> <mrow> <mi>M</mi> <mo>,</mo> <mi>i</mi> </mrow> </msub> <mo>)</mo> </mrow> </mrow> <msub> <mi>r</mi> <mi>i</mi> </msub> </mfrac> <msub> <mi>a</mi> <mrow> <mi>t</mi> <mo>,</mo> <mi>i</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>k</mi> <mn>0</mn> </msub> <mi>g</mi> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mrow> <mi>i</mi> <mo>,</mo> <mi>i</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>t</mi> <mi>i</mi> </msub> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mi>k</mi> <mi>&amp;sigma;</mi> </msub> <msup> <mrow> <mo>|</mo> <msub> <mi>&amp;sigma;</mi> <mi>i</mi> </msub> <mo>|</mo> </mrow> <msub> <mi>&amp;rho;</mi> <mi>&amp;sigma;</mi> </msub> </msup> <mi>sgn</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;sigma;</mi> <mi>i</mi> </msub> <mo>)</mo> </mrow> <mo>&amp;rsqb;</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow> <mrow><msub><mi>a</mi><mrow><mi>n</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>=</mo><mo>-</mo><mfrac><msub><mi>r</mi><mi>i</mi></msub><mrow><mi>cos</mi><mrow><mo>(</mo><msub><mi>&amp;lambda;</mi><mi>i</mi></msub><mo>-</mo><msub><mi>&amp;gamma;</mi><mrow><mi>M</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>)</mo></mrow></mrow></mfrac><mo>&amp;lsqb;</mo><mfrac><mrow><mn>2</mn><msub><mi>V</mn>mi><mrow><mi>r</mi><mo>,</mo><mi>i</mi></mrow></msub><msub><mi>V</mi><mrow><mi>&amp;lambda;</mi><mo>,</mo><mi>i</mi></mrow></msub></mrow><msubsup><mi>r</mi><mi>i</mi><mn>2</mn></msubsup></mfrac><mo>-</mo><mfrac><mrow><mi>sin</mi><mrow><mo>(</mo><msub><mi>&amp;lambda;</mi><mi>i</mi></msub><mo>-</mo><msub><mi>&amp;gamma;</mi><mrow><mi>M</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>)</mo></mrow></mrow><msub><mi>r</mi><mi>i</mi></msub></mfrac><msub><mi>a</mi><mrow><mi>t</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>-</mo><msub><mi>k</mi><mn>0</mn></msub><mi>g</mi><mrow><mo>(</mo><msub><mi>x</mi><mrow><mi>i</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>,</mo><msub><mi>t</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>-</mo><msub><mi>k</mi><mi>&amp;sigma;</mi></msub><msup><mrow><mo>|</mo><msub><mi>&amp;sigma;</mi><mi>i</mi></msub><mo>|</mo></mrow><msub><mi>&amp;rho;</mi><mi>&amp;sigma;</mi></msub></msup><mi>sgn</mi><mrow><mo>(</mo><msub><mi>&amp;sigma;</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>&amp;rsqb;</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow> 公式(1)中:In formula (1): k0>2、kσ、ρσ为常数,其中,kσ>0,0<ρσ<1,k 0 >2, k σ and ρ σ are constants, among them, k σ >0, 0<ρ σ <1, sgn(·)是一个符号函数,γM,i分别表示第i个飞行器的航向角,Vr,i和Vλ,i分别是水平和垂直于视线的相对速度分量,ri表示第i个飞行器和目标之间的相对距离;sgn(·) is a sign function, γ M, i represent the heading angle of the i-th aircraft, V r, i and V λ, i are the relative velocity components horizontally and vertically to the line of sight, ri represents the i-th aircraft relative distance to the target; g(xi,i,ti)和σi的表达式中的xi,i的第一个下标表示第i个状态量,i=1,2;第二个下标表示的第i个飞行器,i=1,…,n,In the expressions of g(xi , i , t i ) and σ i , the first subscript of x i, i indicates the i-th state quantity, i=1, 2; the second subscript indicates the i-th aircraft, i=1,...,n, 其中tgo,i=Tc-ti where t go,i =T c -t i ; <mrow> <msub> <mi>&amp;sigma;</mi> <mi>i</mi> </msub> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>x</mi> <mrow> <mn>2</mn> <mo>,</mo> <mi>i</mi> </mrow> </msub> <mo>+</mo> <mfrac> <msub> <mi>k</mi> <mn>0</mn> </msub> <msub> <mi>t</mi> <mrow> <mi>g</mi> <mi>o</mi> <mo>,</mo> <mi>i</mi> </mrow> </msub> </mfrac> <msub> <mi>x</mi> <mrow> <mn>1</mn> <mo>,</mo> <mi>i</mi> </mrow> </msub> <mo>,</mo> </mrow> </mtd> <mtd> <mrow> <mn>0</mn> <mo>&amp;le;</mo> <msub> <mi>t</mi> <mi>i</mi> </msub> <mo>&lt;</mo> <msub> <mi>T</mi> <mi>c</mi> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>x</mi> <mrow> <mn>2</mn> <mo>,</mo> <mi>i</mi> </mrow> </msub> <mo>,</mo> </mrow> </mtd> <mtd> <mrow> <msub> <mi>t</mi> <mi>i</mi> </msub> <mo>&amp;GreaterEqual;</mo> <msub> <mi>T</mi> <mi>c</mi> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>.</mo> </mrow> <mrow><msub><mi>&amp;sigma;</mi><mi>i</mi></msub><mo>=</mo><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><msub><mi>x</mi><mrow><mn>2</mn><mo>,</mo><mi>i</mi></mrow></msub><mo>+</mo><mfrac><msub><mi>k</mi><mn>0</mn></msub><msub><mi>t</mi><mrow><mi>g</mi><mi>o</mi><mo>,</mo><mi>i</mi></mrow></msub></mfrac><msub><mi>x</mi><mrow><mn>1</mn><mo>,</mo><mi>i</mi></mrow></msub><mo>,</mo></mrow></mtd><mtd><mrow><mn>0</mn><mo>&amp;le;</mo><msub><mi>t</mi><mi>i</mi></msub><mo>&lt;</mo><msub><mi>T</mi><mi>c</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>x</mi><mrow><mn>2</mn><mo>,</mo><mi>i</mi></mrow></msub><mo>,</mo></mrow></mtd><mtd><mrow><msub><mi>t</mi><mi>i</mi></msub><mo>&amp;GreaterEqual;</mo><msub><mi>T</mi><mi>c</mi></msub></mrow></mtd></mtr></mtable></mfenced><mo>.</mo></mrow> 8.根据权利要求6所述的飞行器协同控制装置,其特征在于,8. The aircraft cooperative control device according to claim 6, characterized in that, 所述切向加速度获取模块执行的计算公式为:The calculation formula executed by the tangential acceleration acquisition module is: <mrow> <msub> <mi>a</mi> <mrow> <mi>t</mi> <mo>,</mo> <mi>i</mi> </mrow> </msub> <mo>=</mo> <mo>-</mo> <mfrac> <msubsup> <mi>V</mi> <mrow> <mi>M</mi> <mo>,</mo> <mi>i</mi> </mrow> <mn>2</mn> </msubsup> <msub> <mi>r</mi> <mi>i</mi> </msub> </mfrac> <msub> <mi>k</mi> <mi>&amp;xi;</mi> </msub> <msup> <mrow> <mo>|</mo> <msub> <mi>&amp;xi;</mi> <mi>i</mi> </msub> <mo>|</mo> </mrow> <msub> <mi>&amp;rho;</mi> <mi>&amp;xi;</mi> </msub> </msup> <mi>sgn</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;xi;</mi> <mi>i</mi> </msub> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </mrow> <mrow><msub><mi>a</mi><mrow><mi>t</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>=</mo><mo>-</mo><mfrac><msubsup><mi>V</mi><mrow><mi>M</mi><mo>,</mo><mi>i</mi></mrow><mn>2</mn></msubsup><msub><mi>r</mi><mi>i</mi></msub></mfrac><msub><mi>k</mi><mi>&amp;xi;</mi></msub><msup><mrow><mo>|</mo><msub><mi>&amp;xi;</mi><mi>i</mi></msub><mo>|</mo></mrow><msub><mi>&amp;rho;</mi><mi>&amp;xi;</mi>mi></msub></msup><mi>sgn</mi><mrow><mo>(</mo><msub><mi>&amp;xi;</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow> 公式(2)中:In formula (2): sgn(·)是一个符号函数,sgn( ) is a symbolic function, 为协同误差,表示第i个飞行器的协同变量与相邻飞行器的协同变量之间的差别; is the collaborative error, which represents the difference between the collaborative variable of the i-th aircraft and the collaborative variable of adjacent aircraft; kξ、ρξ为常数,其中,kξ>0,0<ρξ<1。k ξ and ρ ξ are constants, where k ξ >0, 0<ρ ξ <1. 9.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质上存储有飞行器协同控制程序,所述飞行器协同控制程序被处理器执行时视线权利要求1~5中任一所述的飞行器协同控制方法的步骤。9. A computer-readable storage medium, characterized in that an aircraft cooperative control program is stored on the computer-readable storage medium, and when the aircraft cooperative control program is executed by a processor, it can see any one of claims 1-5. The steps of the aircraft cooperative control method described above. 10.一种终端,其特征在于,包括处理器、存储器及存储在所述存储器上并可在所述处理其上运行的飞行器协同控制程序,所述飞行器协同控制程序被所述处理器执行时视线权利要求1~5中任一所述的飞行器协同控制方法的步骤。10. A terminal, characterized in that it includes a processor, a memory, and an aircraft cooperative control program stored on the memory and operable on the processing, when the aircraft cooperative control program is executed by the processor The steps of the aircraft cooperative control method described in any one of claims 1-5.
CN201711164429.4A 2017-11-21 2017-11-21 Aircraft cooperative control method, device, computer-readable storage medium and terminal Active CN108008736B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201711164429.4A CN108008736B (en) 2017-11-21 2017-11-21 Aircraft cooperative control method, device, computer-readable storage medium and terminal

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201711164429.4A CN108008736B (en) 2017-11-21 2017-11-21 Aircraft cooperative control method, device, computer-readable storage medium and terminal

Publications (2)

Publication Number Publication Date
CN108008736A true CN108008736A (en) 2018-05-08
CN108008736B CN108008736B (en) 2020-12-01

Family

ID=62052967

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201711164429.4A Active CN108008736B (en) 2017-11-21 2017-11-21 Aircraft cooperative control method, device, computer-readable storage medium and terminal

Country Status (1)

Country Link
CN (1) CN108008736B (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112835379A (en) * 2019-11-22 2021-05-25 通用电气航空系统有限公司 aircraft flight management system

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20080114502A1 (en) * 1995-06-07 2008-05-15 Automotive Technologies International, Inc. System for Obtaining Vehicular Information
US20100156758A1 (en) * 2007-12-21 2010-06-24 John Thomas Anders Apparatus and method for landing a rotary wing aircraft
CN103245256A (en) * 2013-04-25 2013-08-14 北京理工大学 Multi-missile cooperative attack guidance law designing method
CN104407619A (en) * 2014-11-05 2015-03-11 沈阳航空航天大学 Method enabling multiple unmanned aerial vehicles to reach multiple targets simultaneously under uncertain environments
CN106352738A (en) * 2016-06-08 2017-01-25 北京理工大学 Multi-missile cooperative guidance method based on output consistency
CN106843265A (en) * 2016-12-30 2017-06-13 哈尔滨工业大学 Three-dimensional many guided missile cooperative guidance method and systems of finite time convergence control

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20080114502A1 (en) * 1995-06-07 2008-05-15 Automotive Technologies International, Inc. System for Obtaining Vehicular Information
US20100156758A1 (en) * 2007-12-21 2010-06-24 John Thomas Anders Apparatus and method for landing a rotary wing aircraft
CN103245256A (en) * 2013-04-25 2013-08-14 北京理工大学 Multi-missile cooperative attack guidance law designing method
CN104407619A (en) * 2014-11-05 2015-03-11 沈阳航空航天大学 Method enabling multiple unmanned aerial vehicles to reach multiple targets simultaneously under uncertain environments
CN106352738A (en) * 2016-06-08 2017-01-25 北京理工大学 Multi-missile cooperative guidance method based on output consistency
CN106843265A (en) * 2016-12-30 2017-06-13 哈尔滨工业大学 Three-dimensional many guided missile cooperative guidance method and systems of finite time convergence control

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
MAURICIOGUELMAN等: "Formation flight line of sight guidance", 《ACTA ASTRONAUTICA》 *
杨其伟,等: "基于滑模控制的双约束条件下协同制导律的设计", 《山东科技大学学报》 *
王晓芳: "多导弹协同作战制导律研究", 《弹道学报》 *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112835379A (en) * 2019-11-22 2021-05-25 通用电气航空系统有限公司 aircraft flight management system

Also Published As

Publication number Publication date
CN108008736B (en) 2020-12-01

Similar Documents

Publication Publication Date Title
CN104407619B (en) Multiple no-manned plane under uncertain environment reaches multiple goal approachs simultaneously
CN105676641B (en) The design method of Nonlinear Robust Controller based on contragradience and sliding formwork control
CN104022742B (en) Attitude of flight vehicle robust inverting fault tolerant control method based on Neural Network Observer
CN110879599A (en) Fixed time formation control method based on finite time disturbance observer
CN107422741B (en) Learning-based cluster flight distributed attitude tracking control method for preserving preset performance
CN108681240A (en) The method for diagnosing faults that small drone distribution of the one kind based on Unknown Input Observer is formed into columns
McNeely et al. Tour planning for an unmanned air vehicle under wind conditions
CN109631883B (en) Method for accurately estimating local attitude of aircraft based on node information sharing
CN114489109B (en) Three-dimensional master-slave type multi-aircraft attack time control collaborative guidance method
CN108646554A (en) A kind of quick anti-interference longitudinal guidance method of the aircraft based on specified performance
CN111238469A (en) Unmanned aerial vehicle formation relative navigation method based on inertia/data chain
CN106292297B (en) Attitude control method based on PID controller and L1 adaptive controller
Dong et al. Visual perception-based target aircraft movement prediction for autonomous air combat
Kim et al. Realization of swarm formation flying and optimal trajectory generation for multi-drone performance show
Wu et al. Vision-based trajectory tracking control of quadrotors using super twisting sliding mode control
CN114326760B (en) Gesture collaborative tracking control method for interference and angular velocity feedback
Wu et al. Hierarchical pigeon inspired optimization based Multi-UAV obstacle avoidance control
CN105116905A (en) Aircraft attitude control method
Jing et al. Cooperative Guidance Law with Predefined‐Time Convergence for Multimissile Systems
CN108008736A (en) Aircraft cooperative control method, device, computer-readable recording medium and terminal
CN107942672B (en) An output-limited backstepping control method for quadrotor aircraft based on symmetric time-invariant obstacle Lyapunov function
Loianno et al. Autonomous flight and cooperative control for reconstruction using aerial robots powered by smartphones
Wang et al. Distance-based formation stabilization and flocking control for distributed multi-agent systems
Yang et al. Design, implementation, and verification of a low‐cost terminal guidance system for small fixed‐wing UAVs
Lin et al. A linear control approach to distributed multi-agent formations in d-dimensional space

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant