CN110308742A - 基于同步策略的多无人机时变编队控制方法 - Google Patents
基于同步策略的多无人机时变编队控制方法 Download PDFInfo
- Publication number
- CN110308742A CN110308742A CN201910692450.4A CN201910692450A CN110308742A CN 110308742 A CN110308742 A CN 110308742A CN 201910692450 A CN201910692450 A CN 201910692450A CN 110308742 A CN110308742 A CN 110308742A
- Authority
- CN
- China
- Prior art keywords
- unmanned plane
- formation
- varying
- time
- error
- 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
Links
- 230000015572 biosynthetic process Effects 0.000 title claims abstract description 53
- 238000000034 method Methods 0.000 title claims abstract description 22
- 238000013178 mathematical model Methods 0.000 claims abstract description 12
- 238000013461 design Methods 0.000 claims abstract description 10
- 238000009415 formwork Methods 0.000 claims abstract description 7
- 230000001360 synchronised effect Effects 0.000 claims abstract description 7
- 239000011159 matrix material Substances 0.000 claims description 7
- 238000009795 derivation Methods 0.000 claims description 5
- 230000001133 acceleration Effects 0.000 claims description 4
- 230000005484 gravity Effects 0.000 claims description 2
- 230000000750 progressive effect Effects 0.000 abstract description 2
- 230000008878 coupling Effects 0.000 description 3
- 238000010168 coupling process Methods 0.000 description 3
- 238000005859 coupling reaction Methods 0.000 description 3
- 238000013519 translation Methods 0.000 description 2
- 238000010276 construction Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000011835 investigation Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
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)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种基于同步策略的多无人机时变编队控制方法,首先采用一种带有时变参数的椭球方程来描述无人机在三维空间中的编队;然后将无人系统的分为位置子系统和姿态子系统并建立对应的数学模型,定义由单个无人机的位置误差和无人机之间的同步误差构成的编队误差;最后,基于滑模控制的方法设计位置子系统和姿态子系统的控制律,使无人机的编队误差渐进趋向于零。该发明提出的基于同步策略的多无人机时变编队控制方法能够光滑地实现无人机的时变编队控制,并且通过解耦有效地降低了无人机编队队形协调控制的复杂性,使无人机编队能够应用于侦察、救援、巡航等任务。
Description
技术领域
本发明属于无人机编队控制技术领域,具体为一种基于同步策略的多无人机时变编队控制方法。
背景技术
近年来,无人机以其独特的优势得到各行业的重视,比如它的机动性能特别好,环境适应能力很强,可以执行侦查拍摄、火力打击等各种任务而且它的隐身性能也很可观,最重要的是它可以避免人员伤亡。
单个四旋翼飞行器具有许多良好的特性,例如体积小,灵活性好,隐蔽性好,适应性强。然而,它仍然存在一些缺点,当一个四旋翼飞行器在执行任务时,如果发生故障,它必须返回进行修复,如果它被损坏,那很有可能中断任务。另一方面,单四旋翼飞行器的效率有限。在执行观察或评估任务时,很容易错过目标,无法同时获取目标区域中的所有信息。为了解决这个问题,我们可以让多个四旋翼一起工作来完成任务,即无人机的编队飞行。
绝大多数现有研究结果中的编队都是时不变的。然而,这些构造通常不能满足各种应用中的实际要求。此外,应该指出时不变编队的结果一般不能直接应用于时变编队。因此,研究时变编队的控制更有意义。
发明内容
本发明的目的在于克服现有技术中的不足,提出一种基于同步策略的多无人机时变编队控制方法,该方法能够光滑地实现无人机的时变编队,并且有效地降低了无人机编队在三维空间中的队形控制的耦合性,使无人机编队能够应用于侦察、救援、巡航等任务。
本发明提供了一种基于同步策略的多无人机时变编队控制方法,包括以下步骤:
步骤S1,建立描述三维空间中的无人机编队队形的数学模型;
该数学模型采用带有时变参数的椭球方程进行描述,如下:
其中,xi(t),yi(t),zi(t)是椭球面上的一点(i=1~n),即为无人机在三维空间中的位置;a(t),b(t),c(t),为椭球在三维方向上的长轴;θ(t),φ(t),n(t)为时变参数;x0(t),y0(t),z0(t)为椭球的中心点,且:
其中Ai(t)表示椭圆的参数矩阵;
步骤S2,基于拉格朗日牛顿方程构建四旋翼无人机的数学模型:
其中,φ,θ,ψ分别为四旋翼无人机的滚转角、俯仰角和偏航角;x,y,z为四旋翼无人机质心的位置坐标;l是旋翼末端到旋翼前端的距离;m为四旋翼无人机的质量,I为每个轴的转动惯量,K1-K6为阻力系数;U1-U4为虚拟控制输入;示无人机在三维空间中x,y,z方向的速度;表示无人机在三维空间中x,y,z方向的加速度;表示对应角度的一阶导数;表示对应角度的二阶导数;
步骤S3,基于同步控制策略设计四旋翼无人机位置系统的控制律;
其中,B-1(t)=A(t),σ(t)为引入的中间变量,E(t)为误差方程;
本发明提供了一种基于同步策略的多无人机时变编队控制方法,首先,使用了带有时变参数的椭球参数方程来描述无人机的编队队形,在该参数方程中,通过调节参数的大小来实时地改变编队的队形,这种方式有效地降低了无人机编队在三维空间中的队形控制的耦合性,能够光滑地使编队队形趋于预期的队形。然后,通过定义无人机的位置误差和同步误差来构建无人机编队的误差方程,接着使用滑模控制的方法设计位置误差的控制律使无人机编队的误差趋向于零。
与现有技术相比,本发明所考虑的是三维空间中的四旋翼无人机时变编队队形的控制,通过一种椭球方程来描述无人机的编队,通过这种方式能够更加方便地对无人机的队形加以控制,使得四旋翼无人机编队控制在实际的应用中能够得到进一步的推广。
附图说明
图1为本发明方法的流程框图;
图2为无人机编队在三维空间中飞行的轨迹变化曲线;
图3为无人机编队在三维空间中飞行轨迹在xoy平面上的投影变化曲线;
图4为无人机编队在x方向上的位置变化曲线;
图5为无人机编队在y方向上的位置变化曲线;
图6为无人机编队在z方向上的位置变化曲线;
图7为无人机编队在x方向上的速度变化曲线;
图8为无人机编队在y方向上的速度变化曲线;
图9为无人机编队在z方向上的速度变化曲线;
图10为无人机编队在三维空间中对期望速度的跟踪情况,无人机的期望速度可以根据上述的期望位置求导得到;
图11为无人机编队在三维空间中飞行时各无人机之间的距离变化曲线。
具体实施方式
为了使本技术领域的人员更好地理解本发明方案,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述。
对于所述的三维空间中的无人机编队队形的数学模型,该数学模型采用带有时变参数的椭球方程进行描述,如下:
为了实现编队队形在三维空间中进行时变变化,需要将该椭球方程写成参数方程的形式:
进一步将上式写成矩阵的形式,得到最终用于描述编队队形的形式:
在实施例中,本发明使用三架四旋翼无人机来组成编队(i=1,2,3),三架无人机位于椭球面之上,当编队在三维空间中进行飞行时,这三架无人机围绕椭球的中心点进行旋转,同时,整个编队跟随这个中心点进行实时地移动。
对于所述的四旋翼无人机的数学模型,将其分成位置子系统和姿态子系统:
位置子系统为:
其中:
姿态子系统为:
针对所述的基于同步控制策略设计的四旋翼无人机位置系统的控制律具体如下:
定义无人机的位置误差:
ei(t)=Pi d-Pi(i=1,2,...n,令n+1=1) (10)
其中:Pi d为无人机的期望位置,Pi为无人机的实际位置,
定义无人机之间的同步误差:
即有:
Bi(t)ei(t)=Bi+1(t)ei+1(t) (12)
则令同步误差为:δi(t)=Bi(t)ei(t)-Bi+1(t)ei+1(t) (13)如果实现无人机的编队飞行,则需要满足下式:
定义编队误差方程:
对误差方程进行求导:
令:
则有:
引入中间变量:
其中,
设计滑模函数:
对滑模函数进行求导:
并将位置子系统代入:
由此可以设计出控制输入:
其中,为中间变量σ(t)对应的一阶导数;为误差方程E(t)的一阶导数;控制输入中的K>0、r>0为可调参数;B-1(t)=A(t)为椭圆的参数矩阵;P(t)为无人机在三维空间中的位置;为无人机在三维空间中的速度;g为重力加速度;
为了更好说明本发明方法对四旋翼无人机时变编队的有效控制,在此进行仿真说明:设定无人机的物理参数:无人机质量m=2kg,旋翼末端到旋翼前端的距离l=0.2m,轴转动惯量分别为I1=1.25,I2=1.25,I3=2.5,阻力系数K1=0.01,K2=0.01,K3=0.01,K4=0.02,K5=0.02,K6=0.02,三架无人机的初始位置分别为:(0,0,0)、(0.5,0.5,0.5)、(1,1,1)。此外,在本例中,设定时变参数a=6+0.1t,b=6+0.1t,c=1.5t,x0=6+0.1t,y0=6+0.1t,z0=1.5t,编队中各无人机对应的期望位置为:
[x0,y0,z0]T+[0.5acos(0.2t+0.52),0.5bcos(0.2t+0.52),1.3t]T
[x0,y0,z0]T+[0.5acos(0.2t+2.6),0.5bcos(0.2t+2.6),1.3t]T
[x0,y0,z0]T+[0.5acos(0.2t+4.7),0.5bcos(0.2t+4.7),1.3t]T,
结合图2,无人机在三维空间中进行编队队形的时变变化,该队形的变化包含了三种基本的队形变化:平移、放缩并保持、旋转。对于编队的旋转运动,设定三架无人机绕椭球中心变化的角度分别为:0.2t+0.52,0.2t+2.6,0.2t+4.7,这里的系数0.2为旋转的角速度,转化为角度制为11.46°,即每经过31秒可以完成一次编队的旋转。图3说明了无人机编队在xoy平面上飞行轨迹的变化情况,从该图中能够更加清楚地看到,整个无人机编队做平移运动,同时编队的队形在不断变大(0~30s),之后保持不变(30~60s),而且整个编队处于实时地旋转当中。参考图4,图5,图6,分别为无人机编队在三维空间中位置的变化情况,结合上述编队中的三种基本运动,无人机的位置变化包含三角函数的部分,且其振幅不断变大。图7,8,9,说明了无人机编队在三维空间中速度的实时变化情况。图10说明了无人机编队中各个无人机对自身期望速度的跟踪情况,该曲线具体含义是每架无人机在各个方向上误差的平方根。图11为无人机编队在三维空间中飞行时各无人机之间的距离变化,可以看到在0~30s时无人机之间的距离逐渐增大,即对应整个编队队形的扩大,在30~60s时无人机之间的距离保持不变,对应无人机编队队形保持固定不变。
本发明基于同步策略的三维空间中的多无人机时变编队控制方法,首先采用一种带有时变参数的椭球方程来描述无人机在三维空间中的编队;然后将无人系统的分为位置子系统和姿态子系统并建立对应的数学模型,定义由单个无人机的位置误差和无人机之间的同步误差构成的编队误差;最后,基于滑模控制的方法设计位置子系统和姿态子系统的控制律,使无人机的编队误差渐进趋向于零。该发明提出的基于同步策略的多无人机时变编队控制方法能够光滑地实现无人机的时变编队,并且有效地降低了无人机编队在三维空间中的队形控制的耦合性,使无人机编队能够应用于侦察、救援、巡航等任务。
以上所述仅是本发明的优选实施方式,应当指出,对于本领域的技术人员而言,其依然可以对前述各具体实施方式所记载的技术方案进行修改,或者对其中部分技术特征进行等效替换。凡是利用本发明说明书及附图内容所做的等效结构,直接或间接运用在其他相关的技术领域,均同理在本发明专利保护范围之内。
Claims (4)
1.基于同步策略的多无人机时变编队控制方法,其特征是,包括以下步骤:
步骤S1,建立描述三维空间中的无人机编队队形的数学模型;
该数学模型采用带有时变参数的椭球方程进行描述,如下:
其中,xi(t),yi(t),zi(t)是椭球面上的一点(i=1~n),即为无人机在三维空间中的位置;a(t),b(t),c(t),为椭球在三维方向上的长轴;θ(t),φ(t),n(t)为时变参数;x0(t),y0(t),z0(t)为椭球的中心点,且:
其中Ai(t)表示椭圆的参数矩阵;
步骤S2,基于拉格朗日牛顿方程构建四旋翼无人机的数学模型;
其中,φ,θ,ψ分别为四旋翼无人机的滚转角、俯仰角和偏航角;x,y,z为四旋翼无人机质心的位置坐标;l是旋翼末端到旋翼前端的距离;m为四旋翼无人机的质量,I为每个轴的转动惯量,K1-K6为阻力系数;U1-U4为虚拟控制输入;表示无人机在三维空间中x,y,z方向的速度;表示无人机在三维空间中x,y,z方向的加速度;表示对应角度的一阶导数;表示对应角度的二阶导数;
步骤S3,基于同步控制策略设计四旋翼无人机位置系统的控制律;
其中,B-1(t)=A(t),σ(t)为引入的中间变量,E(t)为误差方程。
2.如权利要求1所述的基于同步策略的多无人机时变编队控制方法,其特征在于,步骤S1中,建立描述无人机编队队形的数学模型的具体过程如下:
三维空间中带时变参数的椭球方程如下:
为了实现编队队形在三维空间中进行时变变化,需要将该椭球方程写成参数方程的形式:
进一步将上式写成矩阵的形式:
3.如权利要求1所述的基于同步策略的多无人机时变编队控制方法,其特征在于,步骤S2中,将构建的四旋翼无人机的数学模型拆分成位置子系统和姿态子系统:
位置子系统为:
其中:
姿态子系统为:
4.如权利要求1所述的基于同步策略的多无人机时变编队控制方法,其特征在于,步骤S3中,基于同步控制策略设计四旋翼无人机位置系统的控制律具体如下:
定义无人机与期望位置的误差:
ei(t)=Pi d-Pi(i=1,2,...n,令n+1=1) (10)
其中:Pi d为无人机的期望位置,Pi为无人机的实际位置,
定义无人机之间的同步误差:
即有:
Bi(t)ei(t)=Bi+1(t)ei+1(t) (12)
则令同步误差为:δi(t)=Bi(t)ei(t)-Bi+1(t)ei+1(t) (13)
如果实现无人机的编队飞行,则需要满足下式:
定义编队误差方程:
对误差方程进行求导:
令:
则有:
引入中间变量:
其中,
设计滑模函数:
对滑模函数进行求导:
并将位置子系统代入:
由此可以得到虚拟控制输入矩阵u(t)如下:
其中,为中间变量σ(t)对应的一阶导数;为误差方程E(t)的一阶导数;控制输入中的K>0、r>0为可调参数;B-1(t)=A(t)为椭圆的参数矩阵;P(t)为无人机在三维空间中的位置;为无人机在三维空间中的速度;g为重力加速度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910692450.4A CN110308742B (zh) | 2019-07-30 | 2019-07-30 | 基于同步策略的多无人机时变编队控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910692450.4A CN110308742B (zh) | 2019-07-30 | 2019-07-30 | 基于同步策略的多无人机时变编队控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110308742A true CN110308742A (zh) | 2019-10-08 |
CN110308742B CN110308742B (zh) | 2022-04-22 |
Family
ID=68081933
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910692450.4A Active CN110308742B (zh) | 2019-07-30 | 2019-07-30 | 基于同步策略的多无人机时变编队控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110308742B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111930142A (zh) * | 2020-08-04 | 2020-11-13 | 西北工业大学 | 速度不可控条件下的多弹编队协同控制方法 |
CN112631335A (zh) * | 2020-12-29 | 2021-04-09 | 南京邮电大学 | 一种基于事件触发的多四旋翼无人机固定事件编队方法 |
CN112947086A (zh) * | 2021-03-09 | 2021-06-11 | 南京航空航天大学 | 一种无人机和无人车组成的异构多智能体系统编队控制中执行器故障的自适应补偿方法 |
CN113625776A (zh) * | 2021-09-16 | 2021-11-09 | 浙江理工大学 | 一种基于中值偏差的多无人机滑模编队控制方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104656663A (zh) * | 2015-02-15 | 2015-05-27 | 西北工业大学 | 一种基于视觉的无人机编队感知与规避方法 |
CN107219857A (zh) * | 2017-03-23 | 2017-09-29 | 南京航空航天大学 | 一种基于三维全局人工势函数的无人机编队路径规划算法 |
CN107807658A (zh) * | 2017-09-30 | 2018-03-16 | 飞智控(天津)科技有限公司 | 面向多无人机编队飞行任务的轨迹规划方法 |
-
2019
- 2019-07-30 CN CN201910692450.4A patent/CN110308742B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104656663A (zh) * | 2015-02-15 | 2015-05-27 | 西北工业大学 | 一种基于视觉的无人机编队感知与规避方法 |
CN107219857A (zh) * | 2017-03-23 | 2017-09-29 | 南京航空航天大学 | 一种基于三维全局人工势函数的无人机编队路径规划算法 |
CN107807658A (zh) * | 2017-09-30 | 2018-03-16 | 飞智控(天津)科技有限公司 | 面向多无人机编队飞行任务的轨迹规划方法 |
Non-Patent Citations (2)
Title |
---|
DEBAO XU等: "Formation Control of Quadrotors for Maneuver Flight Based on Exponential Observer", 《IEEE》 * |
张佳龙 等: "基于改进人工势场的无人机编队避障控制研究", 《西安交通大学学报》 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111930142A (zh) * | 2020-08-04 | 2020-11-13 | 西北工业大学 | 速度不可控条件下的多弹编队协同控制方法 |
CN112631335A (zh) * | 2020-12-29 | 2021-04-09 | 南京邮电大学 | 一种基于事件触发的多四旋翼无人机固定事件编队方法 |
CN112631335B (zh) * | 2020-12-29 | 2023-10-03 | 南京邮电大学 | 一种基于事件触发的多四旋翼无人机固定时间编队方法 |
CN112947086A (zh) * | 2021-03-09 | 2021-06-11 | 南京航空航天大学 | 一种无人机和无人车组成的异构多智能体系统编队控制中执行器故障的自适应补偿方法 |
CN112947086B (zh) * | 2021-03-09 | 2022-10-04 | 南京航空航天大学 | 一种无人机和无人车组成的异构多智能体系统编队控制中执行器故障的自适应补偿方法 |
CN113625776A (zh) * | 2021-09-16 | 2021-11-09 | 浙江理工大学 | 一种基于中值偏差的多无人机滑模编队控制方法 |
CN113625776B (zh) * | 2021-09-16 | 2024-04-26 | 浙江理工大学 | 一种基于中值偏差的多无人机滑模编队控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110308742B (zh) | 2022-04-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110308742A (zh) | 基于同步策略的多无人机时变编队控制方法 | |
CN108459612B (zh) | 基于人工势场法的无人机编队控制方法及装置 | |
US11721219B2 (en) | Method for controlling steady flight of unmanned aircraft | |
CN103412491B (zh) | 一种挠性航天器特征轴姿态机动指数时变滑模控制方法 | |
CN105939765B (zh) | 运动模拟系统控制器和关联的方法 | |
CN110017729A (zh) | 一种带碰撞角约束的多导弹时间协同制导方法 | |
CN109240331A (zh) | 一种无人机-无人车集群模型时变编队控制方法及系统 | |
CN103631153B (zh) | 可视化双模制导航空时敏炸弹半实物仿真方法 | |
CN106933104A (zh) | 一种基于dic‑pid的四旋翼飞行器姿态与位置的混合控制方法 | |
CN105843246A (zh) | 无人机跟踪方法、系统及无人机 | |
CN108268054A (zh) | 亚轨道蜂群飞行器分层式协同控制方法 | |
CN106197173B (zh) | 基于扰动估计和补偿的战术导弹鲁棒姿态控制方法 | |
CN104057452B (zh) | 类人机器人通用动作调试方法 | |
CN112648886B (zh) | 一种组合制导目标拦截方法及系统 | |
CN107832850A (zh) | 对抗环境下无人机占位决策的矩阵博弈方法及装置 | |
CN106625687A (zh) | 一种关节机器人运动学建模方法 | |
CN109407688A (zh) | 一种垂直起降火箭在线轨迹规划的质心运动解耦方法 | |
CN106272380A (zh) | 一种抓捕高速旋转目标后机械臂组合体的姿态稳定方法 | |
CN108438256A (zh) | 一种基于永磁动量交换球的对地凝视卫星姿态控制方法 | |
CN109308064A (zh) | 一种四旋翼无人机的故障容错控制方法及系统 | |
CN115657730A (zh) | 一种大规模多旋翼无人机鲁棒分簇编队控制方法 | |
CN109774977A (zh) | 一种基于四元数的时间最优的卫星姿态快速机动方法 | |
CN109434838A (zh) | 线驱动连续机器人内窥操作的协同运动规划方法及系统 | |
CN112562050A (zh) | 虚拟对象风动画的生成方法及装置、存储介质、终端 | |
CN108446497A (zh) | 一种舰载机集群运动建模仿真方法 |
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 |