针对旋翼无人机吊挂运输系统的非线性控制方法技术方案

本发明专利技术涉及旋翼无人机的吊挂负载运输飞行控制技术，为实现在该系统部分参数未知的条件下，控制四旋翼无人机位置的同时较好地抑制吊挂负载在飞行中的摆动。本发明专利技术采用的技术方案是，基于能量法的四旋翼无人机吊挂飞行系统控制方法，步骤是，基于能量函数方法设计李亚普诺夫方程，进而设计控制器实现无人机控制，进一步具体地，首先通过分别对四旋翼无人机吊挂飞行过程中的无人机和吊挂物体分别进行受力分析，从而获得四旋翼无人机吊挂飞行过程的非线性动力学模型。本发明专利技术主要应用于旋翼无人机的吊挂负载运输飞行控制。

Nonlinear control method for hoist hoist hoist system of rotor

The invention relates to a suspended load transport flight control technology for a rotorcraft UAV, in order to control the position of the four rotor UAV and suppress the swing of the hanging load in flight when the partial parameters of the system are unknown. The technical proposal of the invention is that the flight control method, system energy method four rotor UAV is designed based on hanging steps, Lyapunov equation method based on energy function, and then design a controller for UAV control, further specifically, first through the process of UAV flight were hanging on four rotor UAV and hanging the objects were stress analysis, nonlinear dynamics model to obtain the four rotor flight of UAV is hanging. The invention is mainly applied to the hoisting load transport flight control of the rotor unmanned aerial vehicle.

【技术实现步骤摘要】
针对旋翼无人机吊挂运输系统的非线性控制方法
本专利技术涉及一种旋翼无人机的吊挂负载运输飞行的控制方法，特别是涉及四旋翼无人机以吊挂方式负载物体飞行的控制方法。具体讲，涉及针对旋翼无人机吊挂运输系统的非线性控制方法。
技术介绍
四旋翼无人机是一种多旋翼结构的飞行器。微型无人机以其在自然灾害中查险救援，警用及军用任务，农业施肥等领域发挥的重大作用，引起科研人员的广泛关注。无人机吊挂飞行是将微型无人机运用于各种具体任务的重要实现方式。近年来，无人机吊挂飞行的问题日益得到国内外高校和研究团队的关注。目前国内研究人员的相关研究工作多为针对全尺寸直升机吊挂飞行中，面向飞行员的操作控制性性能问题，以及针对吊挂绳索和吊挂载荷的空气动力学特性分析问题(期刊：南京航空航天大学学报；著者：齐万涛，陈仁良；出版年月：2011年；文章题目：直升机吊挂飞行稳定性和操纵性分析；页码：406-412)。而对微、小型多旋翼无人机的吊挂飞行问题涉及相对较少。国外研究人员针对无人机直升机吊挂飞行的问题提出了多种不同的控制方法。其中，美国宾夕法尼亚大学的研究人员较早开展了这方向的研究工作，并已取得了一些前期的研究成果。其基于微分平滑(differentialflatness)方法设计了针对平面四旋翼无人机吊挂系统的控制器，实现了针对四旋翼无人机吊挂系统的轨迹生成和跟踪，并将这种控制方法扩展到三维环境(会议：ProceedingsoftheIEEEConferenceonRoboticsandAutomation(ICRA)；著者：KoushilSreenath，NathanMichael，VijayKumar；出版年月：2013年；文章题目：Trajectorygenerationandcontrolofaquadrotorwithacable-suspendedload-Adifferentially-flathybridsystem；页码4888-4895)。另外，其研究人员利用几何控制(geometriccontrol)和微分平滑方法，达到了四旋翼无人机吊挂系统几乎全局指数稳定的控制效果(会议：Proceedingsofthe52ndIEEEConferenceonDecisionandControl；著者：KoushilSreenath，TaeyoungLee，VijayKumar；出版年月：2013年；文章题目：GeometriccontrolanddifferentialflatnessofaquadrotorUAVwithacable-suspendedload；页码：2269-2274)。然而其所设计的控制器结构较为复杂，并且需要无人机飞行状态的高阶导数项，在运算能力有限的无人机机载控制器上实现存在一定困难。美国新墨西哥大学同样在无人机吊挂飞行领域取得了较多科研成果。其研究人员利用动态规划(dynamicprogramming)算法实现了四旋翼无人机吊挂飞行的轨迹跟踪(会议：ProceedingsoftheIEEEInternationalConferenceonRoboticsandAutomation(ICRA)；著者：IvanaPalunko，RafaelFierro，andPatricioCruz；出版年月：2012年；文章题目：Trajectorygenerationforswing-freemaneuversofaquadrotorwithsuspendedpayload:adynamicprogrammingapproach；页码：2691-2697)。另外，其研究人员利用强化学习(reinforcementlearning)的方法，实现了通过对四旋翼飞行器位置和姿态的调整达到对吊挂负载的轨迹进行规划的目的(会议：ProceedingsoftheIEEEInternationalConferenceonRoboticsandAutomation(ICRA)；著者：IvanaPalunko，AleksandraFaust，PatricioCruz，LydiaTapia，andRafaelFierro；出版年月：2013；文章题目：AReinforcementLearningApproachTowardsAutonomousSuspendedLoadManipulationUsingAerialRobots；页码：4896-4901)。虽然其设计的轨迹规划方法都较好的实现了吊挂减摆的目的，然而飞行系统仍要依赖优越的控制算法才能实现对设计轨道的有效跟踪。另外一些研究团队将不同的控制思想应用于无人机吊挂系统的分析和研究。例如，一些研究人员基于模糊理论设计了一种新型控制器，实现了无人直升机吊挂系统在平衡点附近的抗摆控制，并通过与经典模糊PD控制器的对比，表明该控制器具有良好的控制效果(期刊：AerospaceScienceandTechnology；著者：HanafyM。Omar；文章题目：Designinganti-swingfuzzycontrollerforhelicopterslung-loadsystemnearhoverbyparticleswarms；页码：223-234)。但文中并未给出较为严格的稳定性分析和收敛性证明。
技术实现思路
为克服现有技术的不足，本专利技术旨在提出提出一种基于能量法的非线性自适应鲁棒控制方法，实现在该系统部分参数未知的条件下，控制四旋翼无人机位置的同时较好地抑制吊挂负载在飞行中的摆动。本专利技术采用的技术方案是，基于能量法的四旋翼无人机吊挂飞行系统控制方法，步骤是，基于能量函数方法设计李亚普诺夫方程，进而设计控制器实现无人机控制，进一步具体地，首先通过分别对四旋翼无人机吊挂飞行过程中的无人机和吊挂物体分别进行受力分析，从而获得四旋翼无人机吊挂飞行过程的非线性动力学模型：式(1)中各变量定义如下：mQ和mL分别为四旋翼无人机和负载的质量，L为绳长，G＝(0,0,g)为重力加速度，PQ(t)＝(xQ(t),yQ(t),zQ(t))为四旋翼飞行器在空间中的位置坐标，F(t)＝(Fx(t),Fy(t),Fz(t))为四旋翼无人机提供的总升力,q(t)＝(sinγx(t)cosγy(t),sinγy(t),cosγx(t)cosγy(t))为无人机指向吊挂负载的单位向量，其中γx(t),γy(t)为吊挂负载摆角；针对如式(1)所示系统的控制器设计：F(t)＝fa(t)q(t)+Fb(t)(2)式(2)中，各符号含义如下：式(3)中kQ,kL均为控制增益，kQ>kL且大于零，另外式(4)、(5)中K,KP分别为控制增益矩阵，均为正定对角矩阵，eQ(t)＝PQ(t)-Pd为无人机的位置误差，式(3)中，为对绳长L的自适应估计，其自适应更新率为：其中映射函数proj(.)定义为控制增益矩阵中的Kp与K分别代表控制器的“比例项”与“微分项”对应矩阵；控制增益kQ与kL分别代表飞行器位置、速度误差与负载位置、速度误差在控制策略中所占的比重。增加kQ/kL的值会提高对飞行器误差的调节速度与控制精度，但同时会牺牲一定的对负载误差的调节速度与控制精度；而减小kQ/kL的值则会产生相反的效果。本文档来自技高网...

