【技术实现步骤摘要】
一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法
本专利技术属于飞行控制
,具体涉及一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法。
技术介绍
四旋翼无人机是一种能够定高悬停和垂直起降的无人机,由于其结构简单、成本低廉、便于维护以及飞行环境通用性强等优点,已经被广泛应用于航空侦察、灾难救援、编队攻击等领域,具有重要的研究意义和应用前景。四旋翼无人机高精度轨迹跟踪是四旋翼无人机执行复杂任务或编队飞行的重要基础和前提。然而在轨迹跟踪尤其是复杂轨迹的跟踪过程中,四旋翼无人机会受到内部气动参数摄动、未建模摩擦动态、外界阵风干扰以及环境不确定性等多源干扰的影响,这些多源干扰严重影响了轨迹跟踪的精度。因此干扰抑制已成为四旋翼无人机轨迹跟踪控制系统设计急需解决的关键问题。针对受扰四旋翼无人机的轨迹跟踪控制问题,国内外学者给出了多种抗干扰控制策略,包括基于标称模型的非线性特性进行反馈的动态逆控制和依靠自身算法鲁棒性的滑模控制。但是这些方法的干扰抑制策略是基于误差信号被动地消除干扰带来的影响,并且系统的抗干扰性能是以牺牲标称性能为代价获取的。因此亟需提出一种能够快速、主动抑制多源干扰影响的四旋翼无人机轨迹跟踪控制方法。
技术实现思路
专利技术目的:本专利技术为了克服上述现有技术的不足,提供了一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法,能够实现位置环和姿态环集总干扰的渐近估计,并将干扰估计信息以前馈的形式对干扰带来的不利影响进行补偿或抵消,以保证四旋翼无人机具备更快速、 ...
【技术保护点】
1.一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法,其特征在于,包括以下步骤:/n(1)构建包含四旋翼无人机位置回路子系统和姿态回路子系统的受扰四旋翼无人机全回路系统模型;/n(2)将四旋翼无人机的轨迹跟踪问题转化为位置环跟踪误差和姿态环跟踪误差的镇定问题;/n(3)设计四旋翼无人机位置和姿态子系统的扩张状态干扰观测器;/n(4)针对四旋翼无人机位置子系统,通过引入虚拟控制量,设计复合动态逆控制器;/n(5)通过代数转换,将位置环的虚拟控制量转化为所需升力指令和四旋翼无人机姿态环的姿态指令;/n(6)针对四旋翼无人机姿态子系统,设计复合动态逆控制器,获得三个轴向所需力矩的大小,实现复杂轨迹的高精度跟踪。/n
【技术特征摘要】
1.一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法,其特征在于,包括以下步骤:
(1)构建包含四旋翼无人机位置回路子系统和姿态回路子系统的受扰四旋翼无人机全回路系统模型;
(2)将四旋翼无人机的轨迹跟踪问题转化为位置环跟踪误差和姿态环跟踪误差的镇定问题;
(3)设计四旋翼无人机位置和姿态子系统的扩张状态干扰观测器;
(4)针对四旋翼无人机位置子系统,通过引入虚拟控制量,设计复合动态逆控制器;
(5)通过代数转换,将位置环的虚拟控制量转化为所需升力指令和四旋翼无人机姿态环的姿态指令;
(6)针对四旋翼无人机姿态子系统,设计复合动态逆控制器,获得三个轴向所需力矩的大小,实现复杂轨迹的高精度跟踪。
2.根据权利要求1所述的一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法,其特征在于,所述步骤(1)包括以下步骤:
(11)构建受扰四旋翼无人机的位置子系统模型:
其中,x,y,z表示四旋翼无人机的位置,X轴正向定义为沿当地经线的切向方向,指向正北方;Y轴正向定义为沿当地纬线切向方向,指向正东方;Z轴正向定义为垂直于当地水平面,根据右手定则指向地心方向,Dx,Dy,Dz表示三个轴向的集总干扰,x表示四旋翼无人机x轴向位移,表示x轴向速度;y表示四旋翼无人机y轴向位移,表示y轴向速度;z表示四旋翼无人机z轴向位移,表示z轴向速度;φ,θ,ψ表示四旋翼无人机的姿态,φ表示四旋翼无人机的滚转角,θ表示四旋翼无人机的俯仰角,ψ表示四旋翼无人机的偏航角;m表示四旋翼无人机的质量,g表示重力加速度,UP表示四旋翼无人机产生的总的升力,kd表示速度阻尼系数;
(12)构建受扰四旋翼无人机姿态子系统模型:
其中,wx,wy和wz表示绕x,y和z轴的旋转角速度;Jx,Jy和Jz表示绕x,y和z轴的转动惯量;τx,τy和τz表示作用在x,y和z轴的力矩;DAx,DAy,DAz表示三个轴向的集总干扰;为了简化书写,引出如下定义:
其中,sinx=sx,cosx=cx,tanx=tx;则可将四旋翼无人机姿态子系统的动态重写为如下形式:
根据姿态动态方程可以得到姿态角二阶动态:
其中,表示W对时间的导数,和分别表示Θ的一阶和二阶导数...
【专利技术属性】
技术研发人员:赵振华,姜斌,曹东,李春涛,张朋,
申请(专利权)人:南京航空航天大学,
类型:发明
国别省市:江苏;32
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。