CN111650951A - 一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法 - Google Patents

一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法 Download PDF

Info

Publication number
CN111650951A
CN111650951A CN202010441724.5A CN202010441724A CN111650951A CN 111650951 A CN111650951 A CN 111650951A CN 202010441724 A CN202010441724 A CN 202010441724A CN 111650951 A CN111650951 A CN 111650951A
Authority
CN
China
Prior art keywords
aerial vehicle
unmanned aerial
quad
attitude
rotor unmanned
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
Application number
CN202010441724.5A
Other languages
English (en)
Other versions
CN111650951B (zh
Inventor
赵振华
姜斌
曹东
李春涛
张朋
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nanjing University of Aeronautics and Astronautics
Original Assignee
Nanjing University of Aeronautics and Astronautics
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Nanjing University of Aeronautics and Astronautics filed Critical Nanjing University of Aeronautics and Astronautics
Priority to CN202010441724.5A priority Critical patent/CN111650951B/zh
Publication of CN111650951A publication Critical patent/CN111650951A/zh
Application granted granted Critical
Publication of CN111650951B publication Critical patent/CN111650951B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0808Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
    • G05D1/0816Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
    • G05D1/0825Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10Simultaneous control of position or course in three dimensions
    • G05D1/101Simultaneous control of position or course in three dimensions specially adapted for aircraft

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Algebra (AREA)
  • Mathematical Analysis (AREA)
  • Mathematical Optimization (AREA)
  • Mathematical Physics (AREA)
  • Pure & Applied Mathematics (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法,首先,建立包含位置回路和姿态回路的受扰四旋翼无人机全回路***模型;其次,基于扩张状态观测器技术,分别针对位置和姿态子***设计干扰观测器,对集总干扰进行估计;最后,基于非线性动态逆算法,结合干扰估计信息,构建复合动态逆轨迹跟踪控制器,实现复杂轨迹的高精度跟踪。本发明通过采用扩张状态观测器技术,实现了位置和姿态回路中集总干扰的渐近估计,并将干扰估计信息以前馈的形式对干扰进行补偿,显著提升了控制器的抗干扰性能;本发明相比于传统的动态逆控制方法,具备更好的抗干扰性能,有效地抑制了多源干扰对四旋翼无人机控制性能的影响。

Description

一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制 方法
技术领域
本发明属于飞行控制技术领域,具体涉及一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法。
背景技术
四旋翼无人机是一种能够定高悬停和垂直起降的无人机,由于其结构简单、成本低廉、便于维护以及飞行环境通用性强等优点,已经被广泛应用于航空侦察、灾难救援、编队攻击等领域,具有重要的研究意义和应用前景。四旋翼无人机高精度轨迹跟踪是四旋翼无人机执行复杂任务或编队飞行的重要基础和前提。然而在轨迹跟踪尤其是复杂轨迹的跟踪过程中,四旋翼无人机会受到内部气动参数摄动、未建模摩擦动态、外界阵风干扰以及环境不确定性等多源干扰的影响,这些多源干扰严重影响了轨迹跟踪的精度。因此干扰抑制已成为四旋翼无人机轨迹跟踪控制***设计急需解决的关键问题。
针对受扰四旋翼无人机的轨迹跟踪控制问题,国内外学者给出了多种抗干扰控制策略,包括基于标称模型的非线性特性进行反馈的动态逆控制和依靠自身算法鲁棒性的滑模控制。但是这些方法的干扰抑制策略是基于误差信号被动地消除干扰带来的影响,并且***的抗干扰性能是以牺牲标称性能为代价获取的。因此亟需提出一种能够快速、主动抑制多源干扰影响的四旋翼无人机轨迹跟踪控制方法。
发明内容
发明目的:本发明为了克服上述现有技术的不足,提供了一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法,能够实现位置环和姿态环集总干扰的渐近估计,并将干扰估计信息以前馈的形式对干扰带来的不利影响进行补偿或抵消,以保证四旋翼无人机具备更快速、更强的抗干扰性能。
技术方案:本发明提供一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法,具体包括以下步骤:
(1)构建包含四旋翼无人机位置回路子***和姿态回路子***的受扰四旋翼无人机全回路***模型;
(2)将四旋翼无人机的轨迹跟踪问题转化为位置环跟踪误差和姿态环跟踪误差的镇定问题;
(3)设计四旋翼无人机位置和姿态子***的扩张状态干扰观测器;
(4)针对四旋翼无人机位置子***,通过引入虚拟控制量,设计复合动态逆控制器;
(5)通过代数转换,将位置环的虚拟控制量转化为所需升力指令和四旋翼无人机姿态环的姿态指令;
(6)针对四旋翼无人机姿态子***,设计复合动态逆控制器,获得三个轴向所需力矩的大小,实现复杂轨迹的高精度跟踪。
进一步地,所述步骤(1)包括以下步骤:
(11)构建受扰四旋翼无人机的位置子***模型:
Figure BDA0002504414570000021
其中,x,y,z表示四旋翼无人机的位置,X轴正向定义为沿当地经线的切向方向,指向正北方;Y轴正向定义为沿当地纬线切向方向,指向正东方;Z轴正向定义为垂直于当地水平面,根据右手定则指向地心方向,Dx,Dy,Dz表示三个轴向的集总干扰,x表示四旋翼无人机x轴向位移,
Figure BDA0002504414570000022
表示x轴向速度;y表示四旋翼无人机y轴向位移,
Figure BDA0002504414570000023
表示y轴向速度;z表示四旋翼无人机z轴向位移,
Figure BDA0002504414570000024
表示z轴向速度;φ,θ,ψ表示四旋翼无人机的姿态,φ表示四旋翼无人机的滚转角,θ表示四旋翼无人机的俯仰角,ψ表示四旋翼无人机的偏航角; m表示四旋翼无人机的质量,g表示重力加速度,UP表示四旋翼无人机产生的总的升力,kd表示速度阻尼系数;
(12)构建受扰四旋翼无人机姿态子***模型:
Figure BDA0002504414570000031
Figure BDA0002504414570000032
其中,wx,wy和wz表示绕x,y和z轴的旋转角速度;Jx,Jy和Jz表示绕x,y和z轴的转动惯量;τx,τy和τz表示作用在x,y和z轴的力矩;
DAx,DAy,DAz表示三个轴向的集总干扰;为了简化书写,引出如下定义:
Figure BDA0002504414570000033
其中,sin x=sx,cos x=cx,tan x=tx;则可将四旋翼无人机姿态子***的动态重写为如下形式:
Figure BDA0002504414570000034
根据姿态动态方程可以得到姿态角二阶动态:
Figure BDA0002504414570000035
其中,
Figure BDA0002504414570000036
表示W对时间的导数,
Figure BDA0002504414570000037
Figure BDA0002504414570000038
分别表示Θ的一阶和二阶导数。
进一步地,所述步骤(2)的实现过程如下:
定义位置跟踪误差为:ex=x-xd,ey=y-yd,ez=z-zd,其中xd,yd,zd为轨迹参考信号,考虑外风等环境干扰,可得位置跟踪误差子***:
Figure BDA0002504414570000041
定义姿态跟踪误差方程:
Figure BDA0002504414570000042
其中,Θd=[φd θd ψd]T为期望姿态角,则可得姿态***跟踪误差动态:
Figure BDA0002504414570000043
则可得到姿态角跟踪误差***动态:
Figure BDA0002504414570000044
其中,DLA∈R3为姿态跟踪误差***中的集总干扰,其表达式为:
Figure BDA0002504414570000045
进一步地,所述步骤(3)具体包括以下步骤:
(31)对于四旋翼无人机的位置子***设计扩张状态观测器,通过引入虚拟控制量axu,ayu和azu实现三个位置通道集总干扰的渐近估计:
Figure BDA0002504414570000046
则X、Y和Z轴向扩张状态观测器可分别设计为:
Figure BDA0002504414570000051
Figure BDA0002504414570000052
其中,lx1、lx2、ly1、ly2、lz1、lz2、为观测器参数,且均为正常数,
Figure BDA0002504414570000053
分别表示位置三轴集总干扰的估计值;
(32)针对姿态跟踪误差子***设计扩张状态观测器以实现姿态角跟踪误差变化率和集总干扰的渐近估计:
Figure BDA0002504414570000054
其中,LA1,LA2,LA3为观测器增益,且均为三维正对角矩阵,
Figure BDA0002504414570000055
Figure BDA0002504414570000056
分别为
Figure BDA0002504414570000057
和DLA的估计值。
进一步地,所述步骤(4)的实现过程如下:
通过引入虚拟控制量,针对位置子***,设计复合动态逆控制器如下:
Figure BDA0002504414570000058
其中,KXP、KXD、KYP、KYD、KZP、KZD为控制器参数,且均为正常数。
进一步地,所述步骤(5)的实现过程如下:
Figure BDA0002504414570000061
进一步地,所述步骤(6)的实现过程如下:
Figure BDA0002504414570000062
其中,
Figure BDA0002504414570000063
为控制器参数,且均为正对角矩阵。
有益效果:与现有技术相比,本发明的有益效果:1、充分利用***非线性特性,在反馈通道将标称非线性以反馈的形式抵消,减小了基于误差反馈的调节压力,显著降低了控制器参数调节难度;2、结合干扰估计信息和动态逆算法构造复合动态逆控制器,对多源干扰进行实时动态地前馈补偿,显著提高了***的抗干扰性能和鲁棒性;3、本发明显著提高了四旋翼无人机对复杂轨迹的跟踪精度,所提方法可推广应用于其他飞行器的高精度控制中,具有广阔的应用前景。
附图说明
图1为本发明采用的全回路复合动态逆轨迹跟踪控制方法框图;
图2为基准动态逆控制器(BNDIC)和所提复合动态逆控制器(CNDIC)作用下的四旋翼无人机跟踪空间三维圆柱轨迹的效果图;
图3为基准动态逆控制器(BNDIC)和所提复合动态逆控制器(CNDIC)作用下的四旋翼无人机三通道位置响应曲线图;
图4为基准动态逆控制器(BNDIC)和所提复合动态逆控制器(CNDIC)作用下的四旋翼无人机三通道位置跟踪误差曲线图;
图5是基准动态逆控制器(BNDIC)和所提复合动态逆控制器(CNDIC)作用下的四旋翼无人机控制输入响应曲线图。
具体实施方式
下面结合附图对本发明作进一步详细描述。
图1为本发明采用的复合动态逆全回路轨迹跟踪控制结构框图。本发明提供一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法,具体步骤如下:
步骤1:构建包含四旋翼无人机位置回路子***和姿态回路子***的受扰四旋翼无人机全回路***模型。
受扰四旋翼无人机的位置子***模型描述如公式(1)所示:
Figure BDA0002504414570000071
其中x,y,z表示四旋翼无人机的位置,X轴正向定义为沿当地经线的切向方向,指向正北方;Y轴正向定义为沿当地纬线切向方向,指向正东方;Z轴正向定义为垂直于当地水平面,根据右手定则指向地心方向。Dx,Dy,Dz表示三个轴向的集总干扰,x表示四旋翼无人机x轴向位移,
Figure BDA0002504414570000072
表示x轴向速度;y表示四旋翼无人机y轴向位移,
Figure BDA0002504414570000073
表示y轴向速度;z表示四旋翼无人机z轴向位移,
Figure BDA0002504414570000074
表示z轴向速度;φ,θ,ψ表示四旋翼无人机的姿态,φ表示四旋翼无人机的滚转角,θ表示四旋翼无人机的俯仰角,ψ表示四旋翼无人机的偏航角; m表示四旋翼无人机的质量,g表示重力加速度,UP表示四旋翼无人机产生的总的升力,kd表示速度阻尼系数。
受扰四旋翼无人机姿态子***模型描述如公式(2)(3)所示:
Figure BDA0002504414570000075
Figure BDA0002504414570000081
其中,wx,wy和wz表示绕x,y和z轴的旋转角速度;Jx,Jy和Jz表示绕x,y和z轴的转动惯量;τx,τy和τz表示作用在x,y和z轴的力矩;
DAx,DAy,DAz表示三个轴向的集总干扰。为了简化书写,引出如下定义:
Figure BDA0002504414570000082
其中,sin x=sx,cos x=cx,tan x=tx。则可将四旋翼无人机姿态子***的动态重写为如下形式:
Figure BDA0002504414570000083
根据姿态动态方程可以得到姿态角二阶动态:
Figure BDA0002504414570000084
其中,
Figure BDA0002504414570000085
表示W对时间的导数,
Figure BDA0002504414570000086
Figure BDA0002504414570000087
分别表示Θ的一阶和二阶导数。
由于旋翼无人机位置回路的轨迹跟踪是通过改变姿态角来实现的,因此将姿态回路的控制目标设定为跟踪虚拟的姿态角指令。
步骤2:四旋翼无人机的轨迹跟踪问题转化为位置环跟踪误差和姿态环跟踪误差的镇定问题。
定义位置跟踪误差为:ex=x-xd,ey=y-yd,ez=z-zd,其中xd,yd,zd为轨迹参考信号。考虑外风等环境干扰,可得位置跟踪误差子***:
Figure BDA0002504414570000091
定义姿态跟踪误差方程:
Figure BDA0002504414570000092
其中,Θd=[φd θd ψd]T为期望姿态角,则可得姿态***跟踪误差动态:
Figure BDA0002504414570000093
则可得到姿态角跟踪误差***动态:
Figure BDA0002504414570000094
其中,DLA∈R3为姿态跟踪误差***中的集总干扰,其表达式为:
Figure BDA0002504414570000095
步骤3:设计四旋翼无人机位置和姿态子***的扩张状态干扰观测器。
对于四旋翼无人机的位置子***(1)设计扩张状态观测器,以实现三个位置通道集总干扰的渐近估计。其设计的具体步骤包括:
对四旋翼无人机的位置子***(1)分析,为了便于控制器设计,引入如下虚拟控制量:
Figure BDA0002504414570000096
则X、Y和Z轴向扩张状态观测器可分别设计为:
Figure BDA0002504414570000101
Figure BDA0002504414570000102
其中,lx1、lx2、ly1、ly2、lz1、lz2、为观测器参数,且均为正常数;
Figure BDA0002504414570000103
分别表示位置三轴集总干扰的估计值。
由于虚拟姿态角指令的变化率无法直接获得,因此姿态角跟踪误差的变化率不可直接获得,需要对其进行估计。以下针对姿态跟踪误差子***(7)设计扩张状态观测器以实现姿态角跟踪误差变化率和集总干扰的渐近估计:
Figure BDA0002504414570000104
其中,LA1,LA2,LA3为观测器增益,且均为三维正对角矩阵,
Figure BDA0002504414570000105
Figure BDA0002504414570000106
分别为
Figure BDA0002504414570000107
和DLA的估计值。
步骤4:针对四旋翼无人机位置子***,通过引入虚拟控制量,设计复合动态逆控制器。
通过引入虚拟控制量,针对位置子***,设计如下复合动态逆控制器:
Figure BDA0002504414570000111
其中,KXP、KXD、KYP、KYD、KZP、KZD为控制器参数,且它们均为正常数。
步骤5:通过代数转换,将位置环的虚拟控制量转化为所需升力指令和四旋翼无人机姿态环的姿态指令。
Figure BDA0002504414570000112
步骤6:针对四旋翼无人机姿态子***,设计复合动态逆控制器,获得三个轴向所需力矩的大小。
利用姿态环集总干扰估计信息和姿态角跟踪误差变化率估计信息,构建复合动态逆控制器:
Figure BDA0002504414570000113
其中,
Figure BDA0002504414570000114
为控制器参数,且均为正对角矩阵。
为了验证本发明优越的抗干扰能性能,在充分考虑外部干扰存在的情况下基于MATLAB仿真环境对本发明算法和传统非线性动态逆算法进行四旋翼无人机仿真对比验证。仿真过程初始值设置为:
x(0)=0,y(0)=0,z(0)=0
Figure BDA0002504414570000115
φ(0)=0,θ(0)=0,ψ(0)=0
wx(0)=0,wy(0)=0,wz(0)=0
位置期望指令和航向角期望值零设置为:
xc(t)=0.5sin(0.5t),yc(t)=0.5cos(0.5t),
zc(t)=-2-0.1t,ψc(t)=cos(0.5t)
仿真过程中外界干扰设置为:
Dx=-2,Dy=2.3,Dz=1.6,
DAx=-0.2(1+0.3sin0.2πt),
DAy=0.13(1+0.4sin0.2πt),
DAz=-0.12(1+0.2sin0.2πt)
所提复合非线性动态逆控制器(Composite Nonlinear Dynamic InverseController,CNDIC)的形式及控制器参数已经在设计样例中给出。用作比较的基准非线性动态逆控制器(Baseline Nonlinear Dynamic Inverse Controller,BNDIC)的形式及控制参数设计如下:
Figure 2
Figure BDA0002504414570000122
本发明提供的一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法,实现了四旋翼无人机的圆柱形复杂轨迹的高精度跟踪控制,为进行对比分别采用基于全回路复合动态逆控制和经典的动态逆控制。图2至图4分别是基准动态逆控制器(BNDIC)和所提复合动态逆控制器(CNDIC)作用下受扰四旋翼无人机跟踪空间三维圆柱轨迹的效果图、三通道位置响应曲线图及三通道位置跟踪误差曲线图,可以看出所提出的全回路复合动态逆控制方法抗干扰性能明显优于传统动态逆控制方法。图5给出了基准动态逆控制器(BNDIC)和所提复合动态逆控制器(CNDIC)作用下四旋翼无人机控制输入响应曲线图,可以看出控制输入在特定限幅范围内。
综上所述,本发明可以保证四旋翼无人机具有更高的轨迹跟踪精度和更强的抗干扰性能。

Claims (7)

1.一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法,其特征在于,包括以下步骤:
(1)构建包含四旋翼无人机位置回路子***和姿态回路子***的受扰四旋翼无人机全回路***模型;
(2)将四旋翼无人机的轨迹跟踪问题转化为位置环跟踪误差和姿态环跟踪误差的镇定问题;
(3)设计四旋翼无人机位置和姿态子***的扩张状态干扰观测器;
(4)针对四旋翼无人机位置子***,通过引入虚拟控制量,设计复合动态逆控制器;
(5)通过代数转换,将位置环的虚拟控制量转化为所需升力指令和四旋翼无人机姿态环的姿态指令;
(6)针对四旋翼无人机姿态子***,设计复合动态逆控制器,获得三个轴向所需力矩的大小,实现复杂轨迹的高精度跟踪。
2.根据权利要求1所述的一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法,其特征在于,所述步骤(1)包括以下步骤:
(11)构建受扰四旋翼无人机的位置子***模型:
Figure FDA0002504414560000011
其中,x,y,z表示四旋翼无人机的位置,X轴正向定义为沿当地经线的切向方向,指向正北方;Y轴正向定义为沿当地纬线切向方向,指向正东方;Z轴正向定义为垂直于当地水平面,根据右手定则指向地心方向,Dx,Dy,Dz表示三个轴向的集总干扰,x表示四旋翼无人机x轴向位移,
Figure FDA0002504414560000012
表示x轴向速度;y表示四旋翼无人机y轴向位移,
Figure FDA0002504414560000013
表示y轴向速度;z表示四旋翼无人机z轴向位移,
Figure FDA0002504414560000014
表示z轴向速度;φ,θ,ψ表示四旋翼无人机的姿态,φ表示四旋翼无人机的滚转角,θ表示四旋翼无人机的俯仰角,ψ表示四旋翼无人机的偏航角;m表示四旋翼无人机的质量,g表示重力加速度,UP表示四旋翼无人机产生的总的升力,kd表示速度阻尼系数;
(12)构建受扰四旋翼无人机姿态子***模型:
Figure FDA0002504414560000021
Figure FDA0002504414560000022
其中,wx,wy和wz表示绕x,y和z轴的旋转角速度;Jx,Jy和Jz表示绕x,y和z轴的转动惯量;τx,τy和τz表示作用在x,y和z轴的力矩;DAx,DAy,DAz表示三个轴向的集总干扰;为了简化书写,引出如下定义:
Figure FDA0002504414560000023
其中,sin x=sx,cos x=cx,tan x=tx;则可将四旋翼无人机姿态子***的动态重写为如下形式:
Figure FDA0002504414560000024
根据姿态动态方程可以得到姿态角二阶动态:
Figure FDA0002504414560000025
其中,
Figure FDA0002504414560000026
表示W对时间的导数,
Figure FDA0002504414560000027
Figure FDA0002504414560000028
分别表示Θ的一阶和二阶导数。
3.根据权利要求1所述的一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法,其特征在于,所述步骤(2)的实现过程如下:
定义位置跟踪误差为:ex=x-xd,ey=y-yd,ez=z-zd,其中xd,yd,zd为轨迹参考信号,考虑外风等环境干扰,可得位置跟踪误差子***:
Figure FDA0002504414560000031
定义姿态跟踪误差方程:
Figure FDA0002504414560000032
其中,Θd=[φd θd ψd]T为期望姿态角,则可得姿态***跟踪误差动态:
Figure FDA0002504414560000033
则可得到姿态角跟踪误差***动态:
Figure FDA0002504414560000034
其中,DLA∈R3为姿态跟踪误差***中的集总干扰,其表达式为:
Figure FDA0002504414560000035
4.权利要求1所述的一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法,其特征在于,所述步骤(3)具体包括以下步骤:
(31)对于四旋翼无人机的位置子***设计扩张状态观测器,通过引入虚拟控制量axu,ayu和azu实现三个位置通道集总干扰的渐近估计:
Figure FDA0002504414560000036
则X、Y和Z轴向扩张状态观测器可分别设计为:
Figure FDA0002504414560000041
其中,lx1、lx2、ly1、ly2、lz1、lz2、为观测器参数,且均为正常数,
Figure FDA0002504414560000042
分别表示位置三轴集总干扰的估计值;
(32)针对姿态跟踪误差子***设计扩张状态观测器以实现姿态角跟踪误差变化率和集总干扰的渐近估计:
Figure FDA0002504414560000043
其中,LA1,LA2,LA3为观测器增益,且均为三维正对角矩阵,
Figure FDA0002504414560000044
Figure FDA0002504414560000045
分别为
Figure FDA0002504414560000046
和DLA的估计值。
5.权利要求1所述的一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法,其特征在于,所述步骤(4)的实现过程如下:
通过引入虚拟控制量,针对位置子***,设计复合动态逆控制器如下:
其中,KXP、KXD、KYP、KYD、KZP、KZD为控制器参数,且均为正常数。
6.如权利要求5所述的一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法,其特征在于,所述步骤(5)的实现过程如下:
Figure FDA0002504414560000051
7.根据权利要求1所述的一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法,其特征在于,所述步骤(6)的实现过程如下:
Figure FDA0002504414560000052
其中,
Figure FDA0002504414560000053
为控制器参数,且均为正对角矩阵。
CN202010441724.5A 2020-05-22 2020-05-22 一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法 Active CN111650951B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010441724.5A CN111650951B (zh) 2020-05-22 2020-05-22 一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010441724.5A CN111650951B (zh) 2020-05-22 2020-05-22 一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法

Publications (2)

Publication Number Publication Date
CN111650951A true CN111650951A (zh) 2020-09-11
CN111650951B CN111650951B (zh) 2021-09-17

Family

ID=72352712

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010441724.5A Active CN111650951B (zh) 2020-05-22 2020-05-22 一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法

Country Status (1)

Country Link
CN (1) CN111650951B (zh)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112462796A (zh) * 2020-11-28 2021-03-09 中国人民解放军海军航空大学青岛校区 一种刚体飞行器姿态角稳定的自适应反演控制***及方法
CN112462798A (zh) * 2020-12-04 2021-03-09 三生万物(北京)人工智能技术有限公司 一种无人机及提高无人机航线飞行性能的方法
CN113110554A (zh) * 2021-04-30 2021-07-13 南京航空航天大学 一种四旋翼无人机复合连续快速终端滑模姿态控制方法
CN114578837A (zh) * 2022-02-18 2022-06-03 南京航空航天大学 一种考虑执行器故障的无人直升机主动容错抗干扰轨迹跟踪控制方法

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103092213A (zh) * 2013-01-21 2013-05-08 南京航空航天大学 六旋翼飞行器的轨迹跟踪控制方法
CN105739513A (zh) * 2016-02-05 2016-07-06 北京航空航天大学 一种四旋翼飞行机器人非线性轨迹跟踪控制器及其跟踪控制方法
CN109597426A (zh) * 2018-11-13 2019-04-09 上海无线电设备研究所 基于l1自适应控制的四旋翼直升机轨迹跟踪控制方法
CN110825122A (zh) * 2019-10-08 2020-02-21 南京航空航天大学 一种四旋翼无人机圆形轨迹主动抗干扰跟踪控制方法
CN110850887A (zh) * 2019-10-10 2020-02-28 南京航空航天大学 一种四旋翼无人机复合动态逆抗干扰姿态控制方法
CN111007877A (zh) * 2019-11-20 2020-04-14 江苏信息职业技术学院 一种四旋翼飞行器的全局鲁棒自适应轨迹跟踪控制方法
CN111026160A (zh) * 2019-12-26 2020-04-17 华中科技大学 一种四旋翼无人机轨迹跟踪控制方法
CN111123967A (zh) * 2020-01-02 2020-05-08 南京航空航天大学 一种基于自适应动态逆的固定翼无人机着舰控制方法

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103092213A (zh) * 2013-01-21 2013-05-08 南京航空航天大学 六旋翼飞行器的轨迹跟踪控制方法
CN105739513A (zh) * 2016-02-05 2016-07-06 北京航空航天大学 一种四旋翼飞行机器人非线性轨迹跟踪控制器及其跟踪控制方法
CN109597426A (zh) * 2018-11-13 2019-04-09 上海无线电设备研究所 基于l1自适应控制的四旋翼直升机轨迹跟踪控制方法
CN110825122A (zh) * 2019-10-08 2020-02-21 南京航空航天大学 一种四旋翼无人机圆形轨迹主动抗干扰跟踪控制方法
CN110850887A (zh) * 2019-10-10 2020-02-28 南京航空航天大学 一种四旋翼无人机复合动态逆抗干扰姿态控制方法
CN111007877A (zh) * 2019-11-20 2020-04-14 江苏信息职业技术学院 一种四旋翼飞行器的全局鲁棒自适应轨迹跟踪控制方法
CN111026160A (zh) * 2019-12-26 2020-04-17 华中科技大学 一种四旋翼无人机轨迹跟踪控制方法
CN111123967A (zh) * 2020-01-02 2020-05-08 南京航空航天大学 一种基于自适应动态逆的固定翼无人机着舰控制方法

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112462796A (zh) * 2020-11-28 2021-03-09 中国人民解放军海军航空大学青岛校区 一种刚体飞行器姿态角稳定的自适应反演控制***及方法
CN112462798A (zh) * 2020-12-04 2021-03-09 三生万物(北京)人工智能技术有限公司 一种无人机及提高无人机航线飞行性能的方法
CN113110554A (zh) * 2021-04-30 2021-07-13 南京航空航天大学 一种四旋翼无人机复合连续快速终端滑模姿态控制方法
CN114578837A (zh) * 2022-02-18 2022-06-03 南京航空航天大学 一种考虑执行器故障的无人直升机主动容错抗干扰轨迹跟踪控制方法

Also Published As

Publication number Publication date
CN111650951B (zh) 2021-09-17

Similar Documents

Publication Publication Date Title
CN111650951B (zh) 一种四旋翼无人机复杂轨迹的全回路复合动态逆跟踪控制方法
CN109991991B (zh) 一种无人直升机鲁棒容错跟踪方法
CN111766899A (zh) 一种基于干扰观测器的四旋翼无人机集群抗干扰编队控制方法
CN110850887B (zh) 一种四旋翼无人机复合动态逆抗干扰姿态控制方法
CN109765918B (zh) 一种无人直升机鲁棒自适应补偿控制方法
CN106325291B (zh) 基于滑模控制律和eso的四旋翼飞行器姿态控制方法及***
CN109062042B (zh) 一种旋翼飞行器的有限时间航迹跟踪控制方法
CN110825122B (zh) 一种四旋翼无人机圆形轨迹主动抗干扰跟踪控制方法
CN112346470A (zh) 一种基于改进自抗扰控制的四旋翼姿态控制方法
CN110320925B (zh) 基于高阶干扰观测器的四旋翼飞行器安全控制方法
CN112015192B (zh) 一种自愈四旋翼无人机抗干扰控制方法与***
CN109885074B (zh) 四旋翼无人机有限时间收敛姿态控制方法
CN112684805B (zh) 一种考虑姿态约束的高机动微型无人机控制方法
CN110377044B (zh) 一种无人直升机的有限时间高度和姿态跟踪控制方法
CN111650952B (zh) 一种基于双干扰观测器四旋翼无人机分层抗干扰方法
CN112666960B (zh) 一种基于l1增广自适应的旋翼飞行器控制方法
CN110275542B (zh) 一种基于自适应有限时间控制的四旋翼飞行器控制方法
CN113156995A (zh) 一种执行器故障下的无人直升机姿态控制方法
CN115366109A (zh) 一种旋翼飞行机械臂复合分层抗干扰方法
CN109976364B (zh) 一种六旋翼飞行器姿态解耦控制方法
CN115202213A (zh) 一种基于自抗扰控制的四旋翼飞行器控制方法
CN107678442B (zh) 一种基于双模型下的四旋翼自主着船控制方法
CN108459611B (zh) 一种近空间飞行器的姿态跟踪控制方法
CN117289598B (zh) 一种飞行器的反步滑模控制方法及***
CN111857171B (zh) 一种基于质量自适应多层神经网络的无人机控制方法

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