CN112580196A - 变绳长无人机减摆控制器生成方法、控制方法及生成系统 - Google Patents
变绳长无人机减摆控制器生成方法、控制方法及生成系统 Download PDFInfo
- Publication number
- CN112580196A CN112580196A CN202011403836.8A CN202011403836A CN112580196A CN 112580196 A CN112580196 A CN 112580196A CN 202011403836 A CN202011403836 A CN 202011403836A CN 112580196 A CN112580196 A CN 112580196A
- Authority
- CN
- China
- Prior art keywords
- aerial vehicle
- unmanned aerial
- rope
- variable
- length
- 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
- 238000000034 method Methods 0.000 title claims abstract description 51
- 230000008878 coupling Effects 0.000 claims abstract description 51
- 238000010168 coupling process Methods 0.000 claims abstract description 51
- 238000005859 coupling reaction Methods 0.000 claims abstract description 51
- 230000014509 gene expression Effects 0.000 claims description 6
- 238000005381 potential energy Methods 0.000 claims description 6
- 230000008859 change Effects 0.000 claims description 4
- 238000009795 derivation Methods 0.000 claims description 3
- 239000011159 matrix material Substances 0.000 claims description 3
- 239000002184 metal Substances 0.000 claims description 3
- 238000010276 construction Methods 0.000 claims description 2
- 230000000452 restraining effect Effects 0.000 abstract 1
- 230000009467 reduction Effects 0.000 description 5
- 230000001629 suppression Effects 0.000 description 4
- 230000008569 process Effects 0.000 description 3
- 230000004044 response Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 238000006073 displacement reaction Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 238000013016 damping Methods 0.000 description 1
- 230000008030 elimination Effects 0.000 description 1
- 238000003379 elimination reaction Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B66—HOISTING; LIFTING; HAULING
- B66C—CRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
- B66C13/00—Other constructional features or details
- B66C13/04—Auxiliary devices for controlling movements of suspended loads, or preventing cable slack
- B66C13/06—Auxiliary devices for controlling movements of suspended loads, or preventing cable slack for minimising or preventing longitudinal or transverse swinging of loads
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B66—HOISTING; LIFTING; HAULING
- B66C—CRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
- B66C13/00—Other constructional features or details
- B66C13/18—Control systems or devices
- B66C13/48—Automatic control of crane drives for producing a single or repeated working cycle; Programme control
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F2119/00—Details relating to the type or aim of the analysis or the optimisation
- G06F2119/14—Force analysis or force optimisation, e.g. static or dynamic forces
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Automation & Control Theory (AREA)
- Computer Hardware Design (AREA)
- Evolutionary Computation (AREA)
- Geometry (AREA)
- General Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本申请涉及一种变绳长无人机减摆控制器生成方法、控制方法及生成系统,该方法包括:根据变绳长无人机吊运系统结构,对变绳长无人机吊运系统进行动力学分析,建立变绳长无人机吊运系统的动力学模型;构建无人机运动参量和负载摆动参量之间的耦合关系,并构造耦合误差函数;基于耦合误差函数,构建与变绳长无人机吊运系统能量和误差相关的李雅普诺夫候选函数;基于变绳长无人机吊运系统状态的反馈,得到控制器。本申请能够对负载摆角具有明显抑制效果。
Description
技术领域
本申请涉及无人机吊运控制技术领域,尤其是涉及一种变绳长无人机减摆控制器生成方法、控制方法及生成系统。
背景技术
无人机运输能够摆脱地面交通的限制,相比地面交通工具来说,其工作空间和方式更加灵活,因此在军事和民用领域得到持续广泛的关注。无人机吊运,利用绳索将负载与无人机相连,并通过无人机的运动来将负载运送到指定的位置。随着无人机的运动,负载会产生摆动,进而对无人机的位置跟踪精度产生影响,甚至会影响其运动的稳定性;另外,在某些应用场合,无人机需要通过变化绳长对负载进行投放和回收。出于对无人机和负载的保护,不允许负载产生较大的摆动,因此,变绳长无人机吊运消摆跟踪是当前无人机吊运领域中的重点问题。
目前针对无人机消摆问题的研究,大都是针对固定绳长的无人机吊运系统,在实际应用中,为提高整机运输效率,往往需要同时控制无人机的空间移动与负载的升降,在这种情况下,由于额外受到了吊绳长度变化的影响,上述针对固定绳长无人机吊运系统所提出的控制方法便无法获得理想控制效果。
在起重机领域出现了针对变绳长吊运的控制方案。但是,由于起重机和无人机的运行机理相差甚远,加上变化的绳长使无人机系统状态之间具有更强的耦合性,因此,变绳长起重机的控制方案不能直接用于无人机吊运的摆角抑制,目前研究变绳长无人机吊运系统的控制问题仍充满困难与挑战。
发明内容
为了解决上述背景技术中的问题,本申请提供一种变绳长无人机减摆控制器生成方法、控制方法及生成系统。
在本申请的第一方面,提供了一种变绳长无人机减摆控制器生成方法,包括:
根据变绳长无人机吊运系统结构,对变绳长无人机吊运系统进行动力学分析,建立变绳长无人机吊运系统的动力学模型;
构建无人机运动参量和负载摆动参量之间的耦合关系,并构造耦合误差函数,所述负载摆动参量包括无人机吊运货物的吊绳的变化量、吊绳在xz平面上的投影与z轴负方向所成的角度以及吊绳与xz平面间的夹角;
基于耦合误差函数,构建与变绳长无人机吊运系统能量和误差相关的李雅普诺夫候选函数;
基于变绳长无人机吊运系统状态的反馈,得到控制器。
优选的,所述对变绳长无人机吊运系统进行动力学分析,建立无人机吊运系统的动力学模型包括:
假设无人机是质量为m1质点,且机体不存在旋转,质量为m2的负载通过长度为L的吊绳与无人机相连,则二者的空间坐标关系为:
其中,(x1,y1,z1)为无人机的空间坐标,(x2,y2,z2)为负载的空间坐标,αx为吊绳在xz平面上的投影与z轴负方向所成的角度,αy为吊绳与xz平面间的夹角,L为吊绳的长度;
无人机吊运系统的动能为:
无人机吊运系统的势能为:
P=m1gz1+m2g(z1-Lcosαzcosαy) (3)
q=[x1,y1,z1,L,αx,αy]T (4)
将(1)带入(2),并采用拉格朗日方程,对无人机吊运系统的动能和势能进行求导,获得变绳长无人机吊运系统的动力学模型:
其中,
上述动力学模型可以写成如下矩阵形式:
其中,
M(q)=[A1B1C1]
G(q)=[0,0,(M+m)mg,-gcosαxcosαy,mg sin αxcosαy,mgL cosαxsinαy]T
F=[Fx,Fy,Fz,FL,0,0]T
其中,Fx为无人机在x方向上的驱动力,Fy为无人机在y方向上的驱动力,Fz为无人机在z方向上的驱动力,FL为吊绳拉力,其方向与Fz相反。
优选的,所述构建无人机运动参量和负载摆动参量之间的耦合关系,并构造耦合误差函数包括:
假定无人机期望轨迹为(xd,yd,zd,Ld),系统误差为
e1=L-Ld
ex=x1-xd
ey=y1-yd
ez=z1-zd (15)
构建无人机运动参量(x1,y1,z1)与负载摆动参量(L,αx,αy)耦合关系,综合考虑系统稳定性和控制器设计,构造如下耦合误差函数:
εl(t)=L0-f1
εx(t)=ex-f2
εy(t)=ey-f3
εz(t)=ez-f4 (16)
其中,
f1=Lcosαxcosαy
f2=λxLsinαxcosαy
f3=λyLsinαy
f4=λzL cosαxcosαy (17)
其中,λx,λy,λz为待设计参数。
优选的,所述基于耦合误差函数,构建与无人机吊运系统能量和误差相关的李雅普诺夫候选函数包括:
由公式(2)和公式(3)可得变绳长无人机吊运系统机械能为:
设计与系统能量及误差相关的李雅普诺夫候选子函数:
V1=Ek+Ep (19)
其中,Ep设计为与耦合误差相关的函数:
其中,kpx,kpy,kpz为正增益系数;
联合公式(18)、公式(19)和公式(20),则V1为
显然V1大于零;
进一步构造李雅普诺夫候选子函数V2和V3
将公式(17)求导并带入V2,取λx=λy=λz=k1,则:
令k1<0,由初等函数性质易知V2+V3>0
基于公式(21)-(23),获得变绳长无人机吊运系统整体正定的李雅普诺夫候选函数:
V(t)=V1+V2+V3。 (25)
优选的,所述基于无人机吊运系统状态的反馈,得到控制器包括:
根据李雅普诺夫第二定理,对于一个控制系统,如果能找到一个正定函数,其导数是负定的,则系统是渐进稳定的,由于所设计的变绳长无人机吊运系统整体李雅普诺夫候选函数V(t)>0,那么,通过控制器的设计使得即可获得稳定的闭环控制系统;
对李雅普诺夫候选子函数V1求导,得到
由功能原理可知变绳长无人机机械能的变化等于驱动力对其做的功,则有:
从而有
对李雅普诺夫候选子函数V2求导,得到
由耦合误差函数定义可知
L0=εl+f1 (30)
设计变绳长无人机吊运系统位置、速度反馈设计控制器为:
优选的,所述方法还包括证明变绳长无人机吊运系统控制器的稳定性步骤:
由公式(17)可知:
对V2求导,并将上式带入,可得:
针对公式(31)所示V31导数表达式,进一步考虑绳摆相关的动力学公式(8)可以得到:
针对V32导数的部分表达式,进一步考虑摆角动力学公式(9)、(10)可以得到:
将以上两式带入(32),可得:
结合公式(5)至(7)、耦合误差函数(16)可得:
假定吊绳长度始终满足设计和实际的要求,即0<Ld≤L≤L0,将公式(33)所示控制器带入公式(44)可得:
由此可知,基于所生成的控制器,变绳长无人机吊运系统的闭环控制稳定。
第二方面,本申请提供了一种变绳长无人机减摆控制方法,所述控制方法基于第一方面中任一项的控制器生成方法生成的控制器实现。
第三方面,本申请提供了一种变绳长无人机减摆控制器生成系统,包括:
动力学模型获取模块,用于根据无人机吊运系统结构,对变绳长无人机吊运系统进行动力学分析,建立变绳长无人机吊运系统的动力学模型;
耦合误差函数构建模块,用于构建无人机运动参量和负载摆动参量之间的耦合关系,并构造耦合误差函数,所述负载摆动参量包括无人机吊运货物的吊绳的变化量、吊绳在xz平面上的投影与z轴负方向所成的角度以及吊绳与xz平面间的夹角;
李雅普诺夫函数构建模块,用于基于耦合误差函数,构建与无人机吊运系统能量和误差相关的李雅普诺夫候选函数;
控制器生成模块,用于基于变绳长无人机吊运系统状态的反馈,得到控制器。
在本申请的实施例提供的变绳长无人机减摆控制器生成方法、控制方法及生成系统中,首先建立变绳长无人机吊运系统的动力学模型,并构建耦合误差函数,然后基于误差函数构建与变绳长无人机吊运系统能量和误差相关的李雅普诺夫候选函数,最后基于变绳长无人机吊运系统状态的反馈,得到控制器,在构建耦合误差函数时,考虑了变绳长无人机吊运货物的吊绳的变化量、吊绳在xz平面上的投影与z轴负方向所成的角度以及吊绳与xz平面间的夹角,因此在对变绳长无人机进行位移/位置跟踪控制,能够对负载摆角具有明显抑制效果,有效地提高工作效率和安全性。
附图说明
图1示出了根据本申请的实施例的变绳长无人机吊运系统的示意图;
图2示出了根据本申请的实施例的变绳长无人机减摆控制器生成方法的流程图;
图3示出了根据本申请的实施例的变绳长无人机吊运系统轨迹跟踪响应曲线图;
图4示出了根据本申请的实施例的变绳长无人机吊运系统摆角响应曲线图;
图5示出了根据本申请的实施例的变绳长无人机减摆控制器生成系统的方框图。
具体实施方式
为使本申请实施例的目的、技术方案和优点更加清楚,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的全部其他实施例,都属于本申请保护的范围。
对于相关领域普通技术人员已知的技术、方法和设备可能不作详细讨论,但在适当情况下,所述技术、方法和设备应当被视为说明书的一部分。
参见图1,无人机吊运系统中,假设无人机是质量为m1质点,且机体不存在旋转,质量为m2的负载通过长度为L的吊绳与无人机相连;无人机在Fx,Fy,Fz的作用力驱动下可沿x,y,z方向运动;负载在吊绳拉力FL作用下可进行z方向上的升降运动。
在无人机吊运系统工作过程中,无人机的运动以及外界扰动会引起负载的摆动,摆角为αx和αy,其中αx是吊绳在xz平面上的投影与z轴负方向所成的角度,αy表示吊绳与xz平面间的夹角。无人机和负载的空间坐标分别记为(x1,y1,z1)和(x2,y2,z2),二者的空间坐标关系为:
由分析可知,Fx,Fy,Fz,FL为控制量,x1,y1,z1,L,αx,αy为状态量,该系统是一个具有6个自由度的欠驱动系统。
无人机吊运的任务是,无人机按设定轨迹/位置飞行并完成负载提升和转运。传统的无人机吊运,由于技术的限制,通常分别执行轨迹/位置跟踪和负载提升作业任务。其摆角抑制策略,仅针对固定绳长作业。这种工作方式,在一定程度上降低了无人机吊运任务的工作效率,系统稳定性也无法得到有效保障。为了提高工作效率,提高安全性,需要针对轨迹/位置跟踪与吊运操作同时运行的无人机进行轨迹跟踪和减摆控制设计。
为此,本申请提供了一种变绳长无人机减摆控制器生成方法、控制方法及生成系统。
在一些实施例中,参见图2,变绳长无人机减摆控制器生成方法包括以下步骤:
步骤202,根据变绳长无人机吊运系统结构,对变绳长无人机吊运系统进行动力学分析,建立变绳长无人机吊运系统的动力学模型。
步骤204,构建无人机运动参量和负载摆动参量之间的耦合关系,并构造耦合误差函数,所述负载摆动参量包括无人机吊运货物的吊绳的变化量、吊绳在xz平面上的投影与z轴负方向所成的角度以及吊绳与xz平面间的夹角。
步骤206,基于耦合误差函数,构建与变绳长无人机吊运系统能量和误差相关的李雅普诺夫候选函数。
步骤208,基于变绳长无人机吊运系统状态的反馈,得到控制器。
根据本申请的实施例,首先建立变绳长无人机吊运系统的动力学模型,并构建耦合误差函数,然后基于误差函数构建与变绳长无人机吊运系统能量和误差相关的李雅普诺夫候选函数,最后基于变绳长无人机吊运系统状态的反馈,得到控制器,在构建耦合误差函数时,考虑了变绳长无人机吊运货物的吊绳的变化量、吊绳在xz平面上的投影与z轴负方向所成的角度以及吊绳与xz平面间的夹角,因此在对变绳长无人机进行位移/位置跟踪控制,能够对负载摆角具有明显抑制效果,有效地提高工作效率和安全性。
下面来对上述各步骤的具体实现方式进行详细介绍。
具体地,对上述变绳长无人机吊运系统进行动力学分析,可知:
无人机吊运系统的动能为:
无人机吊运系统的势能为:
q=[x1,y1,z1,L,αx,αy]T (4)
将(1)带入(2),并采用拉格朗日方程,对无人机吊运系统的动能和势能进行求导,获得变绳长无人机吊运系统的动力学模型:
其中,
上述动力学模型可以写成如下矩阵形式:
其中,
M(q)=[A1B1C1]
G(q)=[0,0,(M+m)mg,-g cosαx cosαy,mg sin αxcosαy,mgL cosαx sinαy]T
F=[Fx,Fy,Fz,FL,0,0]T
其中,Fx为无人机在x方向上的驱动力,Fy为无人机在y方向上的驱动力,Fz为无人机在z方向上的驱动力,FL为吊绳拉力,其方向与Fz相反。
进一步地,假定无人机期望轨迹为(xd,yd,zd,Ld),系统误差为
e1=L-Ld
ex=x1-xd
ey=y1-yd
ez=z1-zd (15)
构建无人机运动参量(x1,y1,z1)与负载摆动参量(L,αx,αy)耦合关系,综合考虑系统稳定性和控制器设计,构造如下耦合误差函数:
εl(t)=L0-f1
εx(t)=ex-f2
εy(t)=ey-f3
εz(t)=ez-f4 (16)
其中,
f1=Lcosαxcosαy
f2=λxLsinαxcosαy
f3=λyLsinαy
f4=λzLcosαxcosαy (17)
其中,λx,λy,λz为待设计参数。
所定义的耦合误差函数,构建了位移和摆角之间的耦合关系,同时,当摆角为零时,公式(10)所示耦合误差与公式(9)所示原始误差相同。
进一步地,由公式(2)和公式(3)可得变绳长无人机吊运系统机械能为:
设计与系统能量及误差相关的李雅普诺夫候选子函数:
V1=Ek+Ep (19)
其中,Ep设计为与耦合误差相关的函数:
其中,kpx,kpy,kpz为正增益系数;
联合公式(18)、公式(19)和公式(20),则V1为
显然V1大于零;
进一步构造李雅普诺夫候选子函数V2和V3
将公式(17)求导并带入V2,取λx=λy=λz=k1,则:
令k1<0,由初等函数性质易知V2+V3>0
基于公式(21)-(23),获得变绳长无人机吊运系统整体正定的李雅普诺夫候选函数:
V(t)=V1+V2+V3。 (25)
进一步地,根据李雅普诺夫第二定理,对于一个控制系统,如果能找到一个正定函数,其导数是负定的,则系统是渐进稳定的,由于所设计的变绳长无人机吊运系统整体李雅普诺夫候选函数V(t)>0,那么,通过控制器的设计使得即可获得稳定的闭环控制系统;
对李雅普诺夫候选子函数V1求导,得到
由功能原理可知变绳长无人机机械能的变化等于驱动力对其做的功,
则有:
从而有
对李雅普诺夫候选子函数V2求导,得到
由耦合误差函数定义可知
L0=εl+f1 (30)
设计变绳长无人机吊运系统位置、速度反馈设计控制器为:
在一些实施例中,变绳长无人机减摆控制器生成方法还包括证明变绳长无人机吊运系统控制器的稳定性步骤,具体地:
由公式(17)可知:
对V2求导,并将上式带入,可得:
针对公式(31)所示V31导数表达式,进一步考虑绳摆相关的动力学公式(8)可以得到:
针对V32导数的部分表达式,进一步考虑摆角动力学公式(9)、(10)可以得到:
将以上两式带入(32),可得:
结合公式(5)至(7)、耦合误差函数(16)可得:
假定吊绳长度始终满足设计和实际的要求,即0<Ld≤L≤L0,将公式(33)所示控制器带入公式(44)可得:
由此可知,基于所生成的控制器,变绳长无人机吊运系统的闭环控制稳定。
为进一步验证无人机吊运系统的性能,可以在MATLAB环境中进行数值仿真,并与PID控制方法进行对比。具体地,仿真设定无人机系统参数为M=0.8kg,L=0.3m,m=0.06kg。x,y,z初始值均设置为0,绳长初始值L=1m。各变量目标为yd=1m,zd=0.5m,Ld=0.2m。本申请所提出方法与PID控制方法对应参数均设置为kpx=3,kdx=2,kpy=2,kdy=2,kpz=55,kdz=120,kpl=100,kdl=100。结果对比如图3和图4所示。其中,点线表示目标轨迹,实线和虚线分别表示本申请所提出方法与PID控制方法的响应轨迹。
从图3和图4中可以看出,本申请实施例提供的控制器在轨迹跟踪控制性能方面由于PID控制,同时,对负载摆角具有明显的抑制效果,在快速定位和负载消摆两个方面均取得了令人满意的效果。
在另一方面,本申请的实施例还提供了一种变绳长无人机减摆控制方法,利用变绳长无人机减摆控制器生成方法中得到的控制器,对无人机进行位移/位置跟踪控制,从而能够对负载摆角具有明显抑制效果,有效地提高了工作效率和安全性。
在另一方面,本申请的实施例还提供了一种变绳长无人机减摆控制器生成系统。参见图5,该系统包括:
动力学模型获取模块510,用于根据变绳长无人机吊运系统结构,对变绳长无人机吊运系统进行动力学分析,建立变绳长无人机吊运系统的动力学模型。
耦合误差函数构建模块520,用于构建无人机运动参量和负载摆动参量之间的耦合关系,并构造耦合误差函数,所述负载摆动参量包括无人机吊运货物的吊绳的变化量、吊绳在xz平面上的投影与z轴负方向所成的角度以及吊绳与xz平面间的夹角。
李雅普诺夫函数构建模块530,用于基于耦合误差函数,构建与变绳长无人机吊运系统能量和误差相关的李雅普诺夫候选函数。
控制器生成模块540,用于基于变绳长无人机吊运系统状态的反馈,得到控制器。
所属领域的技术人员可以清楚地了解到,为描述的方便和简洁,所述描述的模块的具体工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。
以上均为本申请的较佳实施例,并非依此限制本申请的保护范围,故:凡依本申请的结构、形状、原理所做的等效变化,均应涵盖于本申请的保护范围之内。
Claims (8)
1.一种变绳长无人机减摆控制器生成方法,其特征在于,包括:
根据变绳长无人机吊运系统结构,对变绳长无人机吊运系统进行动力学分析,建立变绳长无人机吊运系统的动力学模型;
构建无人机运动参量和负载摆动参量之间的耦合关系,并构造耦合误差函数,所述负载摆动参量包括无人机吊运货物的吊绳的变化量、吊绳在xz平面上的投影与z轴负方向所成的角度以及吊绳与xz平面间的夹角;
基于耦合误差函数,构建与变绳长无人机吊运系统能量和误差相关的李雅普诺夫候选函数;
基于变绳长无人机吊运系统状态的反馈,得到控制器。
2.根据权利要求1所述的方法,其特征在于,所述对变绳长无人机吊运系统进行动力学分析,建立无人机吊运系统的动力学模型包括:
假设无人机是质量为m1质点,且机体不存在旋转,质量为m2的负载通过长度为L的吊绳与无人机相连,则二者的空间坐标关系为:
其中,(x1,y1,z1)为无人机的空间坐标,(x2,y2,z2)为负载的空间坐标,αx为吊绳在xz平面上的投影与z轴负方向所成的角度,αy为吊绳与xz平面间的夹角,L为吊绳的长度;
无人机吊运系统的动能为:
无人机吊运系统的势能为:
P=m1gz1+m2g(z1-L cosαxcosαy) (3)
q=[x1,y1,z1,L,αx,αy]T (4)
将(1)带入(2),并采用拉格朗日方程,对无人机吊运系统的动能和势能进行求导,获得变绳长无人机吊运系统的动力学模型:
其中,
上述动力学模型可以写成如下矩阵形式:
其中,
M(q)=[A1 B1 C1]
G(q)=[0,0,(M+m)mg,-g cosαxcosαy,mg sinαxcosαy,mgL cosαxsinαy]T
F=[Fx,Fy,Fz,FL,0,0]T
其中,Fx为无人机在x方向上的驱动力,Fy为无人机在y方向上的驱动力,Fz为无人机在z方向上的驱动力,FL为吊绳拉力,其方向与Fz相反。
3.根据权利要求2所述的方法,其特征在于,所述构建无人机运动参量和负载摆动参量之间的耦合关系,并构造耦合误差函数包括:
假定无人机期望轨迹为(xd,yd,zd,Ld),系统误差为
e1=L-Ld
ex=x1-xd
ey=y1-yd
ez=z1-zd (15)
构建无人机运动参量(x1,y1,z1)与负载摆动参量(L,αx,αy)耦合关系,综合考虑系统稳定性和控制器设计,构造如下耦合误差函数:
εl(t)=L0-f1
εx(t)=ex-f2
εy(t)=ey-f3
εz(t)=ez-f4 (16)
其中,
f1=L cosαxcosαy
f2=λxL sinαxcosαy
f3=λyL sinαy
f4=λzL cosαxcosαy (17)
其中,λx,λy,λz为待设计参数。
4.根据权利要求3所述的方法,其特征在于,所述基于耦合误差函数,构建与无人机吊运系统能量和误差相关的李雅普诺夫候选函数包括:
由公式(2)和公式(3)可得变绳长无人机吊运系统机械能为:
设计与系统能量及误差相关的李雅普诺夫候选子函数:
V1=Ek+Ep (19)
其中,Ep设计为与耦合误差相关的函数:
其中,kpx,kpy,kpz为正增益系数;
联合公式(18)、公式(19)和公式(20),则V1为
显然V1大于零;
进一步构造李雅普诺夫候选子函数V2和V3
将公式(17)求导并带入V2,取λx=λy=λz=k1,则:
令k1<0,由初等函数性质易知V2+V3>0
基于公式(21)-(23),获得变绳长无人机吊运系统整体正定的李雅普诺夫候选函数:
V(t)=V1+V2+V3。 (25)
5.根据权利要求4所述的方法,其特征在于,所述基于无人机吊运系统状态的反馈,得到控制器包括:
根据李雅普诺夫第二定理,对于一个控制系统,如果能找到一个正定函数,其导数是负定的,则系统是渐进稳定的,由于所设计的变绳长无人机吊运系统整体李雅普诺夫候选函数V(t)>0,那么,通过控制器的设计使得即可获得稳定的闭环控制系统;
对李雅普诺夫候选子函数V1求导,得到
由功能原理可知变绳长无人机机械能的变化等于驱动力对其做的功,则有:
从而有
对李雅普诺夫候选子函数V2求导,得到
由耦合误差函数定义可知
L0=εl+f1 (30)
设计变绳长无人机吊运系统位置、速度反馈设计控制器为:
6.根据权利要求5所述的方法,其特征在于,所述方法还包括证明变绳长无人机吊运系统控制器的稳定性步骤:
由公式(17)可知:
对V2求导,并将上式带入,可得:
针对公式(31)所示V31导数表达式,进一步考虑绳摆相关的动力学公式(8)可以得到:
针对V32导数的部分表达式,进一步考虑摆角动力学公式(9)、(10)可以得到:
将以上两式带入(32),可得:
结合公式(5)至(7)、耦合误差函数(16)可得:
假定吊绳长度始终满足设计和实际的要求,即0<Ld≤L≤L0,将公式(33)所示控制器带入公式(44)可得:
由此可知,基于所生成的控制器,变绳长无人机吊运系统的闭环控制稳定。
7.一种变绳长无人机减摆控制方法,其特征在于,所述控制方法基于权利要求1至6中任一项的控制器生成方法生成的控制器实现。
8.一种变绳长无人机减摆控制器生成系统,其特征在于,包括:
动力学模型获取模块,用于根据变绳长无人机吊运系统结构,对变绳长无人机吊运系统进行动力学分析,建立变绳长无人机吊运系统的动力学模型;
耦合误差函数构建模块,用于构建无人机运动参量和负载摆动参量之间的耦合关系,并构造耦合误差函数,所述负载摆动参量包括无人机吊运货物的吊绳的变化量、吊绳在xz平面上的投影与z轴负方向所成的角度以及吊绳与xz平面间的夹角;
李雅普诺夫函数构建模块,用于基于耦合误差函数,构建与变绳长无人机吊运系统能量和误差相关的李雅普诺夫候选函数;
控制器生成模块,用于基于变绳长无人机吊运系统状态的反馈,得到控制器。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011403836.8A CN112580196B (zh) | 2020-12-02 | 2020-12-02 | 变绳长无人机减摆控制器生成方法、控制方法及生成系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011403836.8A CN112580196B (zh) | 2020-12-02 | 2020-12-02 | 变绳长无人机减摆控制器生成方法、控制方法及生成系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112580196A true CN112580196A (zh) | 2021-03-30 |
CN112580196B CN112580196B (zh) | 2024-06-14 |
Family
ID=75127427
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011403836.8A Active CN112580196B (zh) | 2020-12-02 | 2020-12-02 | 变绳长无人机减摆控制器生成方法、控制方法及生成系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112580196B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115167145A (zh) * | 2022-08-08 | 2022-10-11 | 南开大学 | 一种飞行吊运负载移动平台降落控制方法及系统 |
CN116573557A (zh) * | 2023-05-25 | 2023-08-11 | 南京工业大学 | 一种塔式起重机振幅饱和非线性输出反馈控制方法及系统 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109976366A (zh) * | 2019-03-27 | 2019-07-05 | 天津大学 | 旋翼无人机吊挂负载系统非线性轨迹跟踪控制方法 |
CN110579969A (zh) * | 2019-10-23 | 2019-12-17 | 南开大学 | 一种用于双无人机协同吊运棒状刚体负载的控制方法 |
CN111190430A (zh) * | 2020-01-15 | 2020-05-22 | 西北工业大学 | 一种利用系绳旋翼协调的无人机吊挂负载控制方法 |
-
2020
- 2020-12-02 CN CN202011403836.8A patent/CN112580196B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109976366A (zh) * | 2019-03-27 | 2019-07-05 | 天津大学 | 旋翼无人机吊挂负载系统非线性轨迹跟踪控制方法 |
CN110579969A (zh) * | 2019-10-23 | 2019-12-17 | 南开大学 | 一种用于双无人机协同吊运棒状刚体负载的控制方法 |
CN111190430A (zh) * | 2020-01-15 | 2020-05-22 | 西北工业大学 | 一种利用系绳旋翼协调的无人机吊挂负载控制方法 |
Non-Patent Citations (4)
Title |
---|
BIN XIAN ET AL.: ""An Online Trajectory Planning Approach for a Quadrotor UAV With a Slung Payload"", 《IEEE TRANSACTIONS ON INDUSTRIAL ELECTRONICS》, 31 August 2020 (2020-08-31) * |
XIAO LIANG ET AL.: ""Dynamics Modeling and Analysis for Unmanned Quadrotor Transportation Systems with Double-Pendulum Swing Effects"", 《2019 IEEE 4TH INTERNATIONAL CONFERENCE ON ADVANCED ROBOTICS AND MECHATRONICS(ICARM)》, 31 December 2019 (2019-12-31) * |
王诗章等: ""无人机吊挂飞行系统的减摆控制设计"", 《自动化学报》, 31 October 2018 (2018-10-31) * |
鲜斌等: ""无人机吊挂飞行的非线性控制方法设计"", 《控制理论与应用》, 31 March 2016 (2016-03-31) * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115167145A (zh) * | 2022-08-08 | 2022-10-11 | 南开大学 | 一种飞行吊运负载移动平台降落控制方法及系统 |
CN115167145B (zh) * | 2022-08-08 | 2024-05-10 | 南开大学 | 一种飞行吊运负载移动平台降落控制方法及系统 |
CN116573557A (zh) * | 2023-05-25 | 2023-08-11 | 南京工业大学 | 一种塔式起重机振幅饱和非线性输出反馈控制方法及系统 |
CN116573557B (zh) * | 2023-05-25 | 2024-03-19 | 南京工业大学 | 一种塔式起重机振幅饱和非线性输出反馈控制方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN112580196B (zh) | 2024-06-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Sun et al. | Antiswing cargo transportation of underactuated tower crane systems by a nonlinear controller embedded with an integral term | |
Qian et al. | Dynamics and trajectory tracking control of cooperative multiple mobile cranes | |
CN108358062B (zh) | 欠驱动桥式吊车全局稳定控制方法 | |
CN110342400B (zh) | 一种基于负载能量耦合的桥式起重机定位消摆控制方法 | |
CN109725643B (zh) | 一种基于主动建模的旋翼飞行器非平衡负载吊运系统的控制方法 | |
CN112580196A (zh) | 变绳长无人机减摆控制器生成方法、控制方法及生成系统 | |
Liang et al. | Unmanned aerial transportation system with flexible connection between the quadrotor and the payload: modeling, controller design, and experimental validation | |
CN113955637B (zh) | 一种三维双摆桥式吊车的防摆控制方法及控制系统 | |
Zheng et al. | Saturated adaptive-law-based backstepping and its applications to a quadrotor hover | |
CN110376890B (zh) | 一种基于能量分析的二级摆飞行吊运系统控制方法 | |
CN108132598B (zh) | 移动装弹机械臂系统动力学模型与轨迹控制 | |
Liang et al. | Nonlinear control for aerial transportation systems with double-pendulum swing effects | |
Yang et al. | Finite-time convergence control for a quadrotor unmanned aerial vehicle with a slung load | |
Miao et al. | Trolley regulation and swing reduction of underactuated double-pendulum overhead cranes using fuzzy adaptive nonlinear control | |
CN113942934B (zh) | 基于速度控制的集装箱桥式起重机精准定位及防摇控制方法 | |
Yuchen et al. | Research on multi-UUV pursuit-evasion games strategies under the condition of strongly manoeuvrable evader | |
US20230409035A1 (en) | Method for building controller for robot, method, device for controlling motion of robot, and robot | |
CN113253747A (zh) | 基于分段能量的四旋翼吊挂运输系统非线性轨迹跟踪控制方法 | |
Yi et al. | Cascade sliding-mode controller for large-scale underactuated systems | |
Wang et al. | An anti-swing trajectory approach for an unmanned aerial vehicle with a slung payload | |
Yang et al. | A novel nonsingular fixed-time control for uncertain bridge crane system using two-layer adaptive disturbance observer | |
Sun et al. | Swing reduction control of ship crane based on rope length change | |
Liang et al. | Dynamics modeling and analysis for unmanned quadrotor transportation systems with double-pendulum swing effects | |
Sun et al. | Design of an adaptive depth controller for an autonomous underwater vehicle | |
Chen et al. | A time optimal trajectory planning method for overhead cranes with obstacle avoidance |
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 |