CN108319281B - 基于时间最优的旋翼飞行器吊运系统运动规划方法 - Google Patents
基于时间最优的旋翼飞行器吊运系统运动规划方法 Download PDFInfo
- Publication number
- CN108319281B CN108319281B CN201810013743.0A CN201810013743A CN108319281B CN 108319281 B CN108319281 B CN 108319281B CN 201810013743 A CN201810013743 A CN 201810013743A CN 108319281 B CN108319281 B CN 108319281B
- Authority
- CN
- China
- Prior art keywords
- aircraft
- representing
- time
- load
- acceleration
- 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 39
- 230000001133 acceleration Effects 0.000 claims abstract description 29
- 230000036461 convulsion Effects 0.000 claims abstract description 10
- 230000010355 oscillation Effects 0.000 claims abstract description 3
- 230000006870 function Effects 0.000 claims description 10
- 239000011159 matrix material Substances 0.000 claims description 8
- 238000005457 optimization Methods 0.000 claims description 7
- 238000006073 displacement reaction Methods 0.000 claims description 5
- 238000001228 spectrum Methods 0.000 claims description 3
- 230000001131 transforming effect Effects 0.000 claims 1
- 230000008569 process Effects 0.000 abstract description 7
- 238000012545 processing Methods 0.000 abstract description 4
- PXFBZOLANLWPMH-UHFFFAOYSA-N 16-Epiaffinine Natural products C1C(C2=CC=CC=C2N2)=C2C(=O)CC2C(=CC)CN(C)C1C2CO PXFBZOLANLWPMH-UHFFFAOYSA-N 0.000 abstract description 3
- 238000004088 simulation Methods 0.000 description 10
- 238000004364 calculation method Methods 0.000 description 5
- 238000004422 calculation algorithm Methods 0.000 description 4
- 238000013461 design Methods 0.000 description 4
- 238000002474 experimental method Methods 0.000 description 4
- 230000000694 effects Effects 0.000 description 3
- 230000009466 transformation Effects 0.000 description 3
- 238000013459 approach Methods 0.000 description 2
- 230000008878 coupling Effects 0.000 description 2
- 238000010168 coupling process Methods 0.000 description 2
- 238000005859 coupling reaction Methods 0.000 description 2
- HDRXZJPWHTXQRI-BHDTVMLSSA-N diltiazem hydrochloride Chemical compound [Cl-].C1=CC(OC)=CC=C1[C@H]1[C@@H](OC(C)=O)C(=O)N(CC[NH+](C)C)C2=CC=CC=C2S1 HDRXZJPWHTXQRI-BHDTVMLSSA-N 0.000 description 2
- 230000008030 elimination Effects 0.000 description 2
- 238000003379 elimination reaction Methods 0.000 description 2
- 230000002787 reinforcement Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000013016 damping Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000005381 potential energy Methods 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 238000007493 shaping process Methods 0.000 description 1
- 238000004611 spectroscopical analysis Methods 0.000 description 1
- 230000000087 stabilizing 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/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
-
- 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
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)
Abstract
一种基于时间最优的旋翼飞行器吊运系统运动规划方法,能够得到时间最优的飞行器定位与负载消摆轨迹,属于非线性欠驱动机电系统自动控制领域。首先建立完整的系统动力学模型,随后将系统表达为以加加速度为输入的非线性仿射形式。在离散化和近似化处理之后,可以将原本的时间最优运动规划问题转化为标准的非线性规划问题,这一过程中考虑负载摆动、飞行器速度、加速度、加加速度等各种约束。最后,利用序列二次规划方法即可对该问题进行求解。本发明在处理中无需线性化操作,保留了系统原本的属性,且可以加入对系统状态轨迹和输入量的约束;此外,该方法将飞行器加速度设为输入,从而得到加速度连续的轨迹,以免电机振动而影响其使用寿命。
Description
技术领域
本发明属于非线性欠驱动机电系统自动控制的技术领域,特别是涉及一种基于时间最优的旋翼飞行器吊运系统运动规划方法。
背景技术
旋翼飞行器包括单旋翼直升机与多旋翼飞行器(如四旋翼、六旋翼、八旋翼等),在日常生活的方方面面都有广泛应用,然而,其所具有的强非线性、强耦合性和欠驱动特性[1-3],为其控制带来了许多困难。相较于旋翼飞行器的控制,本发明中研究的旋翼飞行器吊运系统,控制目标包含飞行器快速精确定位和负载摆动消除两个方面,即除了针对飞行器本体的控制,也需要考虑负载的消摆,而负载的引入加剧了系统的前述三个特性。具体而言,负载的运动无法直接进行控制,是由飞行器的平移运动通过吊绳带动产生,飞行器的平移运动又是决定于其旋转运动,因此对旋翼飞行器吊运系统的控制是一个更有挑战的问题。
国内外相关领域的学者针对旋翼飞行器吊运系统的自动控制问题开展了大量的研究工作,典型的方法可以分为两类:镇定/调节控制,轨迹规划结合跟踪控制。对前者的研究包括嵌套饱和控制[4],连接和阻尼配置-无源控制[5],非线性分层控制[6],几何控制[7]等策略。轨迹规划结合跟踪控制的思路则是首先为飞行器设计一条轨迹,然后利用跟踪控制器对该飞行器期望轨迹进行跟踪,以完成对系统的控制。为此,很多学者对轨迹规划方法进行了研究。基于最优化原理,决策的最佳顺序具有无论初始状态如何,剩余的决策对于剩下的问题必须最优的性质,Fierro等[8-9]利用动态规划方法设计了消摆轨迹,但是需要对系统进行线性化。Sreenath等[10-11]则首先证明了旋翼飞行器吊运系统是微分平坦的,且以负载位置和飞行器偏航角为平坦输出,在此基础上构建平坦输出关于时间的优化问题并求解,从而得到了期望轨迹。Singhose等[12-13]将输入整形方法用于飞行器吊运系统,根据绳长量值将基本命令信号与一系列特定脉冲信号作卷积运算,从而实现消摆目标。此外,Faust等[14]提出将有限采样批量强化学习算法用于消摆轨迹的规划,Palunko等[15]则基于最小二乘策略迭代算法提出了一种飞行器轨迹的自学习策略。然而这些方法往往忽略了系统的状态轨迹和输入量约束,也没有考虑时间最优问题,因此限制了旋翼飞行器吊运系统的运送效率和安全性。此外,现有基于加速度为输入的规划方法会造成所得轨迹加速度不连续的问题,引发电机振动而影响其使用寿命。
发明内容
本发明的目的是解决现有旋翼飞行器吊运系统轨迹规划方法存在的上述不足,提供一种基于时间最优的旋翼飞行器吊运系统运动规划方法。
本发明通过建立完整的旋翼飞行器吊运系统动力学模型,分析飞行器平移运动与负载运动之间的动态耦合关系,将时间最优运动规划问题转换为非线性规划问题并利用序列二次规划方法进行求解,同时考虑系统状态量和控制输入约束,得到时间最优的飞行器平移运动轨迹。仿真与实验结果表明,本文方法不仅简单实用,并且在实现飞行器精确定位的同时可以快速消除负载摆动,提升了运送效率和系统的安全性,而以加加速度为输入的规划思路保证了加速度的连续性,减小了电机的负担,因而具有很好的实际应用意义。
本发明提供的基于时间最优的旋翼飞行器吊运系统运动规划方法包括:
第1、旋翼飞行器吊运系统动力学建模
利用拉格朗日方程建模,得到系统内外环模型如下:
其中,M,m分别表示旋翼飞行器与负载的质量,g表示重力加速度,x,y,z分别表示飞行器前向、侧向和竖直位移,表示飞行器前向、侧向和竖直加速度,θx,θy分别表示负载前向和侧向摆角,表示负载前向和侧向摆动速度,表示负载前向和侧向摆动加速度,Cx,Sx,Cy,Sy分别为cosθx,sinθx,cosθy,sinθy的缩写,l表示吊绳长度,J,Ω分别为飞行器转动惯量和其角速度在机体坐标系下的表达,R为机体坐标系到全局坐标系旋转矩阵,R13,R23,R33为旋转矩阵R最后一列的三个元素,f为供给旋翼飞行器推力输入,τ=[τ1,τ2,τ3]T为力矩输入,τ1,τ2,τ3分别表示关于前向、侧向和竖直方向力矩。
第2、构造旋翼飞行器吊运系统时间最优运动规划问题
考虑系统状态轨迹及输入量的约束,构造如下时间最优运动规划问题:
其中引入了新定义的外环系统状态量minimize表示最小,subjectto表示需要考虑的约束条件,T表示运输的总时间,uj=[jx,jy,jz]T表示前向、侧向、竖直加加速度控制输入,表示飞行器前向、侧向和竖直速度,x0,y0,z0表示飞行器起始位置,xd,yd,zd表示飞行器目标位置,vxb,vyb,vzb和axb,ayb,azb分别表示飞行器速度与加速度的限值,θxb,θyb和ωxb,ωyb分别表示负载摆角与摆动速度的限值,辅助函数β(ζ),H(ζ)具体形式如下:
第3、非线性规划问题转化
选择使用高斯伪谱法将上述最优控制问题(23)转化为如下的非线性规划问题:
其中,wk表示勒让德-高斯点相应的权重,ρ表示规范化后的时间尺度,边界值γmax与jmax定义如下:
γmax=[∞,vxb,∞,vyb,∞,vzb,θxb,ωxb,θyb,ωyb,axb,ayb,azb]T (31)
jmax=[jxb,jyb,jzb]T (32)
Dki(ρk)为拉格朗日基本多项式(插值基函数)的导数,具体表达如下:
第4、轨迹跟踪
对于通过上述方法获得的最优参考轨迹ξd(t),选择力和力矩跟踪控制器形式如下:
其中,δ和W为辅助函数,单位向量e3=[0,0,1]T,Rd,Ωd为期望姿态及期望角速度,Kp,Kd,KR,KΩ是待调整控制增益;利用控制器(33-34)计算得到相应的实时控制信号,驱动飞行器工作,实现上述控制目标。
本发明方法的理论依据及推导过程:
第1、旋翼飞行器吊运系统动力学建模
利用拉格朗日方程为旋翼飞行器吊运系统动力学建模。具体地,记ξ=[x,y,z]T为前向、侧向和竖直位移,负载前向和侧向摆角为Θ=[θx,θy]T,l表示吊绳长度,则负载位置ξp=[xp,yp,zp]T表示如下:
其中,Cx,Sx,Cy,Sy分别为cosθx,sinθx,cosθy,sinθy的缩写。系统重力势能表示如下:
V=Mgz+mgzp (2)
其中,M,m分别表示旋翼飞行器与负载的质量,g表示重力加速度。为降低计算量,将系统的总动能Tt分为如下两部分:
Tt=Tou+Tin (3)
其中,Tou包含飞行器平动动能和负载动能,具体形式如下:
Tin为飞行器转动动能,表示如下:
其中,J,Ω分别为飞行器转动惯量和其角速度在机体坐标系下的表达。
由于Tou与Tin之间并不会包含交叉项,因此定义旋翼飞行器吊运系统的外环为飞行器平移运动与负载摆动状态,内环为飞行器转动状态,从而可以分开计算系统的动态方程,便于表达且减轻了计算负担。具体地,外环子系统包含状态量q=[x,y,z,θx,θy]T,其拉格朗日函数可表示为:
Lou=Tou-V (6)
相应的广义力Qi,i={1,2,...,5}为
Q1=fR13,Q2=fR23,Q3=fR33,Q4=0,Q5=0 (7)
R13,R23,R33为机体坐标系到全局坐标系旋转矩阵R最后一列的三个元素,f为供给旋翼飞行器推力输入。由拉格朗日方程可得:
将(1-2),(4),(6-7)代入上述方程整理可得旋翼飞行器吊运系统外环动力学模型表示如下:
由(5)可知,系统内环能量相比飞行器本体转动特性并未改变,因此内环动力学方程为:
其中,τ=[τ1,τ2,τ3]T为力矩输入,τ1,τ2,τ3分别表示关于前向、侧向和竖直方向力矩。
至此,得到旋翼飞行器吊运系统动力学方程(9-10),观察可知负载运动受制于飞行器平移运动,因此,为完成对系统的时间最优运动规划,将主要从外环子系统表达(9)入手,(10)则用于力矩控制器设计。
第2、构造旋翼飞行器吊运系统时间最优运动规划问题
对(9)中后两行,两边同除以ml得:
其中,uj=j表示输入量,辅助函数β(ζ),H(ζ)具体形式如下:
β8,β10分别表示如下:
根据实际指标,对旋翼飞行器及负载摆角的约束与规划从如下几个方面进行考虑:
(i)飞行器位置、速度、加速度与负载摆角、摆动速度始末约束
在运送过程应保证把飞行器从0时刻的起始位置ξ0=[x0,y0,z0]T,运送到T时刻的目标位置ξd=[xd,yd,zd]T。对于初始与目标位置,飞行器速度、加速度与负载摆角、摆动速度均为0。该约束可表示为:
ζ(0)=[x0,0,y0,0,z0,0,0,0,0,0,0,0,0]T (17)
ζ(T)=[xd,0,yd,0,zd,0,0,0,0,0,0,0,0]T (18)
(ii)飞行器速度、加速度约束
考虑到电机的实际性能约束,飞行器速度、加速度应保持在一定的范围内。该约束即为:
其中,vxb,vyb,vzb和axb,ayb,azb分别表示飞行器速度与加速度的限值。
(iii)负载摆角、摆动速度约束
为保证运送过程中的安全性,负载摆角及其摆动速度应保持在一定的范围内,即
|θx(t)|≤θxb,|θy(t)|≤θyb (21)
其中,θxb,θyb和ωxb,ωyb分别表示负载摆角与摆动速度的限值。
综上可得,时间最优化问题为:
其中minimize表示最小,subject to表示需要考虑的约束条件。
第3、非线性规划问题转化
为求解(23),我们选择使用高斯伪谱法将上述最优控制问题转化为非线性规划问题。主要过程分为系统状态与输入的离散化和近似处理。
为此,首先定义
从而将时间尺度从t∈[0,T]转换为ρ∈[-1,1]。求取N阶勒让德多项式的根可以得到N个勒让德-高斯点,记作点列{ρ1,ρ2,...,ρN}∈(-1,1),选取ρ0=-1,从而可以利用如下N+1拉格朗日插值多项式近似系统的状态轨迹和输入量:
其中,ρ=ρi时刻状态轨迹和输入量的值分别为ζ(ρi)和uj(ρi),拉格朗日基本多项式(插值基函数)Li(ρ)具体表达如下:
进而,根据(16)和(18)可以得到状态轨迹的导数表达为
其中,Dki(ρk)为Li在ρ=ρk时刻的导数,表示如下:
至此,基于上述过程,原本的优化问题(14)转化为如下的非线性规划问题:
其中wk表示勒让德-高斯点相应的权重,γmax与jmax定义如下:
γmax=[∞,vxb,∞,vyb,∞,vzb,θxb,ωxb,θyb,ωyb,axb,ayb,azb]T (31)
jmax=[jxb,jyb,jzb]T (32)
对于该非线性规划问题,通过序列二次规划即可求解,得到期望轨迹。
第4、轨迹跟踪
对于通过上述方法获得的最优参考轨迹ξd(t),选择力和力矩跟踪控制器形式如下:
其中,δ和W具体表达如下:
ξd为规划所得期望轨迹,Rd,Ωd为期望姿态及期望角速度,Kp,Kd,KR,KΩ是待调整控制增益,单位向量e3=[0,0,1]T;利用控制器(33-34)计算即可得到相应的实时控制信号,驱动飞行器工作,实现上述控制目标。
本发明的优点和有益效果:
本发明提出了一种基于时间最优的旋翼飞行器吊运系统运动规划方法。本发明首先通过拉格朗日方程建立了完整的系统动力学模型,并将其表达为非线性仿射形式。接下来考虑飞行器位置、速度、加速度与负载摆角、摆动速度始末约束,以及过程中飞行器速度、加速度、加加速度约束和负载摆角、摆动速度约束,构造了时间最优运动规划问题。随后,利用高斯伪谱法将该最优控制问题转化为非线性规划问题,并利用序列二次规划进行求解得到期望轨迹。对该期望轨迹,设计了力和力矩跟踪控制器。仿真与实验结果表明,本发明设计简单直观,且可以实现旋翼飞行器的精确定位与负载的快速消摆。此外,加加速度为输入量的设计,保证了加速度的连续性,减小了电机的负担。
附图说明:
图1飞行器期望位移与负载摆动仿真结果。
图2飞行器速度仿真结果。
图3飞行器加速度仿真结果。
图4飞行器加加速度仿真结果。
图5飞行器实际位移与负载摆动实验结果。
图6力与力矩输入实验结果。
具体实施方式:
实施例1:
第1、旋翼飞行器吊运系统动力学建模
利用拉格朗日方程为旋翼飞行器吊运系统动力学建模,引入系统内外环的概念并分别对其进行计算,以减轻建模过程的计算压力;
根据上述思路,可得旋翼飞行器吊运系统动力学模型表示如下:
这里,选择的系统参数如下:
M=0.625kg,m=0.075kg,J=diag([0.005,0.005,0.013])kg·m2,l=0.535m,g=9.8m/s2
第2、构造旋翼飞行器吊运系统时间最优运动规划问题
考虑系统状态轨迹及输入量的约束,构造如下时间最优运动规划问题:
其中,飞行器初始与目标位置分别设定为:
x0=0.6,y0=0.0,z0=1.8
xd=-0.4,yd=1.5,zd=1.2
各约束上下界选择如下:
vxb=4m/s,vyb=4m/s,vzb=3m/s
axb=0.6m/s2,ayb=0.6m/s2,azb=1.0m/s2
jxb=1.0m/s3,jyb=1.0m/s3,jzb=1.5m/s3
θxb=θyb=5°,ωxb=ωyb=15°/s,
第3、非线性规划问题转化
其中,ζ(ρi)和uj(ρi)分别表示ρ=ρi时刻状态轨迹和输入量的值,拉格朗日基本多项式(插值基函数)Li(ρ)具体表达如下:
进而,可以得到状态轨迹的导数表达为
其中,Dki(ρk)为Li在ρ=ρk时刻的导数,表示如下:
据此,可以得到如下非线性规划问题:
其中wk表示勒让德-高斯点相应的权重,γmax与jmax定义如下:
γmax=[∞,vxb,∞,vyb,∞,vzb,θxb,ωxb,θyb,ωyb,axb,ayb,azb]T (31)
jmax=[jxb,jyb,jzb]T (32)
第4、仿真实验效果描述
第4.1、仿真结果
为验证本发明中所提出轨迹规划算法的性能,首先在MATLAB/Simulink环境中进行数值仿真,具体分为两步:第一,按照上述算法为旋翼飞行器规划一条时间最优的参考轨迹;第二,以该轨迹为输入,查看负载的摆动状况。
仿真的结果如附图1-4所示。图1给出规划出的飞行器期望轨迹与负载摆动,二者用实线表示,点画线表示预设的摆动范围。图2-4则给出了该轨迹的速度、加速度、加加速度信号。从图中可以看出,在飞行器的快速定位与负载消摆两个方面均得到了令人满意的效果,此外,规划得到的轨迹同时满足了设定的状态轨迹和输入量约束,由于以加加速度为输入,期望轨迹的加速度信号是连续的。
第4.2、实验结果
通过获取飞行器位置、速度与负载摆动信号,选择跟踪控制器如下:
其中,辅助向量δ和矩阵W具体表达如下:
ξd为规划所得期望轨迹,Rd,Ωd为期望姿态及期望角速度,Kp,Kd,KR,KΩ是待调整控制增益;利用控制器(33-34)计算即可得到相应的实时控制信号。
在实验中,选取的跟踪控制器控制增益为:
Kp=diag([3.70,3.50,9.95]),Kd=diag([2.34,2.34,6.50])
KR=diag([6.60,6.60,6.30]),KΩ=diag([0.60,0.60,1.00])
实验结果如附图5-6所示。其中,图5给出的实线代表飞行器实际飞行轨迹与负载摆动信号,虚线为飞行器期望轨迹,点画线代表预设的摆动范围。图6给出了力与力矩输入信号。可以看出,在该控制器下,飞行器能够很好地跟踪设计的期望轨迹,在实现了精确定位目标的同时,负载摆动也得到了很好地抑制。实验结果表明,该轨迹规划方法具有良好的控制效果。
参考文献
[1]S.Islam,P.Liu,and S.A.El,Nonlinear adaptive control for quadrotorflying vehicle,Nonlinear Dynamics,78(1):117–133,2014.
[2]B.Zhao,B.Xian,Y.Zhang,and X.Zhang,Nonlinear robust adaptivetracking control of a quadrotor UAV via immersion and invariance methodology,IEEE Transactions on Industrial Electronics,62(5):2891–2902,2015.
[3]B.Zhao,B.Xian,Y.Zhang,and X.Zhang,Nonlinear robust sliding modecontrol of a quadrotor unmanned aerial vehicle based on immersion andinvariance method,International Journal of Robust and Nonlinear Control,25(18):3714–3731,2015.
[4]M.M.Nicotra,E.Garone,R.Naldi,and L.Marcon,Nested saturationcontrol of an UAV carrying a suspended load,in Proceedings of the 2014American Control Conference(ACC),2014:3585–3590.
[5]M.E.G.-Sánchez,D.A.M.-Ravell,R.Lozano,and C.D.G.-Beltrán,Swing-attenuation for a quadrotor transporting a cable-suspended payload,ISAtransactions,68:433–449,2017.
[6]X.Liang,Y.Fang,N.Sun,and H.Lin,Nonlinear hierarchical control forunmanned quadrotor transportation systems,IEEE Transactions on IndustrialElectronics,in press,DOI:10.1109/TIE.2017.2752139,2017.
[7]F.A.Goodarzi,D.Lee,and T.Lee T,Geometric control of a quadrotorUAV transporting a payload connected via flexible cable,
International Journal of Control Automation and Systems,13(6):1486–1498,2015.
[8]I.Palunko,R.Fierro,and P.Cruz,Trajectory generation for swing-freemaneuvers of a quadrotor with suspended payload:A dynamic programmingapproach,in Proceedings of the 2012 IEEE International Conference on Roboticsand Automation(ICRA),2012:2691–2697.
[9]I.Palunko,P.Cruz,and R.Fierro,Agile load transportation:Safe andefficient load manipulation with aerial robots,IEEE Robotics AutomationMagazine,19(3):69–79,2012.
[10]K.Sreenath,N.Michael,and V.Kumar,Trajectory generation andcontrol of a quadrotor with a cable-suspended load-a differentially-flathybrid system,in Proceedings of the 2013 IEEE International Conference onRobotics and Automation(ICRA),2013:4888–4895.
[11]K.Sreenath,T.Lee,and V.Kumar,Geometric control and differentialflatness of a quadrotor UAV with a cable-suspended load,in Proceedings of the52nd IEEE Conference on Decision and Control(CDC),2013:2269–2274.
[12]J.Potter,W.Singhose,and M.Costello,Reducing swing of modelhelicopter sling load using input shaping,in Proceedings of the 2011 9th IEEEInternational Conference on Control and Automation(ICCA),2011:348–353.
[13]C.Adams,J.Potter,and W.Singhose,Modeling and input shapingcontrol of a micro coaxial radio-controlled helicopter carrying a suspendedload,in Proceedings of the 2012 12th International Conference on Control,Automation and Systems(ICCAS),2012:645-650.
[14]A.Faust,I.Palunko,P.Cruz,R.Fierro,and L.Tapia,Learning swing-freetrajectories for UAVs with a suspended load,in Proceedings of the 2013 IEEEInternational Conference on Robotics and Automation(ICRA),2013:4902–4909.
[15]I.Palunko,A.Faust,P.Cruz,L.Tapia,and R.Fierro,A reinforcementlearning approach towards autonomous suspended load manipulation using aerialrobots,in Proceedings of the 2013 IEEE International Conference on Roboticsand Automation(ICRA),2013:4896–4901.
Claims (1)
1.一种基于时间最优的旋翼飞行器吊运系统运动规划方法,其特征在于该方法包括:
第1、旋翼飞行器吊运系统动力学建模;
第2、构造旋翼飞行器吊运系统时间最优运动规划问题;
第3、非线性规划问题转化;
第4、轨迹跟踪;
第1步中:
利用拉格朗日方程建模,得到系统模型如下:
其中,M,m分别表示旋翼飞行器与负载的质量,g表示重力加速度,x,y,z分别表示飞行器前向、侧向和竖直位移,表示飞行器前向、侧向和竖直加速度,θx,θy分别表示负载前向和侧向摆角,表示负载前向和侧向摆动速度,表示负载前向和侧向摆动加速度,Cx,Sx,Cy,Sy分别为cosθx,sinθx,cosθy,sinθy的缩写,l表示吊绳长度,J,Ω分别为飞行器转动惯量和其角速度在机体坐标系下的表达,R为机体坐标系到全局坐标系旋转矩阵,R13,R23,R33为旋转矩阵R最后一列的三个元素,f为供给旋翼飞行器推力输入,τ=[τ1,τ2,τ3]T为力矩输入,τ1,τ2,τ3分别表示关于前向、侧向和竖直方向力矩;sk运算符表示将向量扩张为反对称矩阵的运算;
第2步中:
考虑系统状态轨迹及输入量的约束,构造如下时间最优运动规划问题:
其中引入了新定义的外环系统状态量minimize表示最小,subject to表示需要考虑的约束条件,T表示运输的总时间,uj表示前向、侧向、竖直加加速度控制输入uj=[jx,jy,jz]T,表示飞行器前向、侧向和竖直速度,x0,y0,z0表示飞行器起始位置,xd,yd,zd表示飞行器目标位置,vxb,vyb,vzb和axb,ayb,azb分别表示飞行器速度与加速度的限值,θxb,θyb和ωxb,ωyb分别表示负载摆角与摆动速度的限值,辅助函数β(ζ),H(ζ)具体形式如下:
式(14)中I3×3表示3×3的单位矩阵,主对角线元素为1,其余元素为0;
第3步中:
选择使用高斯伪谱法将上述最优控制问题(23)转化为如下的非线性规划问题:
其中,wk表示勒让德-高斯点相应的权重,ρ表示规范化后的时间尺度,ζ(ρi)和uj(ρi)分别表示ρ=ρi时刻状态轨迹和输入量的值,边界值γmax与jmax定义如下:
γmax=[∞,vxb,∞,vyb,∞,vzb,θxb,ωxb,θyb,ωyb,axb,ayb,azb]T (31)
jmax=[jxb,jyb,jzb]T (32)
其中:jxb,jyb,jzb分别表示前向、侧向、竖直加加速度控制输入的边界值;Dki(ρk)为拉格朗日基本多项式的导数,具体表达如下:
第4步中:
对于通过上述方法获得的最优参考轨迹ξd(t),选择力和力矩跟踪控制器形式如下:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810013743.0A CN108319281B (zh) | 2018-01-08 | 2018-01-08 | 基于时间最优的旋翼飞行器吊运系统运动规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810013743.0A CN108319281B (zh) | 2018-01-08 | 2018-01-08 | 基于时间最优的旋翼飞行器吊运系统运动规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108319281A CN108319281A (zh) | 2018-07-24 |
CN108319281B true CN108319281B (zh) | 2021-02-02 |
Family
ID=62893083
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810013743.0A Active CN108319281B (zh) | 2018-01-08 | 2018-01-08 | 基于时间最优的旋翼飞行器吊运系统运动规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108319281B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109828600B (zh) * | 2019-01-09 | 2020-07-24 | 北京理工大学 | 时间最优快速三维避障路径规划方法 |
CN111551178B (zh) * | 2020-04-27 | 2022-02-18 | 广东工业大学 | 一种基于最短路径的分段轨迹时间规划方法 |
CN112859895B (zh) * | 2021-01-12 | 2022-06-10 | 南开大学 | 面向拉力优化和动态过程设计的双无人机吊运系统载荷重分配方法 |
CN113031655B (zh) * | 2021-03-23 | 2022-05-03 | 南开大学 | 一种伴有负载升降的飞行吊运系统及其控制方法 |
CN113721555B (zh) * | 2021-08-27 | 2023-11-28 | 深圳数马电子技术有限公司 | 一种s型速度规划的目标速度的确定方法及装置 |
CN114137972B (zh) * | 2021-11-24 | 2023-10-31 | 广州小鹏自动驾驶科技有限公司 | 路径生成方法、装置、交通工具及存储介质 |
CN116185051B (zh) * | 2022-09-07 | 2023-09-29 | 浙江大学 | 一种基于四旋翼动力学模型的时间最优轨迹规划方法及装置 |
Citations (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102663520A (zh) * | 2012-04-05 | 2012-09-12 | 中国人民解放军国防科学技术大学 | 一种基于最优控制问题伪谱法求解构架的次优解求解方法 |
CN102849625A (zh) * | 2012-06-28 | 2013-01-02 | 无锡大力起重机械有限公司 | 桥式起重机的吊具防摇控制方法 |
CN103365296A (zh) * | 2013-06-29 | 2013-10-23 | 天津大学 | 一种四旋翼无人飞行器非线性输出反馈飞行控制方法 |
CN104192713A (zh) * | 2014-09-10 | 2014-12-10 | 南开大学 | 基于微分平坦与b样条的时间最优桥式吊车轨迹规划方法 |
CN104444817A (zh) * | 2014-11-14 | 2015-03-25 | 南开大学 | 欠驱动吊车自适应消摆定位控制方法 |
FR2918783B1 (fr) * | 2007-07-09 | 2015-04-10 | Eads Deutschland Gmbh | Systeme d'evitement de collisions et de conflits pour des avions automomes sans pilotes (uav) |
CN104571120A (zh) * | 2014-12-31 | 2015-04-29 | 天津大学 | 四旋翼无人机的姿态非线性自适应控制方法 |
CN105174061A (zh) * | 2015-09-28 | 2015-12-23 | 南开大学 | 基于伪谱法的双摆吊车全局时间最优轨迹规划方法 |
CN106406341A (zh) * | 2016-09-06 | 2017-02-15 | 广西师范大学 | 四旋翼无人飞行器的飞行控制方法 |
CN106651014A (zh) * | 2016-12-12 | 2017-05-10 | 南京航空航天大学 | 一种运输机飞行轨迹优化方法 |
CN106909164A (zh) * | 2017-02-13 | 2017-06-30 | 清华大学 | 一种无人机最小时间平滑轨迹生成方法 |
CN107065553A (zh) * | 2017-04-20 | 2017-08-18 | 南开大学 | 多旋转激励平移振荡器系统非线性耦合自适应控制方法 |
CN107244422A (zh) * | 2017-08-11 | 2017-10-13 | 成都希德电子信息技术有限公司 | 塔吊施工用无人机辅助系统 |
CN107358322A (zh) * | 2017-07-12 | 2017-11-17 | 中南大学 | 一种无人机快递自动投送最短路径规划方法 |
CN107491090A (zh) * | 2017-08-25 | 2017-12-19 | 中国人民解放军火箭军工程大学 | 基于检测点自适应伪谱法的飞行器再入轨迹快速规划方法 |
CN107544551A (zh) * | 2017-09-01 | 2018-01-05 | 北方工业大学 | 一种基于智能无人机的区域快捷物流运输方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6846099B2 (en) * | 2001-06-21 | 2005-01-25 | Honeywell International Inc. | Aircraft position light |
US20110084162A1 (en) * | 2009-10-09 | 2011-04-14 | Honeywell International Inc. | Autonomous Payload Parsing Management System and Structure for an Unmanned Aerial Vehicle |
WO2016007796A1 (en) * | 2014-07-10 | 2016-01-14 | Breeze-Eastern Corporation | Helicopter hoist systems, devices, and methodologies |
-
2018
- 2018-01-08 CN CN201810013743.0A patent/CN108319281B/zh active Active
Patent Citations (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2918783B1 (fr) * | 2007-07-09 | 2015-04-10 | Eads Deutschland Gmbh | Systeme d'evitement de collisions et de conflits pour des avions automomes sans pilotes (uav) |
CN102663520A (zh) * | 2012-04-05 | 2012-09-12 | 中国人民解放军国防科学技术大学 | 一种基于最优控制问题伪谱法求解构架的次优解求解方法 |
CN102849625A (zh) * | 2012-06-28 | 2013-01-02 | 无锡大力起重机械有限公司 | 桥式起重机的吊具防摇控制方法 |
CN103365296A (zh) * | 2013-06-29 | 2013-10-23 | 天津大学 | 一种四旋翼无人飞行器非线性输出反馈飞行控制方法 |
CN104192713A (zh) * | 2014-09-10 | 2014-12-10 | 南开大学 | 基于微分平坦与b样条的时间最优桥式吊车轨迹规划方法 |
CN104444817A (zh) * | 2014-11-14 | 2015-03-25 | 南开大学 | 欠驱动吊车自适应消摆定位控制方法 |
CN104571120A (zh) * | 2014-12-31 | 2015-04-29 | 天津大学 | 四旋翼无人机的姿态非线性自适应控制方法 |
CN105174061A (zh) * | 2015-09-28 | 2015-12-23 | 南开大学 | 基于伪谱法的双摆吊车全局时间最优轨迹规划方法 |
CN106406341A (zh) * | 2016-09-06 | 2017-02-15 | 广西师范大学 | 四旋翼无人飞行器的飞行控制方法 |
CN106651014A (zh) * | 2016-12-12 | 2017-05-10 | 南京航空航天大学 | 一种运输机飞行轨迹优化方法 |
CN106909164A (zh) * | 2017-02-13 | 2017-06-30 | 清华大学 | 一种无人机最小时间平滑轨迹生成方法 |
CN107065553A (zh) * | 2017-04-20 | 2017-08-18 | 南开大学 | 多旋转激励平移振荡器系统非线性耦合自适应控制方法 |
CN107358322A (zh) * | 2017-07-12 | 2017-11-17 | 中南大学 | 一种无人机快递自动投送最短路径规划方法 |
CN107244422A (zh) * | 2017-08-11 | 2017-10-13 | 成都希德电子信息技术有限公司 | 塔吊施工用无人机辅助系统 |
CN107491090A (zh) * | 2017-08-25 | 2017-12-19 | 中国人民解放军火箭军工程大学 | 基于检测点自适应伪谱法的飞行器再入轨迹快速规划方法 |
CN107544551A (zh) * | 2017-09-01 | 2018-01-05 | 北方工业大学 | 一种基于智能无人机的区域快捷物流运输方法 |
Non-Patent Citations (7)
Title |
---|
A Nonlinear model predictive control for a multi-rotor with heavy slung load;TRACHTE J etal;《The 2014 IEEE International Conference on Unmannde Aircraft Systems》;20141231;第6149-6154页 * |
Modelling, Simulation and Flight Test of a Model Predictive Controlled Multirotor with Heavy Slung Load;Notter S etal;《IFAC (International Federation of Automatic Control)》;20161231;第182-187页 * |
平面四旋翼无人飞行器运送系统的轨迹规划与跟踪控制器设计;梁潇等;《控制理论与应用》;20151130;第1430-1438页 * |
无人机吊挂飞行的非线性控制方法设计;鲜斌等;《控制理论与应用》;20160331;第273-279页 * |
欠驱动吊车轨迹规划与非线性控制策略设计、分析及应用;孙宁;《中国博士学位论文全文数据库 工程科技Ⅱ辑》;20150415;第C029-19页 * |
欠驱动桥式吊车消摆跟踪控制;孙宁等;《控制理论与应用》;20150331;第326-333页 * |
非线性系统的最优控制问题研究及其若干应用;刘熔洁;《中国博士学位论文全文数据库 基础科学辑》;20161216;第A0002-36页 * |
Also Published As
Publication number | Publication date |
---|---|
CN108319281A (zh) | 2018-07-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108319281B (zh) | 基于时间最优的旋翼飞行器吊运系统运动规划方法 | |
Zhang et al. | Grasp a moving target from the air: System & control of an aerial manipulator | |
Garimella et al. | Towards model-predictive control for aerial pick-and-place | |
Ritz et al. | Carrying a flexible payload with multiple flying vehicles | |
CN107357166B (zh) | 小型无人直升机的无模型自适应鲁棒控制方法 | |
CN105174061B (zh) | 基于伪谱法的双摆吊车全局时间最优轨迹规划方法 | |
CN109725643B (zh) | 一种基于主动建模的旋翼飞行器非平衡负载吊运系统的控制方法 | |
CN112346470A (zh) | 一种基于改进自抗扰控制的四旋翼姿态控制方法 | |
Liang et al. | Adaptive prescribed performance control of unmanned aerial manipulator with disturbances | |
CN113359427B (zh) | 多无人机协同飞行吊运系统及定位消摆控制方法 | |
CN110456816B (zh) | 一种基于连续终端滑模的四旋翼轨迹跟踪控制方法 | |
CN111459188B (zh) | 一种基于四元数的多旋翼非线性飞行控制方法 | |
CN111813140B (zh) | 一种具有高精度的四旋翼无人机轨迹跟踪控制方法 | |
CN111176318B (zh) | 面向消除稳态误差的飞行吊运系统定位消摆方法及系统 | |
Liang et al. | Unmanned aerial transportation system with flexible connection between the quadrotor and the payload: modeling, controller design, and experimental validation | |
CN111338369B (zh) | 一种基于非线性逆补偿的多旋翼飞行控制方法 | |
Liang et al. | Nonlinear control for aerial transportation systems with double-pendulum swing effects | |
CN116069050A (zh) | 一种抗扰动的旋翼无人机吊载系统减摇控制方法及装置 | |
Ouyang et al. | Control of an aerial manipulator using a quadrotor with a replaceable robotic arm | |
Li et al. | Design and longitudinal dynamics decoupling control of a tilt-rotor aerial vehicle with high maneuverability and efficiency | |
Sumathy et al. | Projection operator‐based robust adaptive control of an aerial robot with a manipulator | |
Wang et al. | An anti-swing trajectory approach for an unmanned aerial vehicle with a slung payload | |
Liu et al. | Large-angle and high-speed trajectory tracking control of a quadrotor UAV based on reachability | |
Hao et al. | Stewart-Inspired Posture Control for a UAV Undertaking Platform Based on Dynamic Model Predictive Control | |
Yin et al. | Flight control system design and autonomous flight control of small-scale unmanned helicopter based on nanosensors |
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 |