CN113791638B - 一种多无人飞行器协同绳系吊装运输***的稳定控制方法 - Google Patents
一种多无人飞行器协同绳系吊装运输***的稳定控制方法 Download PDFInfo
- Publication number
- CN113791638B CN113791638B CN202111017464.XA CN202111017464A CN113791638B CN 113791638 B CN113791638 B CN 113791638B CN 202111017464 A CN202111017464 A CN 202111017464A CN 113791638 B CN113791638 B CN 113791638B
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- interference
- energy
- cooperative
- 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
- 238000000034 method Methods 0.000 title claims abstract description 21
- 238000001514 detection method Methods 0.000 claims abstract description 17
- 238000002347 injection Methods 0.000 claims abstract description 9
- 239000007924 injection Substances 0.000 claims abstract description 9
- 230000001133 acceleration Effects 0.000 claims description 4
- 230000000694 effects Effects 0.000 abstract description 3
- 238000004891 communication Methods 0.000 description 10
- 238000013461 design Methods 0.000 description 7
- 238000010586 diagram Methods 0.000 description 5
- 239000000463 material Substances 0.000 description 5
- 230000015572 biosynthetic process Effects 0.000 description 4
- 239000003795 chemical substances by application Substances 0.000 description 3
- 239000011159 matrix material Substances 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 2
- 230000002452 interceptive effect Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000015556 catabolic process Effects 0.000 description 1
- 230000001276 controlling effect Effects 0.000 description 1
- 230000002596 correlated effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005381 potential energy Methods 0.000 description 1
- 230000002195 synergetic effect Effects 0.000 description 1
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
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
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
技术领域
本发明涉及无人飞行器控制技术研究领域,尤其是一种绳系吊装***的协同运输方法。
背景技术
无人飞行器由于其低成本、安全性高和易于操作的优势在物资运输中具有广泛的应用。单无人飞行器由于其运输载荷能力有限且无法有效控制载荷的姿态,所以使用多无人飞行器协同绳系吊装搬运有效载荷的方法被提出。
多无人飞行器协同绳系吊装搬运有效载荷有众多优势:在搬运有效载荷的时候可以避免频繁起降;可以有效控制有效载荷的姿态;可以提高搬运载荷的质量;可适用于复杂的地形环境。
多无人飞行器在搬运载荷的时候会有构型稳定和整体搬运稳定的问题,本发明提出了一种新的多无人飞行器吊装搬运有效载荷的分布式控制***。该方法不仅可以保持***构型的稳定,还可以保持更加精准的跟踪效果。
申请号为CN202110000112.7的中国专利涉及一种多无人机协同运输***的载荷跟踪控制方法,***由n架无人机和n根系绳与一个载荷组成,n架无人机通过各自系绳连接载荷,在一定的阵型下完成载荷的协同运输。步骤包括:载荷位置跟踪控制器设计,绳上最优拉力分配和包含系绳拉力控制的无人机位置姿态控制设计。该专利解决了多无人机协同运输中载荷的精确位置跟踪控制问题。该发明能够求解出一组最优的拉力分配结果,使得均衡无人机的输出,使得运输效率增加,但是该专利计算模型比较复杂。
申请号为CN201810819129.3的中国专利涉及一种基于速度规划的受约束多智能体编队方法,在考虑编队的同时还考虑智能体间存在约束。通常对于一般的多智能体***,采用分布式控制,在多智能飞行器间构建通讯拓扑,采用一致性控制进行编队控制和整体机动有一定的优势。但是,该***的容错率低,多智能飞行器存在约束,单一智能飞行器的错误指令就可能导致整个***的崩溃或损坏。
发明内容
为了克服现有技术的不足,本发明提供一种多无人飞行器协同绳系吊装运输***的稳定控制方法。本发明在前有发明研究的基础上,提出了一种新的多无人飞行器吊装搬运有效载荷的分布式控制方法,并且该方法中包含了对外界干扰的响应机制,能够对外界对于***的干扰进行识别并加以补偿,不仅可以保持构型的稳定,还可以保持更加精准的跟踪效果。设计干扰检测机制和能量补偿机制进行补偿是本发明重点。
本发明解决其技术问题所采用的技术方案包括以下步骤:
1)建立多无人飞行器协同搬运***的运动学和动力学模型;
由三根系绳连接在无人机和负载上构成多无人机协同搬运负载***,多无人飞行器协同搬运***的运动学和动力学模型为:
其中,qi,分别为第i架无人飞行器的位置、线速度、线加速度,ηi,/>为第i架无人飞行器的姿态角、姿态角速度、姿态角加速度,mi,mL为第i架无人飞行器的质量和所悬挂载荷的质量,Ti为第i架与载荷相连接的绳子的拉力,/>为系绳与竖直方向的夹角,Di1(t),Di2(t),D3(t)为干扰,M(ηi),Ψ(ηi),R(ηi)为中间变量,fi,τi为位置环(x,y,z)和姿态环(θ,φ,ψ)的控制器;
2)设计姿态环和位置环的分布式控制器;
姿态环和位置环的分布式控制器为:
3)设计基于能量的干扰检测机制;
在***施加干扰之后,设计了一种基于能量的干扰检测机制:
4)能量补偿机制进行干扰补偿。
在位置环控制器中进行干扰补偿:
在干扰时加入***之后,及时的检测并进行补偿,使得多无人机协同搬运***能够更好的稳定控制。
所述常数μ取0.99。
本发明的有益效果在于:
(1)该***设计了一个能稳定保持构型的分布式控制器;
(2)在干扰注入***的时候,***的干扰检测机制能够及时对干扰所带来的能量进行检测和估计;
(3)将干扰检测机制和能量补偿机制结合起来,可以及时的判断干扰的注入,能够在保持构型稳定的前提下更平稳的控制多无人飞行器协同搬运***执行任务。
附图说明
图1是本发明多无人飞行器绳系协同吊装物资运输图。
图2是本发明多无人飞行器信息拓扑结构图。
图3是本发明控制框架流程图。
具体实施方式
下面结合附图和实施例对本发明进一步说明。
本发明的主要贡献如下:先是设计了多无人飞行器吊装搬运有效载荷的分布式控制***,然后该控制***中加入了基于能量法的干扰检测机制,最后利用能量补偿机制在控制律中进行干扰补偿。
具体而言,首先基于牛顿第二定律和拉格朗日—欧拉法建立了分布式的多无人飞行器搬运载荷***的动力学方程;然后基于能量法设计了干扰检测机制,可以在干扰输入***的时候及时判断并进行估算干扰注入***的能量;最后在无人飞行器的控制律中进行了补偿来消耗干扰带来的能量,这样可以确保多无人飞行器在运输物资的时候保持稳定的构型跟踪预定轨迹,到达目标点后进行物资投放。
1)建立多无人飞行器协同搬运***的运动学和动力学模型:
首先描述了多四旋翼绳系运输***的动力学模型。有效载荷被视为刚体。四旋翼飞行器的附着点和有效载荷的附着点之间的距离受到绳索长度的限制。
||qi-qL||≤li (1)
其中qi是无人飞行器在世界框架中的位置;qL是有效载荷在世界坐标系中的位置;li代表绳的长度。图1描述了带有吊索有效载荷的多个四旋翼飞行器的运输***。
根据拉格朗日-欧拉方法,具有扰动的绳系多四旋翼运输***的动力学方程如下:
其中式(2)中的第一个和第二个方程分别表示四旋翼飞行器位置环和姿态环中的动力学方程;第三个方程表示有效载荷的动力学方程。
M(ηi)=Ψ(ηi)TJiΨ(ηi) (3)
Ψ(ηi)是从欧拉角的时间导数到角速度的映射,具体定义如下:
简写sφ,cφ代表sinφ,cosφ。
2)设计姿态环和位置环的分布式控制器:
当多无人飞行器进行协同搬运有效载荷时,无人飞行器有分散性控制能力,所以无人飞行器之间应该具有一定的信息交流与共享,即无人飞行器内部存在一定的通信关系。无人飞行器之间的稳定的构型是多无人飞行器搬运有效载荷任务成功与否的关键。
通信网络结构图被用来表示各无人飞行器之间的信息交流和共享的相互关系。***内的各架无人飞行器是通信网络图中的节点,无人飞行器间的信息共享关系则是通信网络图中的边。无人飞行器的通信***构成了一个通信网络图G,该图是一个无向图,节点V表示协同的无人飞行器,E表示无人飞行器之间的通信关系,{v,v}表示无人飞行器和无人飞行器之间的信息传输,箭头的指向时信息的传输方向,如图2所示即为多无人飞行器的通信拓扑图。
3)设计基于能量的干扰检测机制:
现在考虑一般机械***的方程:
对上式进行积分得到
本发明提出的方法试图监测扰动引入的任何能量,因此引入能量检测机制来估计外部干扰注入的能量。这部分能量必须被耗散掉才能保持***的稳定,而控制输入既能控制四旋翼的输入,又能完成耗散能量的任务。无人飞行器在不受干扰的情况下可以稳定飞行,无人飞行器的能量输入曲线是斜率基本不变的对角线。当无人飞行器的输入能量突然增加时,可以检测到干扰施加到***内。
给出四旋翼飞行器的能量输入的定义:
4)能量补偿机制进行干扰补偿:
以上内容阐述了物资投送的多无人飞行器协同绳系吊装稳定控制的具体方法,设计了一个能够保持稳定队形的分布式滑模控制器,还设计了一个干扰检测机制和能量补偿机制,将注入***的干扰实时的进行补偿,时刻保持***的稳定,以便多无人飞行器稳定的运输物资。
以上内容仅为说明本发明的技术思想,不能以此限定本发明的保护范围,凡是按照本发明提出的技术思想,在技术方案基础上做出的任何改动,均落入本发明的权利要求书的保护范围之内。
Claims (2)
1.一种多无人飞行器协同绳系吊装运输***的稳定控制方法,其特征在于包括下述步骤:
1)建立多无人飞行器协同搬运***的运动学和动力学模型;
由三根系绳连接在无人机和负载上构成多无人机协同搬运负载***,多无人飞行器协同搬运***的运动学和动力学模型为:
其中,qi,分别为第i架无人飞行器的位置、线速度、线加速度,ηi,/>为第i架无人飞行器的姿态角、姿态角速度、姿态角加速度,mi,mL为第i架无人飞行器的质量和所悬挂载荷的质量,Ti为第i架与载荷相连接的绳子的拉力,/>为系绳与竖直方向的夹角,Di1(t),Di2(t),D3(t)为干扰,M(ηi),Ψ(ηi),R(ηi)为中间变量,fi,τi为位置环(x,y,z)和姿态环(θ,φ,ψ)的控制器;
2)设计姿态环和位置环的分布式控制器;
姿态环和位置环的分布式控制器为:
3)设计基于能量的干扰检测机制;
在***施加干扰之后,设计了一种基于能量的干扰检测机制:
4)能量补偿机制进行干扰补偿;
在位置环控制器中进行干扰补偿:
在干扰时加入***之后,及时的检测并进行补偿,使得多无人机协同搬运***能够更好的稳定控制。
2.根据权利要求1所述的多无人飞行器协同绳系吊装运输***的稳定控制方法,其特征在于:
所述常数μ取0.99。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111017464.XA CN113791638B (zh) | 2021-08-29 | 2021-08-29 | 一种多无人飞行器协同绳系吊装运输***的稳定控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111017464.XA CN113791638B (zh) | 2021-08-29 | 2021-08-29 | 一种多无人飞行器协同绳系吊装运输***的稳定控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113791638A CN113791638A (zh) | 2021-12-14 |
CN113791638B true CN113791638B (zh) | 2023-06-30 |
Family
ID=78879380
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111017464.XA Active CN113791638B (zh) | 2021-08-29 | 2021-08-29 | 一种多无人飞行器协同绳系吊装运输***的稳定控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113791638B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117970944B (zh) * | 2024-03-29 | 2024-05-31 | 微至航空科技(北京)有限公司 | 一种无人机机组构成的协同搬运*** |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103699133A (zh) * | 2013-12-12 | 2014-04-02 | 西安交通大学 | 一种多飞行器吊装协调控制*** |
CN107608367A (zh) * | 2017-09-06 | 2018-01-19 | 天津大学 | 多变量干扰补偿四旋翼无人机轨迹与姿态协同控制方法 |
WO2019085834A1 (zh) * | 2017-11-01 | 2019-05-09 | 华南理工大学 | 一种无人飞行器稳定飞行控制方法 |
CN112578804A (zh) * | 2020-12-16 | 2021-03-30 | 南京理工大学 | 一种基于事件触发机制的四旋翼飞行器编队滑模控制方法 |
-
2021
- 2021-08-29 CN CN202111017464.XA patent/CN113791638B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103699133A (zh) * | 2013-12-12 | 2014-04-02 | 西安交通大学 | 一种多飞行器吊装协调控制*** |
CN107608367A (zh) * | 2017-09-06 | 2018-01-19 | 天津大学 | 多变量干扰补偿四旋翼无人机轨迹与姿态协同控制方法 |
WO2019085834A1 (zh) * | 2017-11-01 | 2019-05-09 | 华南理工大学 | 一种无人飞行器稳定飞行控制方法 |
CN112578804A (zh) * | 2020-12-16 | 2021-03-30 | 南京理工大学 | 一种基于事件触发机制的四旋翼飞行器编队滑模控制方法 |
Non-Patent Citations (1)
Title |
---|
面向目标对峙跟踪的四旋翼协同编队控制方法;邵星灵;刘俊;李东光;;无人***技术(第01期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN113791638A (zh) | 2021-12-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US9073624B2 (en) | Methods and apparatus to cooperatively lift a payload | |
Ritz et al. | Carrying a flexible payload with multiple flying vehicles | |
US11708248B2 (en) | LQR-based anti-sway control method and system for lifting system | |
CN110579969B (zh) | 一种用于双无人机协同吊运棒状刚体负载的控制方法 | |
Klausen et al. | Cooperative path-following for multirotor UAVs with a suspended payload | |
CN109725643B (zh) | 一种基于主动建模的旋翼飞行器非平衡负载吊运***的控制方法 | |
CN112394644B (zh) | 一种绳系多无人机协同操作***的预设时间控制方法 | |
Pereira et al. | Slung load transportation with a single aerial vehicle and disturbance removal | |
CN113791638B (zh) | 一种多无人飞行器协同绳系吊装运输***的稳定控制方法 | |
EP4144681A2 (en) | Dynamic flex compensation, coordinated hoist control, and anti-sway control for load handling machines | |
Liang et al. | Unmanned aerial transportation system with flexible connection between the quadrotor and the payload: modeling, controller design, and experimental validation | |
Brandão et al. | Side-pull maneuver: A novel control strategy for dragging a cable-tethered load of unknown weight using a UAV | |
CN117452966A (zh) | 一种基于单轴拉力传感器的无人机力协同吊挂搬运方法 | |
CN116820116A (zh) | 基于干扰观测器的变负载吊挂四旋翼无人机控制方法 | |
Baraean et al. | Optimal Nonlinear backstepping controller design of a Quadrotor-Slung load system using particle Swarm Optimization | |
Pereira et al. | Collaborative transportation of a bar by two aerial vehicles with attitude inner loop and experimental validation | |
CN116300466A (zh) | 一种旋翼无人机集群协同吊运点质量载荷的鲁棒控制方法 | |
Mechali et al. | Formation flight control of networked-delayed quadrotors for cooperative slung load transportation | |
Liu et al. | Non‐linear adaptive tracking control for quadrotor aerial robots under uncertain dynamics | |
Zhang et al. | Formation planning for tethered multirotor uav cooperative transportation with unknown payload and cable length | |
Li et al. | Adaptive neural network-based fault-tolerant control for quadrotor-slung-load system under marine scene | |
CN114063626A (zh) | 基于重心检测的四旋翼货运无人机飞行姿态控制方法 | |
Klausen et al. | Suspended load motion control using multicopters | |
Chen et al. | Transportation of payload using multiple quadrotors via rigid connection | |
Fang et al. | Advanced nonlinear control of an offshore boom crane |
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 |