CN109491402B - Multi-unmanned aerial vehicle cooperative target monitoring control method based on cluster control - Google Patents
Multi-unmanned aerial vehicle cooperative target monitoring control method based on cluster control Download PDFInfo
- Publication number
- CN109491402B CN109491402B CN201811298179.8A CN201811298179A CN109491402B CN 109491402 B CN109491402 B CN 109491402B CN 201811298179 A CN201811298179 A CN 201811298179A CN 109491402 B CN109491402 B CN 109491402B
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- target
- aerial vehicles
- minimum value
- monitoring mode
- 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.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
- G05D1/104—Simultaneous control of position or course in three dimensions specially adapted for aircraft involving a plurality of aircrafts, e.g. formation flying
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)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本公开提供一种基于集群控制的多无人机协同目标监视控制方法,使N架无人机从其各自的初始位置,以任意初始速度出发,围绕同一个圆心以不同的半径做圆周运动,且达到稳定状态时,N架无人机进入同步监视模式或平衡监视模式。本公开提供的基于集群控制的多无人机协同目标监视控制方法,能够使多架无人机进行协同作业,增强巡视效果并提升系统可靠性。
The present disclosure provides a multi-unmanned aerial vehicle (UAV) cooperative target monitoring and control method based on cluster control, which enables N UAVs to start from their respective initial positions and start at any initial speed, and to perform circular motions with different radii around the same center. And when the steady state is reached, N UAVs enter the synchronous monitoring mode or the balanced monitoring mode. The multi-UAV cooperative target monitoring and control method based on cluster control provided by the present disclosure can enable multiple UAVs to perform cooperative operations, enhance the patrol effect and improve the system reliability.
Description
技术领域technical field
本公开涉及多无人机集群控制技术领域,尤其涉及一种基于集群控制的多无人机协同目标监视控制方法。The present disclosure relates to the technical field of multi-UAV swarm control, in particular to a multi-UAV cooperative target monitoring and control method based on swarm control.
背景技术Background technique
采用无人机对某一固定目标进行绕飞具有广泛的应用。在军用领域,即可用于对敌方军事目标的侦察监视,也可用于对我方人员的提供空中支援与保护;在民用领域,搭载图像采集设备的无人机已广泛应用于对电塔等目标的巡检。若采用多个无人机绕某一固定目标以不同的半径进行绕飞,这样形成内环与外环,军事上外环无人机可作为防御无人机,内环无人机用于实际工作,民用上外环也可作为内环无人机的备份与协助,提高系统可靠性与工作效率。The use of UAV to fly around a fixed target has a wide range of applications. In the military field, it can be used for reconnaissance and surveillance of enemy military targets, and can also be used to provide air support and protection for our personnel; in the civilian field, UAVs equipped with image acquisition equipment have been widely used in electric towers, etc. target inspection. If multiple UAVs are used to fly around a fixed target with different radii, an inner ring and an outer ring are formed. In the military, the outer ring UAV can be used as a defense UAV, and the inner ring UAV is used in practical applications. The upper outer ring for civilian use can also be used as a backup and assistance for the inner ring UAV to improve system reliability and work efficiency.
现有技术中的绕飞方案一般采用一架无人机对目标进行绕飞,或多架无人机编队控制。The fly-around scheme in the prior art generally uses one UAV to fly around the target, or control multiple UAVs in formation.
然而在实现本公开的过程中,本申请发明人发现,采用一架无人机对目标进行绕飞,其工作效率与系统可靠性远远低于多架无人机绕飞,此外,该方案中大多是通过工作人员手动遥控,即使有少量的自动化巡视方案,其自主化程度也不高;多无人机编队控制虽然是多无人机协同自主飞行,但其编队形式大多是三角编队等,即使有圆周编队也无法实现对无人机相位(航向角)的协同控制,即无法实现让所有无人机做圆周运动的同时还能让它们的相位保持同步状态(所有无人机具有相同的航向角)或平衡状态(所有无人机的航向角均匀的分布在一个圆周上)。However, in the process of realizing the present disclosure, the inventors of the present application found that the work efficiency and system reliability of using one drone to fly around the target are far lower than those of multiple drones. Most of them are manually controlled by staff. Even if there are a small number of automated patrol schemes, the degree of autonomy is not high; although the multi-UAV formation control is the coordinated autonomous flight of multiple UAVs, most of the formation forms are triangular formations, etc. , even if there is a circular formation, the coordinated control of the phase (heading angle) of the UAVs cannot be achieved, that is, it is impossible to make all UAVs perform circular motion while keeping their phases synchronized (all UAVs have the same heading angle) or equilibrium state (the heading angles of all UAVs are evenly distributed on a circle).
公开内容public content
(一)要解决的技术问题(1) Technical problems to be solved
基于上述技术问题,本公开提供一种基于集群控制的多无人机协同目标监视控制方法,以缓解现有技术中的无人机控制方案大多通过工作人员手动操控,自主化程度地,无法实现让所有无人机做圆周运动的同时还能让它们的相位保持同步状态或平衡状态的技术问题。Based on the above technical problems, the present disclosure provides a multi-UAV cooperative target monitoring and control method based on cluster control, so as to alleviate that most of the UAV control solutions in the prior art are manually controlled by staff, which cannot be achieved in the degree of autonomy. The technical problem of keeping all the drones in a circular motion while keeping their phases in sync or in balance.
(二)技术方案(2) Technical solutions
本公开提供一种基于集群控制的多无人机协同目标监视控制方法,使N架无人机从其各自的初始位置,以任意初始速度出发,围绕同一个圆心以不同的半径做圆周运动,且达到稳定状态时,N架所述无人机进入同步监视模式或平衡监视模式,N≥2,包括:The present disclosure provides a multi-unmanned aerial vehicle (UAV) cooperative target monitoring and control method based on cluster control, which enables N UAVs to start from their respective initial positions and start at any initial speed, and to perform circular motions with different radii around the same center. And when the steady state is reached, N said UAVs enter the synchronous monitoring mode or the balanced monitoring mode, N≥2, including:
步骤A:建立目标方程,使所述目标方程求出极小值时N架所述无人机的相位达到期望的相位分布;Step A: establish a target equation, so that the phase of the N UAVs reaches the desired phase distribution when the target equation obtains a minimum value;
步骤B:求取该目标方程取得极小值过程中的下降方向;Step B: Find the descending direction in the process of obtaining the minimum value of the target equation;
步骤C:基于该下降方向,设计N架所述无人机的控制率;Step C: Based on the descending direction, design the control rate of N described UAVs;
步骤D:迭代计算所述控制率,将所述目标方程对应的控制率发送至N架所述无人机;Step D: iteratively calculate the control rate, and send the control rate corresponding to the target equation to N UAVs;
步骤E:重复步骤D,直至N架所述无人机终止监视模式。Step E: Repeat Step D until N UAVs terminate the monitoring mode.
在本公开的一些实施例中,所述步骤A中,所述目标方程由以下多个方程定义:In some embodiments of the present disclosure, in the step A, the target equation is defined by the following multiple equations:
其中, zm=xm+iym,m=1,...,N,c=[c1,...,cN]T,cm表示N架所述无人机中第m架无人机以固定的巡航速度vm和角频率ωc进行圆周运动时,该圆形轨迹的圆心,θ=[θ1,...,θN]T,θ的每一个元素对应每个无人机的相位角;当FC(θ)取得极小值时,N架所述无人机围绕一个共同的圆心做圆周运动,当fpθ(θ)到达其惟一的极大值点时,N架所述无人机进入同步监视模式,当fpθ(θ)到达其惟一的极小值点时,N架所述无人机进入平衡监视模式。in, z m =x m +iy m , m=1,..., N, c=[c 1 ,..., c N ] T , cm represents the m -th unmanned drone among the N drones When the UAV performs circular motion at a fixed cruise speed v m and angular frequency ω c , the center of the circular trajectory, θ=[θ1,...,θ N ] T , each element of θ corresponds to each UAV When F C (θ) gets a minimum value, N UAVs make circular motions around a common center, when f pθ (θ) reaches its only maximum point, N UAVs The UAVs enter the synchronous monitoring mode, and when f pθ (θ) reaches its only minimum point, N UAVs enter the balanced monitoring mode.
在本公开的一些实施例中,所述步骤A中:In some embodiments of the present disclosure, in the step A:
同步监视模式下的目标方程如下所示:The target equation in synchronous monitoring mode is as follows:
其中:当FA(θ)取得极小值时,FC(θ)取得极小值,且到达其惟一的极大值点;in: When F A (θ) takes a minimum value, F C (θ) takes a minimum value, and reach its unique maximum point;
平衡监视模式下的目标方程如下所示:The objective equation in the balance monitor mode is as follows:
其中:当FB(θ)取得极小值时,FC(θ)取得极小值,且到达其惟一的极小值点;in: When F B (θ) takes a minimum value, F C (θ) takes a minimum value, and reaches its only minimum point;
其中, in,
在本公升的一些实施例中,所述步骤B中,根据Levenberg-Marquardt算法,求取该目标方程取得极小值过程中的下降方向。In some embodiments of the present invention, in the step B, according to the Levenberg-Marquardt algorithm, the descending direction in the process of obtaining the minimum value of the objective equation is obtained.
在本公开的一些实施例中,所属步骤B中:In some embodiments of the present disclosure, in step B:
同步监视模式下的目标方程的下降方向如下式所示:The descending direction of the target equation in synchronous monitoring mode is as follows:
其中,JA为fA(θ)的一阶偏导数, where J A is the first-order partial derivative of f A (θ),
平衡监视模式下的目标方程的下降方向如下式所示:The descending direction of the target equation in the balance monitoring mode is as follows:
其中,JB为fB(θ)的一阶偏导数, where J B is the first-order partial derivative of f B (θ),
在本公开的一些实施例中,所述步骤C中:In some embodiments of the present disclosure, in the step C:
同步监视模式下的控制率如下式所示:The control rate in synchronous monitoring mode is as follows:
θk+1=θk+dA,k+ωc θ k+1 = θ k +d A, k + ω c
平衡监视模式下的控制率如下式所示:The control rate in balanced monitoring mode is as follows:
θk+1=θk+dB,k+ωc θ k+1 = θ k +d B, k + ω c
其中,ωc为N个无人机最终期望的做圆周运动的角速度,k+1、k表示N架所述无人机的第k+1和k次采样时刻。in, ω c is the final expected angular velocity of the N UAVs to perform circular motion, and k+1 and k represent the k+1 and k sampling times of the N UAVs.
在本公开的一些实施例中,所述步骤D包括:步骤D1:参数初始化,包括:设定每架所述无人机的巡航速度vm与角频率ωc,m=1,2,...,N,令k=0;步骤D2:令k=k+1;步骤D3:将所述步骤C设计的控制率进行迭代运算;步骤D4:若所述目标方程的函数值没有减小,更新阻尼系数,并返回步骤D3重新进行迭代运算,否则进入步骤D5;步骤D5:若目标方程的函数值取得极小值,将此时得出的控制率反馈至N架所述无人机,并返回步骤D2,否则继续执行迭代运算。In some embodiments of the present disclosure, the step D includes: step D1: parameter initialization, including: setting the cruising speed v m and the angular frequency ωc of each of the UAVs, m=1, 2, .. ., N, let k=0; Step D2: Let k=k+1; Step D3: Iteratively calculate the control rate designed in Step C; Step D4: If the function value of the objective equation does not decrease, Update the damping coefficient, and return to step D3 to perform the iterative operation again, otherwise go to step D5; step D5: if the function value of the objective equation obtains a minimum value, the control rate obtained at this time is fed back to the N UAVs, And return to step D2, otherwise continue to perform the iterative operation.
在本公开的一些实施例中,其中:所述步骤D1中,参数初始化还包括:令β∈(0,1);所述步骤D4中,令Fnew=F(θk+1),所述目标方程的函数值没有减小的判断依据为:Fnew>F(θk)+βgT(θk)dk。In some embodiments of the present disclosure, wherein: in the step D1, parameter initialization further includes: let β∈(0,1); in the step D4, let Fnew=F(θ k+1 ), the The criterion for determining that the function value of the objective equation is not reduced is: Fnew>F(θ k )+βg T (θ k )d k .
在本公开的一些实施例中,其中:所述步骤D1中,参数初始化还包括:令阻尼系数μ>0,υ>1:所述步骤D4中,更新阻尼系数的方式为:令μ=μ*υ。In some embodiments of the present disclosure, wherein: in the step D1, the parameter initialization further includes: setting the damping coefficient μ>0, υ>1: in the step D4, the method of updating the damping coefficient is: let μ=μ *υ.
在本公开的一些实施例中,其中:所述步骤D1中,参数初始化还包括:设定精度参数eps,且令其逼近于0;所述步骤D5中,令tol=||dk||;所述目标方程的函数值取得极小值的判断依据是:tol≤eps。In some embodiments of the present disclosure, wherein: in the step D1, the parameter initialization further includes: setting the precision parameter eps, and making it approximate to 0; in the step D5, let tol=||d k || ; The judgment basis for obtaining the minimum value of the function value of the objective equation is: tol≤eps.
(三)有益效果(3) Beneficial effects
从上述技术方案可以看出,本公开提供的基于集群控制的多无人机协同目标监视控制方法具有以下有益效果的其中之一或其中一部分:It can be seen from the above technical solutions that the cluster control-based multi-UAV cooperative target monitoring and control method provided by the present disclosure has one or a part of the following beneficial effects:
(1)本公开提供的基于集群控制的多无人机协同目标监视控制方法,能够使多架无人机进行协同作业,增强巡视效果(多架无人机协同巡视,可以弥补一架无人机巡视精度不够的缺点)并提升系统可靠性(即使某架无人机出现问题仍有其他无人机可以正常工作);(1) The multi-UAV cooperative target monitoring and control method based on cluster control provided by the present disclosure can enable multiple UAVs to perform cooperative operations and enhance the patrol effect (multiple UAVs cooperate to patrol, which can make up for one unmanned aircraft). The shortcomings of insufficient drone patrol accuracy) and improve system reliability (even if a drone has a problem, other drones can still work normally);
(2)本公开提供的基于集群控制的多无人机协同目标监视控制方法相比于现有技术中的手动遥控方案自主化程度高;(2) Compared with the manual remote control scheme in the prior art, the multi-UAV cooperative target monitoring and control method based on cluster control provided by the present disclosure has a higher degree of autonomy;
(3)本公开提供的基于集群控制的多无人机协同目标监视控制方法能够使所有无人机做圆周运动的同时还能让它们的相位保持同步状态或平衡状态,而这两种相位分布相比于仅使用多架无人机绕飞而没有相关相位协同具有各自优势,比如,若多架无人机具有同步相位分布,内圈的无人机可以用来执行任务,外圈的无人机可以用来保护内圈的无人机,执行外围警戒;若多架无人机具有平衡相位分布,这种具有平衡相位分布的协同绕飞可以用来保护圆心位置上的目标,因多架无人机在多个同心圆上以均匀分布的相位飞行,大大增加了敌方无人机突防攻击的难度;(3) The multi-UAV cooperative target monitoring and control method based on swarm control provided by the present disclosure can make all UAVs perform circular motion while keeping their phases in a synchronized state or a balanced state, and the two phase distributions Compared with using multiple UAVs to fly around without relevant phase coordination, they have their own advantages. For example, if multiple UAVs have a synchronous phase distribution, the UAVs in the inner circle can be used to perform tasks, and the UAVs in the outer circle can be used to perform tasks. The man-machine can be used to protect the drones in the inner circle and perform peripheral alerts; if multiple drones have a balanced phase distribution, this coordinated flight with balanced phase distribution can be used to protect the target at the center of the circle. The UAV flies in a uniformly distributed phase on multiple concentric circles, which greatly increases the difficulty of the enemy UAV penetration attack;
(4)本公开提供的基于集群控制的多无人机协同目标监视控制方法可用于电力巡检领域的对电塔进行绕飞检测,军用领域对敌方军事目标进行侦察监视等应用场景中。(4) The multi-UAV cooperative target monitoring and control method based on cluster control provided by the present disclosure can be used in application scenarios such as flying around detection of electrical towers in the field of electric power inspection, and reconnaissance and monitoring of enemy military targets in the military field.
附图说明Description of drawings
图1为本公开提供的基于集群控制的多无人机协同目标监视控制方法的步骤流程图。FIG. 1 is a flow chart of steps of a method for monitoring and controlling multi-UAV cooperative targets based on swarm control provided by the present disclosure.
图2为本公开提供的基于集群控制的多无人机协同目标监视控制方法的运算逻辑结构图。FIG. 2 is an operational logic structure diagram of a multi-UAV cooperative target monitoring and control method based on cluster control provided by the present disclosure.
图3为利用本公开提供的基于集群控制的多无人机协同目标监视控制方法控制3架无人机实现同步监视模式的仿真结果图。FIG. 3 is a simulation result diagram of controlling three unmanned aerial vehicles to realize a synchronous monitoring mode by using the multi-UAV cooperative target monitoring and control method based on cluster control provided by the present disclosure.
图4为利用本公开提供的基于集群控制的多无人机协同目标监视控制方法控制2架无人机实现平衡监视模式的仿真结果图。FIG. 4 is a simulation result diagram of controlling two UAVs to realize a balanced monitoring mode by using the multi-UAV cooperative target monitoring and control method based on cluster control provided by the present disclosure.
具体实施方式Detailed ways
本公开提供的基于集群控制的多无人机协同目标监视控制方法能够使多架无人机进行协同作业,增强巡视效果并提升系统可靠性。The multi-UAV cooperative target monitoring and control method based on cluster control provided by the present disclosure can enable multiple UAVs to perform cooperative operations, enhance the patrol effect and improve the system reliability.
为使本公开的目的、技术方案和优点更加清楚明白,以下结合具体实施例,并参照附图,对本公开进一步详细说明。In order to make the objectives, technical solutions and advantages of the present disclosure clearer, the present disclosure will be further described in detail below with reference to the specific embodiments and the accompanying drawings.
本公开提供一种基于集群控制的多无人机协同目标监视控制方法,使N架无人机从其各自的初始位置,以任意初始速度出发,围绕同一个圆心以不同的半径做圆周运动,且达到稳定状态时,N架无人机进入同步监视模式(所有无人机具有相同的航向角)或平衡监视模式(所有无人机的航向角均匀的分布在一个圆周上),N≥2,如图1所示,包括:The present disclosure provides a multi-unmanned aerial vehicle (UAV) cooperative target monitoring and control method based on cluster control, which enables N UAVs to start from their respective initial positions and start at any initial speed, and to perform circular motions with different radii around the same center. And when the steady state is reached, N UAVs enter the synchronous monitoring mode (all UAVs have the same heading angle) or the balanced monitoring mode (the heading angles of all UAVs are evenly distributed on a circle), N≥2 , as shown in Figure 1, including:
步骤A:建立目标方程,使目标方程求出极小值时N架无人机的相位达到期望的相位分布;Step A: establish a target equation, so that the phase of the N UAVs reaches the desired phase distribution when the target equation obtains a minimum value;
步骤B:求取该目标方程取得极小值过程中的下降方向;Step B: Find the descending direction in the process of obtaining the minimum value of the target equation;
步骤C:基于该下降方向,设计N架无人机的控制率;Step C: Based on the descending direction, design the control rate of N UAVs;
步骤D:迭代计算控制率,将目标方程对应的控制率发送至N架无人机;Step D: iteratively calculate the control rate, and send the control rate corresponding to the target equation to N UAVs;
步骤E:重复步骤D,直至N架无人机终止监视模式。Step E: Repeat step D until N drones terminate the monitoring mode.
为使本公开实施例提供的基于集群控制的多无人机协同目标监视控制方法更便于理解,以下通过建立系统模型,对本公开实施例提供的基于集群控制的多无人机协同目标监视控制方法进行解释说明:In order to make the multi-UAV cooperative target monitoring and control method based on swarm control provided by the embodiment of the present disclosure easier to understand, the following describes the multi-UAV cooperative target monitoring and control method based on swarm control provided by the embodiment of the present disclosure by establishing a system model. To explain:
在一组含有N个无人机的无人机集群中,第m个无人机的系统模型描述为:In a set of UAV swarms containing N UAVs, the system model of the m-th UAV is described as:
其中θm是第m个无人机的相位角,xm,是第m个无人机的位置坐标,m=1,...,N。Δt是采样时间,假定无人机m有一个正的定常巡航速度vm>0,且是其控制输入,为了便于分析,在本实施例中,省略Δt,并且上标m和下标m具有相同的含义。where θm is the phase angle of the mth UAV, xm , are the position coordinates of the mth UAV, m=1,...,N. Δt is the sampling time, assuming that the UAV m has a positive steady cruise speed v m > 0, and is its control input. For the convenience of analysis, in this embodiment, Δt is omitted, and the superscript m and the subscript m have the same meaning.
为了定义一组N个无人机需要形成的两种期望形式(同步监视模式和平衡监视模式)的相位分布,首先通过下式定义参数pθ:In order to define the phase distribution of the two desired forms (synchronous surveillance mode and balanced surveillance mode) that a set of N UAVs need to form, the parameter p θ is first defined by:
同步相位分布的定义为:当所有无人机的相位都相同时,对于m,n=1,...,N,随着t→∞,|pθ|→1,即:随着t→∞,θm-θn→0;The synchronization phase distribution is defined as: when the phases of all UAVs are the same, for m, n = 1, ..., N, as t→∞, |p θ |→1, that is: as t→ ∞, θ m - θ n → 0;
平衡相位分布的定义为:各个无人机的相位值使得随着t→∞,|pθ|→0。The balanced phase distribution is defined as: the phase value of each UAV is such that as t→∞, |p θ |→0.
假定第m架无人机以固定的巡航速度vm和角频率ωc进行圆周运动,则此圆周的半径rm=vm/|ωc|,令zm=xm+iym,可求得此圆周的圆心为Assuming that the m-th UAV performs a circular motion with a fixed cruising speed v m and angular frequency ω c , the radius of the circle r m =v m /|ω c |, let z m =x m +iy m , we can obtain Find the center of this circle as
定义投影矩阵令c=[c1,...,cN]T,当且仅当Define the projection matrix Let c=[c 1 , . . . , c N ] T , if and only if
时,所有无人机运动轨迹的圆心将会重合,基于此,定义如下的目标方程 When , the centers of all UAV trajectories will coincide. Based on this, the following target equation is defined
其中定义如下:in Defined as follows:
对于m=1,...,N,当且仅当FC(θ)取得其惟一的极小值时,Pc=0;至此,实现了令一组无人机围绕一个共同的圆心做圆周运动,在此基础上,为了使多架无人机的相位达到期望的相位分布,定义如下的目标的方程 For m=1, . On this basis, in order to make the phases of multiple UAVs reach the desired phase distribution, the following equations of the target are defined
其中,θ=[θ1,...,θN]T,θ的每一个元素对应每个无人机的相位角;当达到其惟一的极大值点时,所有无人机的相位角相同;当达到其惟一极小值点时,所有无人机的相位平衡。Among them, θ=[θ 1 ,...,θ N ] T , each element of θ corresponds to the phase angle of each UAV; when When reaching its unique maximum point, all UAVs have the same phase angle; when The phases of all drones are balanced when they reach their only minimum point.
因此,在本公开的一些实施例中,步骤A中,目标方程由以下多个方程定义:Therefore, in some embodiments of the present disclosure, in step A, the target equation is defined by the following equations:
当FC(θ)取得极小值时,N架所述无人机围绕一个共同的圆心做圆周运动,当到达其惟一的极大值点时,N架所述无人机进入同步监视模式,当到达其惟一的极小值点时,N架所述无人机进入平衡监视模式。When F C (θ) achieves a minimum value, the N UAVs make a circular motion around a common center, and when When reaching its unique maximum point, N said UAVs enter the synchronous monitoring mode, when When reaching its only minimum point, the N said UAVs enter the balance monitoring mode.
在本公开的一些实施例中,为了实现上述两个目标:令所有无人机围绕同一圆心以不同半径做圆周运动并实现两种期望的相位分布模式,设计如下的目标方程在步骤A中:In some embodiments of the present disclosure, in order to achieve the above two goals: make all UAVs make circular motions around the same center with different radii and achieve two desired phase distribution modes, the following objective equations are designed In step A:
同步监视模式下的目标方程如下所示:The target equation in synchronous monitoring mode is as follows:
其中:当FA(θ)取得极小值时,FC(θ)取得极小值,且到达其惟一的极大值点;in: When F A (θ) takes a minimum value, F C (θ) takes a minimum value, and reach its unique maximum point;
平衡监视模式下的目标方程如下所示:The objective equation in the balance monitor mode is as follows:
其中:当FB(θ)取得极小值时,FC(θ)取得极小值,且到达其惟一的极小值点;in: When F B (θ) takes a minimum value, F C (θ) takes a minimum value, and reaches its only minimum point;
其中,Umαx为的极大值,且 where U mαx is the maximum value of , and
在本公开的一些实施例中,寻求目标函数FA(θ)或FB(θ)的极小值的过程实际是解决最小二乘问题,因此在步骤B中,采用解决此类问题比较有效的Levenbeg-Marquardt方法来求取该目标方程取得极小值过程中的下降方向。In some embodiments of the present disclosure, the process of finding the minimum value of the objective function F A (θ) or F B (θ) is actually solving the least squares problem, so in step B, it is more effective to solve such problems by using The Levenbeg-Marquardt method is used to find the descending direction in the process of obtaining the minimum value of the objective equation.
在本公开的一些实施例,所述步骤B中,根据Levenbeg-Marquardt方法:In some embodiments of the present disclosure, in the step B, according to the Levenbeg-Marquardt method:
同步监视模式下的目标方程的下降方向如下式所示:The descending direction of the target equation in synchronous monitoring mode is as follows:
其中,JA为fA(θ)的一阶偏导数, where J A is the first-order partial derivative of f A (θ),
平衡监视模式下的目标方程的下降方向如下式所示:The descending direction of the target equation in the balance monitoring mode is as follows:
其中,JB为fB(θ)的一阶偏导数, where J B is the first-order partial derivative of f B (θ),
在本公开的一些实施例中,为了能够让无人机做圆周运动,基于上述下降方向,步骤C中:In some embodiments of the present disclosure, in order to allow the drone to perform circular motion, based on the above-mentioned descending direction, in step C:
设计同步监视模式下的控制率如下式所示:The control rate in the synchronous monitoring mode is designed as follows:
θk+1=θk+dA,k+ωc θ k+1 = θ k +d A, k + ω c
设计平衡监视模式下的控制率如下式所示:The control rate in design balance monitoring mode is as follows:
θk+1=θk+dB,k+ωc θ k+1 = θ k +d B, k + ω c
其中,ωc为N个无人机最终期望的做圆周运动的角速度,k+1、k表示N架所述无人机的第k+1和k次采样时刻。in, ω c is the final expected angular velocity of the N UAVs to perform circular motion, and k+1 and k represent the k+1 and k sampling times of the N UAVs.
在本公开的一些实施例中,如图2所示,步骤D包括:In some embodiments of the present disclosure, as shown in FIG. 2 , step D includes:
步骤D1:参数初始化,包括:设定每架所述无人机的巡航速度vm(即在协同控制开始时各个无人机的初始巡航速度)与角频率ωc(即最终期望的多个无人机做圆周运动的角速度),m=1,2,...,N,令k=0,β∈(0,1),阻尼系数μ>0,系数υ>1,设定精度参数eps,且令其逼近于0(例如:eps=10-6);Step D1: parameter initialization, including: setting the cruising speed vm of each UAV (that is, the initial cruising speed of each UAV at the beginning of the cooperative control) and the angular frequency ω c (that is, the final desired multiple The angular velocity of the UAV doing circular motion), m=1, 2, ..., N, let k=0, β∈(0,1), damping coefficient μ>0, coefficient υ>1, set the accuracy parameter eps, and make it close to 0 (for example: eps=10 -6 );
步骤D2:令k=k+1;Step D2: let k=k+1;
步骤D3:将所述步骤C设计的控制率进行迭代运算;Step D3: performing an iterative operation on the control rate designed in step C;
步骤D4:令Fnew=F(θk+1),若Fnew>F(θk)+βgT(θk)dk,说明目标方程的函数值没有减小,此时更新阻尼系数令μ=μ*υ,并返回步骤D3重新进行迭代运算,否则进入步骤D5;Step D4: Let Fnew=F(θ k+1 ), if Fnew>F(θ k )+βg T (θ k )d k , it means that the function value of the objective equation does not decrease, and the damping coefficient is updated to make μ= μ*υ, and return to step D3 to perform the iterative operation again, otherwise go to step D5;
步骤D5:令tol=||dk||,若tol≤eps,说明此时目标方程的函数值取得极小值,将此时得出的控制率反馈至N架无人机,并返回步骤D2,否则继续执行迭代运算。Step D5: Let tol=||d k ||, if tol≤eps, it means that the function value of the objective equation has obtained a minimum value at this time, and the control rate obtained at this time is fed back to N UAVs, and returns to the step D2, otherwise continue to perform the iterative operation.
以下以两具体实施例,验证本公开实施例提供的基于集群控制的多无人机协同目标监视控制方法的有效性:The following two specific embodiments are used to verify the effectiveness of the multi-UAV cooperative target monitoring and control method based on cluster control provided by the embodiments of the present disclosure:
实施例1:在本实施例中,由3个无人机组成的无人机集群其初始速度与相位角分别设定为v1=0.3m/s,v2=0.6m/s,v3=0.9m/s,θ1=0,θ2=π/4,θ3=π/2,所有无人机期望的最终角速度为ωc=0.3,算法参数设定为β=0.4,μ=8,υ=1.5,如图3所示,所有无人机从不同初始位置以不同初始相位出发,围绕同一个圆心做圆周运动,最终,所有无人机的相位达到同步相位分布状态。Embodiment 1: In this embodiment, the initial speed and phase angle of the UAV swarm composed of 3 UAVs are respectively set as v 1 =0.3m/s, v 2 =0.6m/s, v 3 =0.9m/s, θ 1 =0, θ 2 =π/4, θ 3 =π/2, the desired final angular velocity of all UAVs is ω c =0.3, the algorithm parameters are set as β = 0.4, μ = 8, υ = 1.5, as shown in Figure 3, all UAVs start from different initial positions with different initial phases, and make circular motions around the same center. Finally, the phases of all UAVs reach a synchronous phase distribution state.
实施例2:在本实施例中,由2个无人机组成的无人机集群其初始速度与相位角分别设定为v1=0.3m/s,v2=0.6m/s,θ1=0,θ2=π/4,所有无人机期望的最终角速度为ωc=0.3,算法参数设定为β=0.4,μ=8,υ=1.5,如图4所示,所有无人机从不同初始位置以不同初始相位出发,围绕同一个圆心做圆周运动,最终,所有无人机在实现同圆心运动的同时实现了平衡相位分布。Embodiment 2: In this embodiment, the initial speed and phase angle of the UAV swarm composed of two UAVs are set as v 1 =0.3m/s, v 2 =0.6m/s, θ 1 = 0, θ 2 = π/4, the desired final angular velocity of all UAVs is ω c = 0.3, and the algorithm parameters are set to β = 0.4, μ = 8, υ = 1.5, as shown in Figure 4, all unmanned The drones start from different initial positions with different initial phases, and make circular motions around the same center. In the end, all drones achieve balanced phase distribution while achieving concentric motion.
依据以上描述,本领域技术人员应当对本公开实施例提供的基于集群控制的多无人机协同目标监视控制方法有了清楚的认识。Based on the above description, those skilled in the art should have a clear understanding of the multi-UAV cooperative target monitoring and control method based on cluster control provided by the embodiments of the present disclosure.
综上所述,本公开提供的基于集群控制的多无人机协同目标监视控制方法通过建立目标方程,并对目标方程求取极小值,从而实现多架无人机进行协同作业,增强巡视效果并提升系统可靠性。To sum up, the multi-UAV cooperative target monitoring and control method based on cluster control provided by the present disclosure realizes the cooperative operation of multiple UAVs and enhances the patrol by establishing the target equation and obtaining the minimum value of the target equation. effect and improve system reliability.
还需要说明的是,实施例中提到的方向用语,例如“上”、“下”、“前”、“后”、“左”、“右”等,仅是参考附图的方向,并非用来限制本公开的保护范围。贯穿附图,相同的元素由相同或相近的附图标记来表示。在可能导致对本公开的理解造成混淆时,将省略常规结构或构造。It should also be noted that the directional terms mentioned in the embodiments, such as "up", "down", "front", "rear", "left", "right", etc., only refer to the directions of the drawings, not used to limit the scope of protection of the present disclosure. Throughout the drawings, the same elements are denoted by the same or similar reference numbers. Conventional structures or constructions will be omitted when it may lead to obscuring the understanding of the present disclosure.
并且图中各部件的形状和尺寸不反映真实大小和比例,而仅示意本公开实施例的内容。另外,在权利要求中,不应将位于括号之间的任何参考符号构造成对权利要求的限制。Moreover, the shapes and sizes of the components in the figures do not reflect the actual size and proportion, but merely illustrate the contents of the embodiments of the present disclosure. Furthermore, in the claims, any reference signs placed between parentheses shall not be construed as limiting the claim.
类似地,应当理解,为了精简本公开并帮助理解各个公开方面中的一个或多个,在上面对本公开的示例性实施例的描述中,本公开的各个特征有时被一起分组到单个实施例、图、或者对其的描述中。然而,并不应将该公开的方法解释成反映如下意图:即所要求保护的本公开要求比在每个权利要求中所明确记载的特征更多的特征。更确切地说,如前面的权利要求书所反映的那样,公开方面在于少于前面公开的单个实施例的所有特征。因此,遵循具体实施方式的权利要求书由此明确地并入该具体实施方式,其中每个权利要求本身都作为本公开的单独实施例。Similarly, it will be appreciated that in the above description of exemplary embodiments of the disclosure, various features of the disclosure are sometimes grouped together into a single embodiment, figure, or its description. However, this method of disclosure should not be interpreted as reflecting an intention that the claimed disclosure requires more features than are expressly recited in each claim. Rather, as the foregoing claims reflect, disclosed aspects lie in less than all features of a single foregoing disclosed embodiment. Thus, the claims following the Detailed Description are hereby expressly incorporated into this Detailed Description, with each claim standing on its own as a separate embodiment of the present disclosure.
以上所述的具体实施例,对本公开的目的、技术方案和有益效果进行了进一步详细说明,所应理解的是,以上所述仅为本公开的具体实施例而已,并不用于限制本公开,凡在本公开的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本公开的保护范围之内。The specific embodiments described above further describe the purpose, technical solutions and beneficial effects of the present disclosure in detail. It should be understood that the above-mentioned specific embodiments are only specific embodiments of the present disclosure, and are not intended to limit the present disclosure. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present disclosure should be included within the protection scope of the present disclosure.
Claims (9)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811298179.8A CN109491402B (en) | 2018-11-01 | 2018-11-01 | Multi-unmanned aerial vehicle cooperative target monitoring control method based on cluster control |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811298179.8A CN109491402B (en) | 2018-11-01 | 2018-11-01 | Multi-unmanned aerial vehicle cooperative target monitoring control method based on cluster control |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109491402A CN109491402A (en) | 2019-03-19 |
CN109491402B true CN109491402B (en) | 2020-10-16 |
Family
ID=65693574
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811298179.8A Active CN109491402B (en) | 2018-11-01 | 2018-11-01 | Multi-unmanned aerial vehicle cooperative target monitoring control method based on cluster control |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109491402B (en) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110377059A (en) * | 2019-08-29 | 2019-10-25 | 哈尔滨工程大学 | A kind of more AUV person of surrounding and seize cooperative control methods based on lion group's algorithm |
CN114647240A (en) * | 2021-05-10 | 2022-06-21 | 中国科学技术大学 | Three-ring perception obstacle avoidance method and obstacle avoidance system using the same |
CN113391646A (en) * | 2021-07-20 | 2021-09-14 | 国网青海省电力公司海西供电公司 | Inspection system of power transmission line |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103744390A (en) * | 2013-12-31 | 2014-04-23 | 中国测绘科学研究院 | Cooperative control method for inspection of power line of unmanned aerial vehicle |
CN106406346A (en) * | 2016-11-01 | 2017-02-15 | 北京理工大学 | Plan method for rapid coverage track search coordinated by multiple UAVs (Unmanned Aerial Vehicles) |
CN106814752A (en) * | 2017-03-21 | 2017-06-09 | 广东容祺智能科技有限公司 | A kind of round-the-clock City Surveillance System based on unmanned plane cluster |
CN106873628A (en) * | 2017-04-12 | 2017-06-20 | 北京理工大学 | A kind of multiple no-manned plane tracks the collaboration paths planning method of many maneuvering targets |
CN107179777A (en) * | 2017-06-03 | 2017-09-19 | 复旦大学 | Multiple agent cluster Synergistic method and multiple no-manned plane cluster cooperative system |
CN107422748A (en) * | 2017-06-29 | 2017-12-01 | 南京航空航天大学 | A kind of fixed-wing unmanned plane formation guidance device and collaboration homing guidance method |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7191056B2 (en) * | 2005-01-04 | 2007-03-13 | The Boeing Company | Precision landmark-aided navigation |
US8126848B2 (en) * | 2006-12-07 | 2012-02-28 | Robert Edward Wagner | Automated method for identifying and repairing logical data discrepancies between database replicas in a database cluster |
TW201215442A (en) * | 2010-10-06 | 2012-04-16 | Hon Hai Prec Ind Co Ltd | Unmanned Aerial Vehicle control system and method |
CN102692225B (en) * | 2011-03-24 | 2015-03-11 | 北京理工大学 | Attitude heading reference system for low-cost small unmanned aerial vehicle |
FR2998363B1 (en) * | 2012-11-19 | 2015-01-02 | Inria Inst Nat Rech Informatique & Automatique | METHOD FOR DETERMINING, IN A 3D FIXED REFERENTIAL, THE LOCATION OF A MOVING GEAR, ASSOCIATED DEVICE AND COMPUTER PROGRAM |
CN103744372B (en) * | 2013-12-23 | 2016-06-08 | 广东电网公司电力科学研究院 | The multisensor method for synchronizing time of unmanned plane electric inspection process and system |
CN105573340B (en) * | 2016-01-15 | 2019-06-04 | 中国人民解放军国防科学技术大学 | A crosswind-resistant flight control method for fixed-wing unmanned aerial vehicles |
CN106846922A (en) * | 2017-03-14 | 2017-06-13 | 武汉天宇智戎防务科技有限公司 | Low altitude short range cluster cooperates with defence system and defence method |
CN108476288B (en) * | 2017-05-24 | 2021-05-07 | 深圳市大疆创新科技有限公司 | Shooting control method and device |
-
2018
- 2018-11-01 CN CN201811298179.8A patent/CN109491402B/en active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103744390A (en) * | 2013-12-31 | 2014-04-23 | 中国测绘科学研究院 | Cooperative control method for inspection of power line of unmanned aerial vehicle |
CN106406346A (en) * | 2016-11-01 | 2017-02-15 | 北京理工大学 | Plan method for rapid coverage track search coordinated by multiple UAVs (Unmanned Aerial Vehicles) |
CN106814752A (en) * | 2017-03-21 | 2017-06-09 | 广东容祺智能科技有限公司 | A kind of round-the-clock City Surveillance System based on unmanned plane cluster |
CN106873628A (en) * | 2017-04-12 | 2017-06-20 | 北京理工大学 | A kind of multiple no-manned plane tracks the collaboration paths planning method of many maneuvering targets |
CN107179777A (en) * | 2017-06-03 | 2017-09-19 | 复旦大学 | Multiple agent cluster Synergistic method and multiple no-manned plane cluster cooperative system |
CN107422748A (en) * | 2017-06-29 | 2017-12-01 | 南京航空航天大学 | A kind of fixed-wing unmanned plane formation guidance device and collaboration homing guidance method |
Non-Patent Citations (2)
Title |
---|
Near-optimal continuous patrolling with teams of mobile information gathering agents;Stranders.R;《ARTIFICIAL INTELLIGENCE》;20130228;第195卷;全文 * |
无人机集群系统侦察监视任务规划方法;陈少飞;《中国博士学位论文全文数据库(工程科技Ⅱ辑)》;20171115(第11期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN109491402A (en) | 2019-03-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110488867B (en) | Unmanned aerial vehicle cluster convoying behavior generation method based on improved virtual force field | |
AU2017344750B2 (en) | Thrust vectored multicopters | |
US11084579B2 (en) | Convertible biplane aircraft for capturing drones | |
CN107957730B (en) | A kind of unmanned aerial vehicle stable flight control method | |
Floreano et al. | Science, technology and the future of small autonomous drones | |
CN109358638B (en) | Visual Obstacle Avoidance Method for UAV Based on Distributed Map | |
CN103365297B (en) | Based on four rotor wing unmanned aerial vehicle flight control methods of light stream | |
CN109491402B (en) | Multi-unmanned aerial vehicle cooperative target monitoring control method based on cluster control | |
Moore et al. | Autonomous MAV guidance with a lightweight omnidirectional vision sensor | |
CN109375645B (en) | Multi-unmanned aerial vehicle collaborative regional patrol control method based on cluster intelligence | |
CN205098466U (en) | Population density monitoring devices based on many rotors | |
Papachristos et al. | Modeling and control simulation of an unmanned tilt tri-rotor aerial vehicle | |
CN110308742B (en) | Time-varying formation control method of multiple UAVs based on synchronization strategy | |
US11124296B2 (en) | Flying wing aircraft having flight and storage configurations | |
KR102684376B1 (en) | Autonormous flight uav and method controlling thereof | |
Zhang et al. | Optimal trajectory generation for time-to-contact based aerial robotic perching | |
CN102393644A (en) | Ducted unmanned aerial vehicle anti-sway method based on optimized quadratic form control of artificial bee colony | |
US20200017212A1 (en) | Flying Wing Aircraft having a Two-dimensional Thrust Array | |
CN111443733A (en) | Unmanned aerial vehicle flight control method and device and unmanned aerial vehicle | |
US20220024583A1 (en) | Tether controlled drone | |
US20200017213A1 (en) | Flying Wing Aircraft having a Compact Storage Configuration | |
CN116009570A (en) | Time cooperative control method of variable speed aircraft | |
CN117311386A (en) | Bionic trapping cluster control method considering multi-angle constraint | |
CN113110600B (en) | Control method and system of micro jet-powered UAV | |
Pimentel et al. | Design, modeling and control of an over-actuated hexacopter tilt-rotor |
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 |