一种四旋翼无人机的鲁棒跟踪控制方法及系统技术方案

技术编号:25707364 阅读:46 留言:0更新日期:2020-09-23 02:54
本发明专利技术公开了一种四旋翼无人机的鲁棒跟踪控制方法及系统,属于无人机控制领域。针对现有技术中存在的无人机系统的时变扰动问题,本发明专利技术提出了一种四旋翼无人机的鲁棒跟踪控制方法及系统,控制方法包括:根据四旋翼无人机的动力学和运动学模型,得到四旋翼无人机的状态空间模型;根据四旋翼无人机的状态空间模型,构建四旋翼无人机控制系统的广义比例积分观测器;将广义比例积分观测器与反步控制相结合,构建复合控制器;通过复合控制器对四旋翼无人机进行控制。本发明专利技术将反步控制与广义比例积分观测器相结合,利用广义比例积分观测器估测集总时变扰动,将估测值应用于前馈控制,有效提高了系统的抗干扰能力,并且易于实现。

【技术实现步骤摘要】
一种四旋翼无人机的鲁棒跟踪控制方法及系统
本专利技术涉及无人机控制领域,更具体地说,涉及一种四旋翼无人机的鲁棒跟踪控制方法及系统。
技术介绍
随着无人机技术的发展,四旋翼无人机引起了很多人的注意,与传统固定翼相比,四旋翼无人机有许多显著的优点。首先它的机械结构简单、控制灵活,其次它具有垂直起落的能力,使用四旋翼无人机能替代人去完成危险任务,这些优点使得四旋翼无人机在军事和民用领域得到广泛应用。在这些复杂的任务中,四旋翼无人机的性能主要依赖于飞行控制器。因此,研究人员在无人机的飞行控制器设计上付出了很多努力。文献中也记录了各种各样的控制方法。其中,PID(proportionintegrationdifferentiation)控制方法凭借其易于实现的特点的到最广泛的应用。但是,因为PID的线性特性,它的控制精度受到限制,难以满足越来越高的需求。由于新一代的硬件提供了更高的计算能力,许多非线性控制方法得到实现,例如:滑模控制器、反步控制器和线性二次控制器。后来,为了达到鲁棒控制,控制器中逐渐引入了现代控制理论,例如李雅普诺夫函数设计。这些本文档来自技高网...

【技术保护点】
1.一种四旋翼无人机的鲁棒跟踪控制方法,其特征在于,包括以下步骤:/n步骤1、根据四旋翼无人机的动力学和运动学模型,得到四旋翼无人机的状态空间模型;/n步骤2、根据四旋翼无人机的状态空间模型,构建四旋翼无人机控制系统的广义比例积分观测器;/n步骤3、将广义比例积分观测器与反步控制相结合,构建复合控制器;/n步骤4、通过复合控制器对四旋翼无人机进行控制。/n

【技术特征摘要】
1.一种四旋翼无人机的鲁棒跟踪控制方法,其特征在于,包括以下步骤:
步骤1、根据四旋翼无人机的动力学和运动学模型,得到四旋翼无人机的状态空间模型;
步骤2、根据四旋翼无人机的状态空间模型,构建四旋翼无人机控制系统的广义比例积分观测器;
步骤3、将广义比例积分观测器与反步控制相结合,构建复合控制器;
步骤4、通过复合控制器对四旋翼无人机进行控制。


2.根据权利要求1所述的四旋翼无人机的鲁棒跟踪控制方法,其特征在于,步骤1中建立四旋翼无人机的动力学和运动学模型,包括以下步骤:
步骤1.1、建立动力学模型:



其中m是四旋翼无人机的质量,T是主推动力,τ是转动力矩,J是机体的惯量矩阵,v和ω分别是机体的速度和角速度,和分别是机体加速度和角加速度向量,;



其中r=[x,y,z]T和分别表示四旋翼无人机在地面坐标系下的位置向量和速度向量,g是重力加速度,e3[0,0,1]T是地面坐标系中的一个单位向量,dT=[d4,d5,d6]表示位置环的复合扰动,Rq是机体坐标到地面坐标系的变换矩阵;
步骤1.2、建立运动学模型为:



其中是欧拉角向量,是角速度向量,τ=[τ1,τ2,τ3]是转动力矩,dτ=[d1,d2,d3]是姿态环的复合扰动,Tq是变换矩阵,ψ,θ,分别表示偏航角、俯仰角、翻滚角。
步骤1.3、定义四旋翼无人机状态空间的状态变量:



步骤1.4、根据动力学与运动学模型,建立四旋翼无人机的状态空间模型:









其中Ux=-sinx3,Uy=sinx1cosx3,Jx,Jy,Jz是四旋翼无人机在各个轴上的惯量,U1、U2、U3和U4为系统的输入。


3.根据权利要求2所述的四旋翼无人机的鲁棒跟踪控制方法,其特征在于,步骤2中建立四旋翼无人机控制系统的广义比例积分观测器,具体包括以下步骤:
步骤2.1、使用泰勒多项式估计复合扰动:



步骤2.2、根据四旋翼无人机的状态空间模型,建立广义比例积分观测器:



其中w1、w2、w3和w4是x1、x2、d1和的估计值,定义w3为ρ1、ρ2、ρ3和ρ4是观测增益,可以通过配置观测器极点获得;
根据步骤2.1和步骤2.2中计算d1估计值的方式,可计算得到d2、d3、d4、d5和d6的估计值,分别定义为和


4.根据权利要求1或3所述的四旋翼无人机...

【专利技术属性】
技术研发人员:孙振兴仇家鑫费杨张兴华
申请(专利权)人:南京工业大学
类型:发明
国别省市:江苏;32

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1