【技术保护点】
一种基于能量法的四旋翼无人机吊挂飞行系统控制方法，其特征是，步骤是，基于能量函数方法设计李亚普诺夫方程，进而设计控制器实现无人机控制，进一步具体地，首先通过分别对四旋翼无人机吊挂飞行过程中的无人机和吊挂物体分别进行受力分析，从而获得四旋翼无人机吊挂飞行过程的非线性动力学模型：

【技术特征摘要】
1.一种基于能量法的四旋翼无人机吊挂飞行系统控制方法，其特征是，步骤是，基于能量函数方法设计李亚普诺夫方程，进而设计控制器实现无人机控制，进一步具体地，首先通过分别对四旋翼无人机吊挂飞行过程中的无人机和吊挂物体分别进行受力分析，从而获得四旋翼无人机吊挂飞行过程的非线性动力学模型：式(1)中各变量定义如下：mQ和mL分别为四旋翼无人机和负载的质量，L为绳长，G＝(0,0,g)为重力加速度，PQ(t)＝(xQ(t),yQ(t),zQ(t))为四旋翼飞行器在空间中的位置坐标，F(t)＝(Fx(t),Fy(t),Fz(t))为四旋翼无人机提供的总升力,q(t)＝(sinγx(t)cosγy(t),sinγy(t),cosγx(t)cosγy(t))为无人机指向吊挂负载的单位向量，其中γx(t),γy(t)为吊挂负载摆角；针对如式(1)所示系统的控制器设计：F(t)＝fa(t)q(t)+Fb(t)(2)式(2)中，各符号含义如下：式(3)中kQ,kL均为控制增益，kQ>kL且大于零，另外式(4)、(5)中K,KP分别为控制增益矩阵，均为正定对角矩阵，eQ(t)＝PQ(t)-Pd为无人机的位置误差，式(3)中，为对绳长L的自适应估计，其自适应更新率为：其中映射函数proj(.)定义为控制增益矩阵中的Kp与K分别代表控制器的“比例项”与“微分项”对应矩阵；控制增益kQ与kL分别代表飞行器位置、速度误差与负载位置、速度误差在控制策略中所占的比重。2.如权利要求1所述的基于能量法的四旋翼无人机吊挂飞行系统控制方法，其特征是，增加kQ/kL的值会提高对飞行器误差的调节速度与...

【专利技术属性】
技术研发人员：鲜斌，杨森，
申请(专利权)人：天津大学，
类型：发明
国别省市：天津,12