CN104932512B - 一种基于mimo非线性不确定反步法的四旋翼位姿控制方法 - Google Patents

一种基于mimo非线性不确定反步法的四旋翼位姿控制方法 Download PDF

Info

Publication number
CN104932512B
CN104932512B CN201510355319.0A CN201510355319A CN104932512B CN 104932512 B CN104932512 B CN 104932512B CN 201510355319 A CN201510355319 A CN 201510355319A CN 104932512 B CN104932512 B CN 104932512B
Authority
CN
China
Prior art keywords
quadrotor
centerdot
control
robust compensation
contragradience
Prior art date
Application number
CN201510355319.0A
Other languages
English (en)
Other versions
CN104932512A (zh
Inventor
孙长银
潘汛
余瑶
张兰
郭金
胡艳艳
Original Assignee
北京科技大学
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 北京科技大学 filed Critical 北京科技大学
Priority to CN201510355319.0A priority Critical patent/CN104932512B/zh
Publication of CN104932512A publication Critical patent/CN104932512A/zh
Application granted granted Critical
Publication of CN104932512B publication Critical patent/CN104932512B/zh

Links

Abstract

本发明提供一种基于MIMO非线性不确定反步法的四旋翼位姿控制方法,有助于提高四旋翼飞行器的飞行安全性和控制性能。所述方法包括:基于空气动力学和旋翼飞行器运动原理,并根据控制性能要求建立四旋翼飞行器数学模型;根据所述四旋翼飞行器数学模型和精度要求,建立四旋翼飞行器模型;根据所述四旋翼飞行器数学模型和四旋翼飞行器模型的不确定性、外界干扰、欠驱动、强耦合特性,对所述四旋翼飞行器模型进行分析解耦,确定基于内外环控制的反步鲁棒补偿控制器。本发明适用于自动化控制技术领域。

Description

一种基于MI MO非线性不确定反步法的四旋翼位姿控制方法
技术领域
[000Ί] 本发明涉及自动化控制技术领域,特别是指一种基于MIMO非线性不确定反步法的 四旋翼位姿控制方法。
背景技术
[0002] 固定翼飞行器载重能力强,飞行速度快,适合长航时的大面积巡航任务,旋翼飞行 器可执行垂直起降,前后侧飞,悬停等高难度任务,具有机动能力强,位姿跟踪能力出色等 特点。正是由于在工作方式上具有优势互补的特点,在特定的应用环境中,旋翼飞行器可以 完成许多固定翼飞行器难以完成的任务,如地面目标跟踪,电力巡线、环境勘测等,具有重 大的实用价值。因此,对旋翼飞行器进行深入的研究是很有必要的。
[0003] 四旋翼飞行器是除了传统直升机外,旋翼类飞行器的又一典型代表,直升机的机 械结构包括主桨和尾桨,尾桨用于抵消主桨旋转产生的附加力矩,控制较复杂,四旋翼利用 分布在机体周围的四个旋翼提供升力,具有旋翼挥舞面积小、转速低、安全系数高等特点。 四旋翼的飞行方式灵活多变,机动能力较强,但由其运动原理决定的欠驱动、强耦合、非线 性等特点,使控制器的设计工作变得较为困难。
[0004] 旋翼类飞行器是非自稳系统,如果不对其加以控制,在外界或自身扰动的作用下, 旋翼类飞行器是不稳定的,会出现失控(如坠机、角度震荡发散等)情况。旋翼类飞行器的控 制器一般是利用反馈信息和参考信号之间的偏差作为输入,按照设计的控制律计算控制器 输出,通常也是被控对象的执行机构输入,当控制律表征的输入输出关系合理时,执行机构 的动作会抑制旋翼类飞行器的不稳定运动趋势。
[0005] 目前,工程上广泛采用常规的PID控制方法设计的常规控制器,该常规控制器对四 旋翼飞行器模型的精度无太大要求,忽略四旋翼飞行器模型中不确定项的影响,然而这种 近似只在四旋翼处于近悬停状态成立,当四旋翼进行大机动飞行时,常规控制器性能急剧 变差,存在潜在的安全隐患;同时,常规控制器仅为控制系统输出提供反馈通道,控制律设 计过程简单,控制精度低和控制性能差,难以应对飞行过程中的强耦合、四旋翼飞行器模型 的不确定性和外界干扰,如:四旋翼执行航迹跟踪任务时,常规的PID控制器,难以保证轨迹 跟踪精度高、响应快速和抗干扰能力强等特性同时得到满足。
发明内容
[0006] 本发明要解决的技术问题是提供一种基于MIMO非线性不确定反步法的四旋翼位 姿控制方法,以解决现有技术所存在的采用常规的PID控制方法难以应对飞行过程中的强 耦合、四旋翼飞行器模型的不确定性和外界干扰的问题。
[0007] 为解决上述技术问题,本发明实施例提供一种基于MMO非线性不确定反步法的四 旋翼位姿控制方法,包括:
[0008] 基于空气动力学和旋翼飞行器运动原理,并根据控制性能要求建立四旋翼飞行器 数学模型;
[0009] 根据所述四旋翼飞行器数学模型和精度要求,建立四旋翼飞行器模型;
[0010] 根据所述四旋翼飞行器数学模型和四旋翼飞行器模型的不确定性、外界干扰、欠 驱动、强耦合特性,确定基于内外环控制的反步鲁棒补偿控制器。
[0011] 可选地,所述根据所述四旋翼飞行器数学模型和精度要求,建立四旋翼飞行器模 型包括:
[0012] 对四旋翼飞行器进行受力分析和运动学分析,根据所述四旋翼飞行器数学模型和 精度要求,通过机理建模确定四旋翼飞行器模型的结构;
[0013] 根据四旋翼飞行器模型的结构,通过系统辨识、测量方式确定四旋翼飞行器模型 的参数,其中,辨识对象为实践工程中的四旋翼飞行器,辨识的内容包括:转动惯量、旋翼臂 长、模型阶次;
[0014] 对四旋翼飞行器模型的结构和参数进行验证;
[0015] 将所述四旋翼飞行器模型用确定性和不确定性两个部分表示,并结合实践工程, 减小不确定性部分所占的比重。
[0016] 可选地,所述四旋翼飞行器数学模型包括:表示四旋翼飞行器在地面坐标系中位 置的位置方程组和表示四旋翼飞行器在地面坐标系中姿态的姿态方程组;
[0017] 所述位置方程组表示如下:
[0018]
Figure CN104932512BD00071
[0019] 其中,不确定项&1(:树,£1:,*) = '12/^卢2(讲,9>)=寸广/-7’《』,*:.“成&,句=^ Φ表示欧拉角,Ui表示旋翼升力,m表示四旋翼质量,g表示重力加速度,cx ,Cy,cz表示空气阻 力系数,x,y,z表示四旋翼飞行器的空间位置,分别表示x,y,z的导数;X於5分别 表示的导数;
[0020] 所述姿态方程组表示如下:
[0021]
Figure CN104932512BD00072
[0022] 其中,不确定项' _
Figure CN104932512BD00073
___ _ ,
Figure CN104932512BD00074
113,114表示三轴转矩,^,]^表示转动惯量矩阵]"的对角线元素1,^,表戌.#分别表 示φ,θ,φ的导数,參,A #分别表示一,么#的导数,W表示电机转速,Jr表示电机转动惯 量,Cp,Cq,Cr表示转矩阻力系数。
[0023] 可选地,所述反步鲁棒补偿控制器采用内外环控制,内环姿态参考信号通过外环 控制律确定;
[0024] 所述反步鲁棒补偿控制器包括:反步控制器和鲁棒补偿控制器;
[0025] 通过反步控制器控制四旋翼飞行器模型状态变量的理想运动轨迹;
[0026] 通过鲁棒补偿控制器对四旋翼飞行器模型误差进行补偿,所述鲁棒补偿控制器的 跟踪性能和频率特性由控制性能要求和系统特性确定。
[0027] 可选地,所述根据所述四旋翼飞行器数学模型和四旋翼飞行器模型的不确定性、 外界干扰、欠驱动、强耦合特性,对所述四旋翼飞行器模型进行分析解耦,确定基于内外环 控制的反步鲁棒补偿控制器包括:
[0028] 对所述四旋翼飞行器数学模型进行整合分析,确定四旋翼飞行器数学模型的状态 空间表示形式;
[0029] 根据四旋翼飞行器数学模型的状态空间表示形式,结合四旋翼飞行器模型的不确 定性,外界干扰,控制性能要求,四旋翼飞行器的欠驱动、强耦合特性,位置、姿态不同的响 应特性,并基于内外环控制思想,对四旋翼飞行器的位置、偏航控制解耦成单通道的位姿控 制,再对单通道的二阶子系统进行反步鲁棒补偿控制律设计,对四旋翼飞行器模型的不确 定性和外界干扰进行补偿。
[0030] 可选地,所述四旋翼飞行器数学模型的状杰空间表示形式如下:
[0031]
Figure CN104932512BD00081
[0032] 其中,X11,X21,X31与空间位置x,y,z--对应,X13,X23,X41与欧拉角Φ,Θ,Φ--对 应,叉12,叉22,叉32与速度¥\^,¥2--对应,Χ14,Χ24,Χ42与欧拉角表我破--对应,Ai (i = 1, 2,…6)为不确定项Ai (*)的简写。
[0033] 可选地,所述对四旋翼飞行器的位置、偏航控制解耦成单通道的位姿控制,再对单 通道的二阶子系统进行反步鲁棒补偿控制律设计,对四旋翼飞行器模型的不确定性和外界 干扰进行补偿包括:
[0034] Z通道的控制输入为:Ul=m* (-a32*e32+f32*W32+g) / (COS (X13) *COS (X23))
[0035] 其中
Figure CN104932512BD00082
为Z方向的参考信号,1为2(1的导数,烏2为虚拟输入,a31和a32表示反步鲁棒补偿控制器的 调节参数;
[0036]偏航通道的控制律为:U4 = Jz* (-Cl42*e42+f42*W42) - (Jx-Jy) *X14*X24
[0037] 其中,
Figure CN104932512BD00091
!为 Φ角度的参考信号,t为恥的导数,t为虚拟输入,α4#Ρα42表示反步鲁棒补偿控制器的调 节参数;
[0038]滚转通道的控制律为:U2 = Jx* (_ai4*ei4+fl4*W14) - (Jy-Jz) *X24*X42
[0039] 其中,
Figure CN104932512BD00092
Figure CN104932512BD00093
1 Φ d为滚转 角的参考信号,a i 2、f I 2、a 2 2和f 2 2为反步鲁棒补偿控制器的调节参数,
Figure CN104932512BD00094
为虚拟输入, h W:?-毛2,毛2为虚拟输入,秦为Φ d的导数,笨4为虚拟输入,a13和a14表示反步鲁棒补偿 控制器的调节参数;
[0040] 俯仰通道的控制律为:U3 = Jy* (-Cl24*e24+f24*W24) - (Jz-Jx) *X14*X42
[0041] 其中,
Figure CN104932512BD00095
Figure CN104932512BD00096
’ Qd为 俯仰角的参考信号,a 1 2、f 1 2、a 2 2和f 2 2为反步鲁棒补偿控制器的调节参数,
Figure CN104932512BD00097
_e12 = X12 - i12,為为虚拟输入, e22 =X22 -先2,.ί22为虚拟输入,4为Gd的导数,4为虚拟输入,a23和a24表示反步鲁棒补偿 控制器的调节参数。
[0042] 可选地,所述方法还包括:在实践工程中,对四旋翼飞行器机载的传感器采集的四 旋翼飞行器的飞行信息进行滤波融合处理;
[0043] 所述对四旋翼飞行器机载的传感器采集的四旋翼飞行器的飞行信息进行滤波融 合处理包括:
[0044] 通过四旋翼飞行器机载的传感器采集四旋翼飞行器的飞行信息;
[0045] 通过低通滤波器对采集的四旋翼飞行器的飞行信息进行低通滤波处理,其中,所 述低通滤波器是结合实践工程中的四旋翼飞行器确定的;
[0046] 通过卡尔曼滤波器冗余机制对不同传感器采集的隐含同类型的经过低通滤波处 理后的飞行信息进行数据融合,得到目标观测信息;
[0047] 其中,数据融合包括:陀螺仪传感器、加速度计传感器,磁力计传感器、GPS传感器、 超声波传感器、气压计传感器采集的并经过低通滤波后的信息,及建立在此基础上的角速 度、欧拉角内环信息、速度、位置外环信息。
[0048] 可选地,所述方法还包括:
[0049] 在实践工程中,对确定的反步鲁棒补偿控制算法进行离散化处理,离散化程度由 反步鲁棒补偿控制器的控制性能和传感器的采样频率决定。
[0050] 可选地,所述根据所述四旋翼飞行器数学模型和四旋翼飞行器模型的不确定性、 外界干扰、欠驱动、强耦合特性,对所述四旋翼飞行器模型进行分析解耦,确定基于内外环 控制的反步鲁棒补偿控制器之后包括:
[0051] 在理论研究阶段,根据确定的反步鲁棒补偿控制器,建立四旋翼飞行器仿真模型, 并调节反步鲁棒补偿控制器的调节参数,直至控制性能满足控制性能要求,对基于反步鲁 棒补偿控制器的四旋翼飞行器仿真模型进行初步验证,其中,所述控制性能包括:响应时 间、超调、抗干扰能力;
[0052] 在实践工程中,对基于反步鲁棒补偿控制器的四旋翼飞行器的实际飞行效果进行 后期验证。
[0053] 本发明的上述技术方案的有益效果如下:
[0054] 上述方案中,通过空气动力学和旋翼飞行器运动原理,并根据控制性能要求建立 四旋翼飞行器的数学模型,再根据所述四旋翼飞行器的数学模型和精度要求,确定四旋翼 飞行器模型,最后,根据所述四旋翼飞行器数学模型和四旋翼飞行器模型的不确定性、外界 干扰、欠驱动、强耦合特性,对所述四旋翼飞行器模型进行分析解耦,确定基于内外环控制 的反步鲁棒补偿控制器。这样,对四旋翼飞行器模型进行分析解耦为确定基于内外环控制 的反步鲁棒补偿控制器服务,能够避免常规近似处理带来的控制性能恶化问题,并采用基 于内外环控制的反步鲁棒补偿控制器来补偿四旋翼飞行器模型的欠驱动、强耦合、不确定 性和外界干扰对飞行过程造成的干扰,改善四旋翼飞行器模型的控制精度和控制性能,从 而提高了四旋翼飞行器模型的飞行安全性和可操控性。
附图说明
[0055] 图1为本发明实施例提供的基于MMO非线性不确定反步法的四旋翼位姿控制方法 流程图;
[0056] 图2为本发明实施例提供的基于反步鲁棒补偿控制方法的控制系统结构示意图;
[0057] 图3为本发明实施例提供的四旋翼飞行器模型解耦后的单通道反步鲁棒补偿控制 律的二阶子系统结构示意图;
[0058] 图4为本发明实施例提供的传感器采集到的冗余信息进行数据融合的示意图;
[0059] 图5为图5中卡尔曼滤波器原理框图;
[0000]图6为本发明实施例提供的基于反步鲁棒补偿控制方法的simul ink平台仿真框 图;
[0061] 图7为本发明实施例提供的验证基于反步鲁棒补偿控制方法的有效性的方法流程 图;
[0062] 图8为本发明实施例提供的仿真中采用阶跃输入时的位置响应交叉验证效果图;
[0063] 图9为本发明实施例提供的仿真中采用内外环控制结构的姿态响应多通道交叉验 证效果图;
[0064] 图10为本发明实施例提供的位置跟踪飞行测试时,单通道位置跟踪飞行测试效果 图;
[0065] 图11为本发明实施例提供的姿态跟踪飞行测试时,单通道偏航角跟踪飞行测试时 效果图;
[0066] 图12为本发明实施例提供的室外飞行试验中进行轨迹跟踪的效果图。
具体实施方式
[0067] 为使本发明要解决的技术问题、技术方案和优点更加清楚,下面将结合附图及具 体实施例进行详细描述。
[0068] 本发明针对现有的采用常规的PID控制方法难以应对飞行过程中的强耦合、四旋 翼飞行器模型的不确定性和外界干扰的问题,提供一种基于Mnro非线性不确定反步法的四 旋翼位姿控制方法。
[0069] 实施例一
[0070] 参看图1所示,本发明实施例提供的一种基于MMO非线性不确定反步法的四旋翼 位姿控制方法,包括:
[0071] SI:基于空气动力学和旋翼飞行器运动原理,并根据控制性能要求建立四旋翼飞 行器数学模型;
[0072] S2:根据所述四旋翼飞行器数学模型和精度要求,建立四旋翼飞行器模型;
[0073] S3:根据所述四旋翼飞行器数学模型和四旋翼飞行器模型的不确定性、外界干扰、 欠驱动、强耦合特性,对所述四旋翼飞行器模型进行分析解耦,确定基于内外环控制的反步 鲁棒补偿控制器。
[0074] 本发明实施例所述的基于多变量输入多变量输出(Multiple-Input Multiple-〇utput,Mnro)非线性不确定反步法的四旋翼位姿控制方法,通过空气动力学和旋翼飞行器 运动原理,并根据控制性能要求建立四旋翼飞行器的数学模型,再根据所述四旋翼飞行器 的数学模型和精度要求,确定四旋翼飞行器模型,最后,根据所述四旋翼飞行器数学模型和 四旋翼飞行器模型的不确定性、外界干扰、欠驱动、强耦合特性,对所述四旋翼飞行器模型 进行分析解耦,确定基于内外环控制的反步鲁棒补偿控制器。这样,对四旋翼飞行器模型进 行分析解耦为确定基于内外环控制的反步鲁棒补偿控制器服务,能够避免常规近似处理带 来的控制性能恶化问题,并采用基于内外环控制的反步鲁棒补偿控制器来补偿四旋翼飞行 器模型的欠驱动、强耦合、不确定性和外界干扰对飞行过程造成的干扰,改善四旋翼飞行器 模型的控制精度和控制性能,从而提高了四旋翼飞行器模型的飞行安全性和可操控性。
[0075] 在前述基于MMO非线性不确定反步法的四旋翼位姿控制方法的具体实施方式中, 可选地,所述根据所述四旋翼飞行器数学模型和精度要求,建立四旋翼飞行器模型包括:
[0076] 对四旋翼飞行器进行受力分析和运动学分析,根据所述四旋翼飞行器数学模型和 精度要求,通过机理建模确定四旋翼飞行器模型的结构;
[0077] 根据四旋翼飞行器模型的结构,通过系统辨识、测量方式确定四旋翼飞行器模型 的参数,其中,辨识对象为实践工程中的四旋翼飞行器,辨识的内容包括:转动惯量、旋翼臂 长、模型阶次;
[0078] 对四旋翼飞行器模型的结构和参数进行验证;
[0079] 将所述四旋翼飞行器模型用确定性和不确定性两个部分表示,并结合实践工程, 减小不确定性部分所占的比重。
[0080] 本发明实施例中,四旋翼飞行器模型的精度(简称模型精度),直接影响后续的模 型特性分析(包括:欠驱动、强耦合等特性)和反步鲁棒补偿控制器的设计,影响模型精度的 因素主要有两个:四旋翼飞行器模型的结构和模型参数,在提高模型精度时,要兼顾模型描 述的准确性和复杂度,考虑过多输入的复杂模型,对反步鲁棒补偿控制器性能提升的帮助 有限。为了方便描述,将四旋翼飞行器模型的结构简称为模型结构,四旋翼飞行器模型的参 数简称为模型参数。
[0081] 本发明实施例中,为了更好的理解模型结构和模型参数,先对模型结构和模型参 数的相关知识进行简单说明:
[0082] 模型结构从本质上反映了模型的特点,是影响模型精度的主要因素,模型结构直 接影响后续设计反步鲁棒补偿控制器的全局性能。模型参数是影响模型精度的又一重要因 素,模型参数以确定的模型结构为前提,脱离结构讨论模型参数没有实际意义,当模型结构 确定后,模型参数在模型类中对四旋翼飞行器的特有细节特征进行定位,与模型结构一起, 对四旋翼飞行器的属性进行完整描述。
[0083] 一般而言,可以通过机理建模和系统辨识的方式确定模型结构,机理建模基本能 在全局范围内准确地描述系统特性,但需要丰富的先验知识和扎实的理论基础,系统辨识 得到的模型结构简单,且辨识过程可以通过不同的辨识工具包完成,基本上能在系统常规 工作模式下较客观地描述系统特性,但辨识结果通常具有一定的局限性。
[0084] —般而言,通过直接测量和辨识的方式获得模型参数,前者适用于直观的能直接 进行测量的参数对象,如本发明中的旋翼中心到四旋翼飞行器质心距离(臂长L);难以用简 单直接的方式进行辨识的参数对象,通常需要根据参数特性,设计具有实际可行性的实验, 借助能直接测量的观测量,反向推算出待辨识参数值的大小,如本发明中四旋翼飞行器的 三轴转动惯量、电机转动惯量等,可以分别通过设计三悬线转动惯量测量,电机结构简单拆 解分析等实验,得到系统未知的待辨识参数。
[0085] 本发明实施例中,在建模过程中,为保证模型精度,对四旋翼飞行器进行受力分析 和运动学分析,并采用机理建模的方式确定模型结构,确保模型状态在大范围内全局一致 有效;通过设计实验,并借助Matlab辨识工具箱完成识别模型参数,并通过不同环境中获得 的数据对建立的四旋翼飞行器模型进行反复验证。待辨识参数中,由于选用的电调、电机和 旋翼特性对用户不透明,而在实践验证环节,搭建的四旋翼飞行器硬件平台不太可能出现 较大的变动,所以本发明在对旋翼升力系数和阻力系数进行辨识时,并不是通过寻找旋翼 转速与升力间关系的方式进行,为减小不必要的工作量,且不影响模型的完整性,本发明直 接辨识执行机构控制信号与旋翼升力之间的关系,而尽量不关心每个串联执行机构间的输 入输出特性。本发明通过执行机构控制信号与旋翼升力的映射实验,得到旋翼系统升力与 脉冲宽度调制(Pulse Width Modulation,PWM)、电池电压等输入信号之间的关系,并在反 步鲁棒补偿控制器部分通过反变换体现了这种映射关系。
[0086] 本发明实施例中,还将所述四旋翼飞行器模型用确定性和不确定性两个部分表 示,并结合实践工程,减小不确定性部分所占的比重,为下一步的控制律设计工作做准备, 这样就避免了常规控制方法中对模型的简化,从而引起设计的反步鲁棒补偿控制器性能与 实际飞行效果存在差异,通常这种差异在大机动飞行时非常明显,甚至导致飞行器失稳。本 发明实施例中,基于空气动力学和飞行器运动原理,并根据控制性能要求,对四旋翼飞行器 进行受力分析,并结合运动学相关知识,通过如下步骤确定四旋翼飞行器数学模型,所述四 旋翼飞行器数学模型包括:表示四旋翼飞行器在地面坐标系中位置的位置方程组和表示四 旋翼飞行器在地面坐标系中姿态的姿态方程组。
[0087] 在惯性坐标系(地面坐标系)中,四旋翼飞行器数学模型方程式满足式(1):
[0088]
Figure CN104932512BD00131
Cl)
[0089] 式(1)中,Φ,θ,φ表示欧拉角,U1表示旋翼升力,m表示四旋翼质量,g表示重力加速 度,Cx,Cy,Cz表示空气阻力系数,x,y,z表示四旋翼飞行器的空间位置,i,j,i分别表示x,y,z 的导数;iS分别表示i,.的导数。
[0090] 在机体坐标系(NED)中,四旋翼飞行器数学模型方程式满足式⑵:
[0091]
Figure CN104932512BD00132
( 2 )
[0092] 式(2)中,J表示3*3的机体转动惯量矩阵,U2 ,U3,U4表示三轴转矩,表在#分别表 示Φ,Θ,Φ的导数,承成歹分别表示一,在.妒的导数,Wi表示第i电机的转速,Jr表示电机 转动惯量,Cp,Cq,Cr表示转矩阻力系数。
[0093] 直观上讲,惯性坐标系是无人飞行器的习惯坐标系,所以需要将在机体坐标系中 建立的模型方程转化到特殊的惯性坐标系中,通过变换过程可知,机体角速度与欧拉角的 对应关系为式(3):
[0094]
Figure CN104932512BD00133
( 3 )
[0095] 将式⑵、式⑶两式联合,可得式⑷:
Figure CN104932512BD00134
(4)
[0097] 式⑶中,ΚΓ1分别为下述矩阵:
[0098]
Figure CN104932512BD00135
[0099]
Figure CN104932512BD00141
[0100] 将欧拉角方程用机体角速度方程代替,角度模型之间的误差通过对不确定性部分 的补偿输入进行弥补。
[0101] 根据四旋翼飞行器硬件平台的特点可知,转动惯量矩阵J的非对角线元素的值很 小,相对于转动惯量矩阵J的对角线元素JX,Jy,Jz可以忽略不计,所以欧拉角方程可转化为 式⑶:
Figure CN104932512BD00142
(5)
[0103] 根据式(1),将位置方程重写为式⑶:
[0104]
Figure CN104932512BD00143
( 6 )
[0105] 式(6)中,不确定项为:
[0106]
Figure CN104932512BD00144
[0107] 根据式⑶,将姿态方程重写为式(7):
[0108]
Figure CN104932512BD00145
C 7)
[0109] 式⑵中,W表示电机转速,不确定项定义为:
[0110]
Figure CN104932512BD00146
[0111] 至此,根据表示四旋翼飞行器在地面坐标系中位置的位置方程组式(6)和表示四 旋翼飞行器在地面坐标系中姿态的姿态方程组式(7)确定的四旋翼飞行器数学模型。
[0112] 在前述基于MMO非线性不确定反步法的四旋翼位姿控制方法的具体实施方式中, 可选地,所述反步鲁棒补偿控制器采用内外环控制,内环姿态参考信号通过外环控制律确 定;
[0113] 所述反步鲁棒补偿控制器包括:反步控制器和鲁棒补偿控制器;
[0114] 通过反步控制器控制四旋翼飞行器模型状态变量的理想运动轨迹;
[0115] 通过鲁棒补偿控制器对四旋翼飞行器模型误差进行补偿,所述鲁棒补偿控制器的 跟踪性能和频率特性由控制性能要求和系统特性确定。
[0116] 本发明实施例中,参看图2所示,反步鲁棒补偿控制器分为外环位置控制和内环姿 态控制两部分,内环姿态参考信号通过外环控制律确定,其中,6D0F指六自由度(包括:3个 位置自由度和3个姿态自由度)。具体的,将四旋翼飞行器的外环控制律根据位置参考信号 和当前位置信息,经过运算得到内环姿态参考信号,内环控制律结合姿态信息,输出控制信 号驱动执行机构按照既定的方式动作,最终使四旋翼平台到达期望的状态,完成诸如定点 悬停、轨迹跟踪等飞行任务。
[0117] 本发明实施例通过结合实践工程中,对四旋翼飞行器模型进行分析,确定导致四 旋翼飞行器模型输出与输入存在不确定性的因素,这些因素包括:模型参数不确定性、未建 模动态、系统噪声(包括:传感器噪声)和外部干扰等。当量化的不确定性与确定性部分满足 一定的关系时,不确定性造成的一般控制器的性能恶化现象可通过鲁棒补偿改善。
[0118] 本发明实施例中,正是考虑到实际实践工程中存在的各种不确定性和外部噪声, 结合旋翼飞行器欠驱动、强耦合等MMO典型特点,且为减少控制器设计的保守性,防止鲁棒 补偿执行机构饱和,在进行模型不确定性分离时,本发明放弃了一般的模型线性化原则,而 是最大可能地保留了模型的确定性部分,为确保四旋翼飞行器的控制性能和工程实现的可 能性,本发明设计了对外部干扰和不确定性具有较强鲁棒性的反步鲁棒补偿控制器,与一 般的控制器相比,四旋翼飞行器模型的反步鲁棒补偿控制器具有抗干扰能力强,控制性能 优良的特点。
[0119] 本发明实施例中,为使反步鲁棒补偿控制器发挥良好的性能,使被控的四旋翼飞 行器的模型结构尽可能符合客观实际,模型结构和模型参数偏差,在不超过一定范围时,可 以通过反步鲁棒补偿控制器来减小其对控制性能的不利影响,该反步鲁棒补偿控制器具有 如下特点:
[0120] 反步鲁棒补偿控制器从结构上分为反步控制器和鲁棒补偿控制器两部分,反步控 制器是针对四旋翼飞行器模型确定性部分设计的控制器,作用是设计旋翼飞行器状态变量 的理想运动轨迹,也称为标称控制器。
[0121] 鲁棒补偿控制器是控制器的重要组成部分,其作用在于补偿由于四旋翼飞行器模 型的不确定部分(不确定性和外界干扰)对飞行过程造成的干扰,使得补偿后的四旋翼飞行 器模型与标称模型一样,便于通过标称模型设计控制律,从而确保四旋翼飞行器模型不确 定性部分的控制性能基本上与针对四旋翼飞行器模型确定性部分设计的反步控制器一致, 使得四旋翼飞行器在一定程度的干扰下,仍能按照期望的性能完成既定的飞行任务,鲁棒 补偿控制器的跟踪性能和频率特性,由控制性能要求和系统特性确定,其中,标称模型是四 旋翼飞行器模型的确定性部分,能够通过实验或客观规律得到的。所述反步鲁棒补偿控制 器具有良好的跟踪特性,响应快速、超调小、静差以指数形式趋近于零,适用于诸如四旋翼 的复杂非线性不确定系统,但不局限于此。
[0122] 在前述基于MMO非线性不确定反步法的四旋翼位姿控制方法的具体实施方式中, 可选地,所述根据所述四旋翼飞行器数学模型和四旋翼飞行器模型的不确定性、外界干扰、 欠驱动、强耦合特性,对所述四旋翼飞行器模型进行分析解耦,确定基于内外环控制的反步 鲁棒补偿控制器包括:
[0123] 对所述四旋翼飞行器数学模型进行整合分析,确定四旋翼飞行器数学模型的状态 空间表示形式;
[0124] 根据四旋翼飞行器数学模型的状态空间表示形式,结合四旋翼飞行器模型的不确 定性,外界干扰,控制性能要求,四旋翼飞行器的欠驱动、强耦合特性,位置、姿态不同的响 应特性,并基于内外环控制思想,对四旋翼飞行器的位置、偏航控制解耦成单通道的位姿控 制,再对单通道的二阶子系统进行反步鲁棒补偿控制律设计,对四旋翼飞行器模型的不确 定性和外界干扰进行补偿。
[0125] 本发明实施例中,对所述四旋翼飞行器数学模型进行整合分析,确定四旋翼飞行 器数学模型的状态空间表示形式,为后续反步鲁棒补偿控制器设计工作打好基础,所述四 旋翼飞行器数学模型的状态空间表示形式如下:
[0126]
Figure CN104932512BD00161
[0127] 其中,X11,X21,X31与空间位置X,y,Z--对应,X13,X23,X41与欧拉角Φ,θ,Φ--对 应,Χ12,Χ22,Χ32与速度Vx, Vy,Vz--对应,Χ14,Χ24,Χ42与欧拉角一,成*/>--对应,Ai Q = 1, 2,…6)为不确定项A1 (*)的简写。四旋翼飞行器可在空中进行六自由度的运动,六自由度 分别指位置三自由度和角度三自由度,这些可观测的自由度状态变量及其微分,构成了四 旋翼飞行器模型的状态变量空间。
[0128] 本发明实施例中,根据确定的四旋翼飞行器数学模型的状态空间表示形式,结合 四旋翼飞行器模型的不确定性,外界干扰,控制性能要求,四旋翼飞行器的欠驱动、强耦合 特性,位置、姿态不同的响应特性,并基于内外环控制思想,对四旋翼飞行器的位置、偏航控 制解耦成单通道的位姿控制,再对单通道的二阶子系统进行反步鲁棒补偿控制律设计,对 四旋翼飞行器模型的不确定性和外界干扰进行补偿,参看图3所示为四旋翼模型解耦后的 单通道反步鲁棒补偿控制律的二阶子系统结构示意图。
[0129] 本发明实施例中,反步鲁棒补偿控制器的设计步骤如下:
[0130] ζ位置和偏航通道均可视为关于控制输入的二阶子系统,先为ζ通道设计基于反步 法的反步鲁棒补偿控制器:
[0133] γί 一 ν* — 7 V* 一 一,y ^ p . 4- T [0131] ~ Λ31 Λ32 — U:A C31 1 Δ(1 》.;ι = C.;: = [0132] 其中,Zd为Z方向的参考信号,ASzd的导数,·^32为虚拟输入,α3ΐ表不反步鲁棒补偿 控制器的调节参数,对e32求导:
Figure CN104932512BD00171
[0134] α32和f32为反步鲁棒补偿控制器 的调节参数,Λ 3 2为不确定项,为使控制输入对不确定性的补偿效果较好,取
Figure CN104932512BD00172
其中,S表示拉普拉斯算子,进行频域处理的特殊运算形式。
[0135] 故应设计控制输入为:
[0136] Ul=m* (-a32*e32+f32*W32+g) / (COS (Χ13) *COS (Χ23) ) (8)
[0137] 本发明实施例中,偏航角子系统的同结构控制器设计步骤与z位置类似,可得偏航 通道的反步鲁棒补偿控制器为:
[0138]
Figure CN104932512BD00173
[0139] 其中,如为Φ角度的参考信号,#,/为恥的导数,为虚拟输入,a4i表示反步鲁棒补 偿控制器的调节参数,对e42求导:
Figure CN104932512BD00174
[0140]
[0141] Ϊ42和f42为反步鲁棒补偿控制器的调 7 节参数,A62为不确定项,其中
Figure CN104932512BD00175
[0142] 故偏航通道的控制律为:
[0143] U4=Jz* (-a42*e42+f42*W42) - (Jx-Jy) *X14*X24 (9)
[0144] 本发明实施例中,当对位置分量X和y进行控制时,由于控制输入隐含在状态变量 中,需要进行转换变形,以便进行控制律设计,避免了常规补偿器的微分爆炸效应,针对位 置分量X:
[0145]
Figure CN104932512BD00176
[0146] 其中,Xd为X方向的参考信号,毛为Xd的导数,4为虚拟输入,αη表示反步鲁棒补 偿控制器的调节参数,对e12求导:
Figure CN104932512BD00181
[0150] 式(10)中,a12和f12为反步鲁棒补偿控制器的调节参数,A12为不确定项,
Figure CN104932512BD00182
[0151] 由于状态变量间的耦合,还需要y方向的控制输入信息,依上可得:
[0152] 心=—«21>+九 ί·::丨二.V::丨一.Γ", Cj12 - X-n - Χ::
[0153] 其中,yd为y方向的参考信号,的导数,毛2为虚拟输入,a21表示反步鲁棒补 偿控制器的调节参数,对e22求导:
Figure CN104932512BD00183
[0157] 式(11)中,a22和f22为反步鲁棒补偿控制器的调节参数,A22为不确定项,
Figure CN104932512BD00184
[0158] 综合式(10)、式11)两式,可得滚转角的参考信号Φ<!,俯仰角的参考信号0d:
Figure CN104932512BD00185
[0161] 在获得滚转和俯仰角的参考信号后,可以按照常规方式进行内环欧拉通道的闭环 鲁棒补偿控制律设计,对于滚转角有: _2] Wt i14=-auy+i β13=χ13-φ(Ι ^14 = X14-X14
[0163] 其中,4为Φ<!的导数,丸4为虚拟输入,α13表示反步鲁棒补偿控制器的调节参数, 对ei4求导:
Figure CN104932512BD00191
4和匕4为反步鲁棒补偿控制器的调 节参数,Λ42为不确定项
Figure CN104932512BD00192
[0166] 得到滚转通道控制律为:
[0167] U2 = Jx* (-ai4*ei4+f14*wi4) - (Jy-Jz) *X24*X42 (12)
[0168] 同理可得俯仰通道控制律为:
[0169] U3 = Jy* (-a24*e24+f24*W24) - (Jz-Jx) *X14*X42 (13)
[0170] 式(13)中
Figure CN104932512BD00193
4为0d的导数,.%4为虚 拟输入,a23、a24和f24表示反步鲁棒补偿控制器的调节参数。
[0171] 至此,综合式⑶-(13),反步鲁棒补偿控制器的设计工作已完成。
[0172] 在前述基于MMO非线性不确定反步法的四旋翼位姿控制方法的具体实施方式中, 可选地,所述方法还包括:在实践工程中,对四旋翼飞行器机载的传感器采集的四旋翼飞行 器的飞行信息进行滤波融合处理;
[0173] 所述对四旋翼飞行器机载的传感器采集的四旋翼飞行器的飞行信息进行滤波融 合处理包括:
[0174] 通过四旋翼飞行器机载的传感器采集四旋翼飞行器的飞行信息;
[0175] 通过低通滤波器对采集的四旋翼飞行器的飞行信息进行低通滤波处理,其中,所 述低通滤波器是结合实践工程中的四旋翼飞行器确定的;
[0176] 通过卡尔曼滤波器冗余机制对不同传感器采集的隐含同类型的经过低通滤波处 理后的飞行信息进行数据融合,得到目标观测信息;
[0177] 其中,数据融合包括:陀螺仪传感器、加速度计传感器,磁力计传感器、GPS传感器、 超声波传感器、气压计传感器采集的并经过低通滤波后的信息,及建立在此基础上的角速 度、欧拉角内环信息、速度、位置外环信息。
[0178] 本发明实施例中,在实践工程中,还依据四旋翼飞行器系统的控制性能和运算、接 口通信等要求,选择反步鲁棒补偿控制器的硬件实现基础,包括飞行器外围设备、飞控板和 传感器。例如,所述飞行器外围设备包括:DJI F450飞行器机架,朗宇X2212无刷直流电机, FUN系列10*4 · 7P旋翼,好盈platinum pro 30A电调、Xsens公司的Mti-G-700传感器等。飞控 板是反步鲁棒补偿控制器实现其功能的重要部件,在综合考虑反步鲁棒补偿控制器性能和 成本的基础上,选择基于TMS320F28335的DSP为处理核心设计飞控板,并进行适应工作环境 的优化,即采用基于TMS320F28335的DSP控制单元运行本发明设计的反步鲁棒补偿控制算 法。
[0179] 本发明实施例中,在实践工程中,为对设计的四旋翼飞行器的反步鲁棒补偿控制 器的可行性、控制性能进行分析,需选择满足需求的传感器,结合不同传感器特点,搭建四 旋翼飞行器的传感器平台,对传感器参数进行校正、以及对传感器采集的数据进行处理。
[0180] 本发明实施例中,当进行纯粹的理论分析时,通常假设四旋翼飞行器传感器的采 集的四旋翼飞行器的飞行信息准确无偏,但是,在实践工程中,微小型传感器由于机械结 构、观测原理等因素,容易受到外界环境的干扰,造成采集信息的可信度低,从而影响整个 控制系统的性能。
[0181] 旋翼类飞行器依靠旋翼产生的升力抵消自身的重力,达到飞行目的,现阶段小型 四旋翼飞行器基本依靠3S锂电池作为动力来源,载重能力有限,不能搭载大型复杂的高精 度传感器为四旋翼导航。为解决载重能力与传感器精度之间的矛盾,结合当前四旋翼控制 领域较为成熟的传感器数据融合技术,为传感器设计数据滤波与融合通道。数据融合利用 多个传感器得到某观测变量的相关信息,利用冗余机制对不同来源的信息进行整合,得到 可信度较高的目标观测信息。
[0182] 本发明实施例中,结合四旋翼飞行器模型的特点,对传感器采集的四旋翼飞行器 的飞行信息进行初步处理,减小错误信息对反步鲁棒补偿控制器和滤波器性能的影响。例 如,在实践工程中搭建四旋翼飞行器时,由于旋翼不能提供与重力方向相同的力,所以四旋 翼飞行器的加速度不会小于重力加速度的相反数;实践环节的测试结果表明,由于四旋翼 飞行器动力系统电调、电机、电源等硬件的性能限制,四旋翼飞行器的加速度不会超过重力 加速度。所以在对加速度计进行滤波时,可以先进行限幅处理,防止异常的传感器信息导致 执行机构的误动作,导致四旋翼飞行器系统不稳定。
[0183] 在实践工程搭建的四旋翼飞行器中,传感器的异常信息带来的影响有两个方面:
[0184] —是导致反步鲁棒补偿控制器决策失当,引起执行机构误动作,使四旋翼飞行器 产生振荡甚至失稳,造成安全隐患;
[0185] 二是使滤波器在进行参数估计时,对不同来源信息的噪声估计出现较大偏差,导 致之后较长时间的估计信息可信度较低,特别是这段时间再次出现较强干扰时,四旋翼飞 行器容易进入不稳定飞行状态,发生意外。
[0186] 本发明实施例中,先通过低通滤波器对采集的四旋翼飞行器的飞行信息进行低通 滤波处理,减少传感器原始数据对融合不利的成分,便于卡尔曼滤波器快速收敛,其中,所 述低通滤波器是结合实践工程中的四旋翼飞行器确定的,再利用成熟的滤波理论,对不同 传感器采集的隐含同类型的经过低通滤波处理后的飞行信息进行数据融合,该融合过程应 根据不同传感器信息的特点,有目的地进行。例如,传感器中,我们可以通过陀螺仪和磁力 计获得偏航角ί目息,陀螺仪是通过角速度积分得到角度ί目息的,获得的角度ί目息随着时间 漂移,且偏差越来越大,这种无界的漂移对控制器来说往往是致命的,通过磁力计获得的偏 航角信息具有较好的静态特性,但其对快速的角度变化不敏感,存在明显的滞后。经过上述 简单分析,可以很自然地想到利用某种手段将陀螺仪和磁力计两种偏航角信息获取方式的 优点结合起来,使处理结果既具有磁力计稳定准确的静态特性,同时又具备陀螺仪对角度 变化敏感快速的动态响应能力。
[0187] 本发明实施例中,参看图4所示,利用卡尔曼滤波器对冗余的传感器信息进行数据 融合处理,得到可信度较高的目标观测信息,为实践工程中控制系统良好的可视化性能打 好基础,参看图5所示为卡尔曼滤波器原理框图。
[0188] 在前述基于MMO非线性不确定反步法的四旋翼位姿控制方法的具体实施方式中, 可选地,所述方法还包括:
[0189] 在实践工程中,对确定的反步鲁棒补偿控制算法进行离散化处理,离散化程度由 反步鲁棒补偿控制器的控制性能和传感器的采样频率决定。
[0190] 本发明实施例中,为在实践工程中顺利实现对四旋翼飞行器的控制,需对本发明 实设计的反步鲁棒补偿控制算法进行离散化处理,离散程度由反步鲁棒补偿控制器的控制 性能和传感器的采样频率决定,例如,离散化控制频率可以为IOOHz。
[0191] 在前述基于MMO非线性不确定反步法的四旋翼位姿控制方法的具体实施方式中, 可选地,所述根据所述四旋翼飞行器数学模型和四旋翼飞行器模型的不确定性、外界干扰、 欠驱动、强耦合特性,对所述四旋翼飞行器模型进行分析解耦,确定基于内外环控制的反步 鲁棒补偿控制器之后包括:
[0192] 在理论研究阶段,根据确定的反步鲁棒补偿控制器,建立四旋翼飞行器仿真模型, 并调节反步鲁棒补偿控制器的调节参数,直至控制性能满足控制性能要求,对基于反步鲁 棒补偿控制器的四旋翼飞行器仿真模型进行初步验证,其中,所述控制性能包括:响应时 间、超调、抗干扰能力;
[0193] 在实践工程中,对基于反步鲁棒补偿控制器的四旋翼飞行器的实际飞行效果进行 后期验证。
[0194] 本发明实施例中,利用上述设计的反步鲁棒补偿控制器,在simulink仿真平台上 搭建四旋翼飞行器仿真模型,在理论研究中和实践工程中,分析四旋翼飞行器控制系统的 状态并依此调节反步鲁棒补偿控制器的调节参数,使系统性能(包括响应时间、超调、抗干 扰能力等)满足预期要求。系统性能的评测主要从两方面进行,在理想干净环境下 (Simul ink仿真平台),反步鲁棒补偿控制器响应速度、超调量、静态误差等指标。实际飞行 时,结合地面站信息、飞行环境和飞行任务,对飞行质量作出综合测评。
[0195] 本发明实施例中,参看图6所示为反步鲁棒补偿控制的simulink平台仿真框图,仿 真中考虑了四旋翼飞行器模型不确定性、传感器噪声、外界干扰、执行机构不对称性、动力 性能变化、积分器饱和等因素,并将这些因素整合到被控四旋翼飞行器模型中,设计反步鲁 棒补偿控制器并检验其性能,为实践工程做参数调整的提供初期参考。为使仿真能更好地 模拟实际飞行时的情况,设置仿真采样时间与传感器的数据发送频率一致,并在电机-旋翼 模型间加入随机的白噪声干扰,幅值为进行升力测试试验中的最大变动范围,使仿真结果 具有较高的说服力。
[0196] 本发明实施例中,为验证本发明设计的反步鲁棒补偿控制算法的有效性,需对基 于反步鲁棒补偿控制方法的控制系统进行验证,不仅在理论阶段对基于反步鲁棒补偿控制 方法的有效性进行初步验证,在实践工程中,也要对四旋翼飞行器的实际飞行效果进行测 试验证,在实践工程中,该控制系统主要包括两部分,硬件平台和软件平台,硬件给控制算 法的执行提供了平台,软件代码指明了在硬件平台中进行怎样的操作,来实现设计的控制 方法,硬件平台和软件平台是相互依存,不可分割的关系。硬件平台包括:搭载软件的飞控 板、四旋翼机体、传感器、接收机及飞行器外围设备,硬件部分为验证发明目的提供了实体 和可能。
[0197] 本发明实施例中,软件平台中,传感器和接收机与飞控板的数据通讯通过中断方 式实现,这有利于提高程序的执行效率并减少出错,程序采用模块化方式编写,预留接口以 便于移植。
[0198] 本发明实施例中,所述软件平台按照用途划分为嵌入式控制程序和地面站两个部 分,嵌入式控制程序是完整的关于传感器信息处理、上位机通信、控制策略执行解决方案, 主要在软件平台中完成开发工作。简易版本的地面站具有调节控制参数,监控状态变量,控 制性能评估等功能,完成地面站初期上位机平台的搭建。
[0199] 本发明实施例中,为验证本发明设计的基于反步鲁棒补偿控制方法的控制系统的 有效性,对两类的飞行试验进行验证:定点悬停和轨迹跟踪,参看图7所示为验证基于反步 鲁棒补偿控制方法的有效性,其中,i表示通信接口标志,num表示通信接口总数量,CH_pro 表示接收机信息处理标志,Sen_pr〇 = 1表示传感器信息处理标志,UKF指卡尔曼滤波器,参 看图8和图9所示,展示了采用本发明设计的反步鲁棒补偿控制算法控制四旋翼飞行器到达 指定位置并定点悬停的过程,从图8中可以看出,四旋翼飞行器控制系统能在7s内从原点到 达给定悬停点(7,_2,3),响应快速无超调,反步鲁棒补偿控制器基本上消除了不同通道之 间的相互干扰,第25s时,四旋翼飞行器控制系统的位置响应出现了较小的波动,结合图9可 知,这主要是四旋翼飞行器控制系统快速跟踪给定偏航角导致的,位置和角度偏差都是以 指数形式收敛到零的,其中,Pitch表示俯仰角Θ,Yaw表示偏航角i^Roll表示滚转角Φ。
[0200] 本发明实施例中,在实践工程中,根据simulink仿真结果,对反步鲁棒补偿控制器 参数进行微调,使四旋翼飞行性能满足要求,因室外干扰源较多,且产生的干扰具有随机 性,而反步鲁棒补偿控制进行输入补偿需要一定的时间,再加上传感器的测量噪声无法完 全消除,所以实际飞行时,位置和姿态响应会有一些较小的抖动,但整体表现良好,参看图 10和图11所示,图12为四旋翼飞行器上升至给定的高度,跟踪边长为30米正方形,将飞行数 据无线传输至地面站,并绘出飞行效果图的情况,参看图12所示为室外飞行试验中进行轨 迹跟踪的效果图。
[0201] 以上所述是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员 来说,在不脱离本发明所述原理的前提下,还可以作出若干改进和润饰,这些改进和润饰也 应视为本发明的保护范围。

Claims (9)

1. 一种基于ΜΙΜΟ非线性不确定反步法的四旋翼位姿控制方法,其特征在于,包括: 基于空气动力学和旋翼飞行器运动原理,并根据控制性能要求建立四旋翼飞行器数学 丰旲型; 根据所述四旋翼飞行器数学模型和精度要求,建立四旋翼飞行器模型; 根据所述四旋翼飞行器数学模型和四旋翼飞行器模型的不确定性、外界干扰、欠驱动、 强耦合特性,对所述四旋翼飞行器模型进行分析解耦,确定基于内外环控制的反步鲁棒补 偿控制器; 其中,所述四旋翼飞行器数学模型包括:表示四旋翼飞行器在地面坐标系中位置的位 置方程组和表示四旋翼飞行器在地面坐标系中姿态的姿态方程组; 所述位置方程组表示如下:
Figure CN104932512BC00021
其中,不确定项
Figure CN104932512BC00022
Φ,θ,Ψ表示欧拉角,Ui表示旋翼升力,m表示四旋翼质量,g表示重力加速度,cx,Cy,cz表示 空气阻力系数,x,y,z表示四旋翼飞行器的空间位置,匕j.i分别表示x,y,z的导数3¾ S 分别表示毛的导数; 所述姿态方程组表示如下:
Figure CN104932512BC00023
Figure CN104932512BC00024
Figure CN104932512BC00025
U 2 , 其中,不确定项 ? U3,U4表示三轴转矩,Jx,Jy,Jz表示转动惯量矩阵J的对角线元素Jx,Jy,Jz,0,么#分别表示 Φ,θ,ψ的导数,表戌,分别表示.表冷,#的导数,W表示电机转速,Jr表示电机转动惯 量,Cp,Cq,Cr表示转矩阻力系数。
2. 根据权利要求1所述的方法,其特征在于,所述根据所述四旋翼飞行器数学模型和精 度要求,建立四旋翼飞行器模型包括: 对四旋翼飞行器进行受力分析和运动学分析,根据所述四旋翼飞行器数学模型和精度 要求,通过机理建模确定四旋翼飞行器模型的结构; 根据四旋翼飞行器模型的结构,通过系统辨识、测量方式确定四旋翼飞行器模型的参 数,其中,辨识对象为实践工程中的四旋翼飞行器,辨识的内容包括:转动惯量、旋翼臂长、 模型阶次; 对四旋翼飞行器模型的结构和参数进行验证; 将所述四旋翼飞行器模型用确定性和不确定性两个部分表示,并结合实践工程,减小 不确定性部分所占的比重。
3. 根据权利要求1所述的方法,其特征在于,所述反步鲁棒补偿控制器采用内外环控 制,内环姿态参考信号通过外环控制律确定; 所述反步鲁棒补偿控制器包括:反步控制器和鲁棒补偿控制器; 通过反步控制器控制四旋翼飞行器模型状态变量的理想运动轨迹; 通过鲁棒补偿控制器对四旋翼飞行器模型误差进行补偿,所述鲁棒补偿控制器的跟踪 性能和频率特性由控制性能要求和系统特性确定。
4. 根据权利要求3所述的方法,其特征在于,所述根据所述四旋翼飞行器数学模型和四 旋翼飞行器模型的不确定性、外界干扰、欠驱动、强耦合特性,对所述四旋翼飞行器模型进 行分析解親,确定基于内外环控制的反步鲁棒补偿控制器包括: 对所述四旋翼飞行器数学模型进行整合分析,确定四旋翼飞行器数学模型的状态空间 表示形式; 根据四旋翼飞行器数学模型的状态空间表示形式,结合四旋翼飞行器模型的不确定 性,外界干扰,控制性能要求,四旋翼飞行器的欠驱动、强耦合特性,位置、姿态不同的响应 特性,并基于内外环控制思想,对四旋翼飞行器的位置、偏航控制解耦成单通道的位姿控 制,再对单通道的二阶子系统进行反步鲁棒补偿控制律设计,对四旋翼飞行器模型的不确 定性和外界干扰进行补偿。
5. 根据权利要求4所述的方法,其特征在于,所述四旋翼飞行器数学模型的状态空间表 示形式如下:
Figure CN104932512BC00031
其中,X11,X21,X31与空间位置X,y,Z--对应,X13,X23,X41与欧拉角Φ,Θ,Ψ--对应, X12,X22,X32与速度Vx,Vy,Vz--对应,X14,X24,X42与欧拉角1/少--对应,Ai (i = 1,2,…6) 为不确定项Ai (*)的简写。
6. 根据权利要求5所述的方法,其特征在于,所述对四旋翼飞行器的位置、偏航控制解 耦成单通道的位姿控制,再对单通道的二阶子系统进行反步鲁棒补偿控制律设计,对四旋 翼飞行器模型的不确定性和外界干扰进行补偿包括: Z通道的控制输入为:Ul=m* (-a32*e32+f32*W32+g) / (COS (X13) *COS (X23)) 其中, Zd为Z方向的参
Figure CN104932512BC00041
( 考信号,4为Zd的导数,4为虚拟输入,Ct3^a32表示反步鲁棒补偿控制器的调节参数,f32表 示反步鲁棒补偿控制器的调节参数; 偏航通道的控制律为:U4 = Jz* (-Cl42*e42+f42*W42) - (Jx-Jy) *X14*X24 其中,
Figure CN104932512BC00042
Ψ<1为Ψ角度 的参考信号,也为Ψ<ι的导数,免2为虚拟输入,Ct4JPa42表示反步鲁棒补偿控制器的调节参 数,f 42表示反步鲁棒补偿控制器的调节参数; 滚转通道的控制律为:U2 = Jx* (_ai4*ei4+fl4*W14) - (Jy-Jz) *X24*X42 其中
Figure CN104932512BC00043
Φ d为滚转角的参考信号,a i 2、f i 2、a 2 2和f 2 2为反步鲁棒补偿控制器的调节参数,
Figure CN104932512BC00044
为虚拟输入, ":2 =.½ -为虚拟输入,么为Φ<!的导数,為4为虚拟输入,Ct13和Q14表示反步鲁棒补偿控 制器的调节参数,f14表示反步鲁棒补偿控制器的调节参数; 俯仰通道的控制律为:U3 = Jy* (-Cl24*e24+f24*W24) - (Jz-Jx) *X14*X42 其中
Figure CN104932512BC00045
I
Figure CN104932512BC00046
为 俯仰角的参考信号,a I 2、f I 2、a 2 2和f 2 2为反步鲁棒补偿控制器的调节参数,
Figure CN104932512BC00047
为虚拟输入, e22 =X22 -i22,i22为虚拟输入,是为0<!的导数,i24为虚拟输入,a23和a24表示反步鲁棒补偿控 制器的调节参数,f24表示反步鲁棒补偿控制器的调节参数。
7.根据权利要求1所述的方法,其特征在于,还包括:在实践工程中,对四旋翼飞行器机 载的传感器采集的四旋翼飞行器的飞行信息进行滤波融合处理; 所述对四旋翼飞行器机载的传感器采集的四旋翼飞行器的飞行信息进行滤波融合处 理包括: 通过四旋翼飞行器机载的传感器采集四旋翼飞行器的飞行信息; 通过低通滤波器对采集的四旋翼飞行器的飞行信息进行低通滤波处理,其中,所述低 通滤波器是结合实践工程中的四旋翼飞行器确定的; 通过卡尔曼滤波器冗余机制对不同传感器采集的隐含同类型的经过低通滤波处理后 的飞行信息进行数据融合,得到目标观测信息; 其中,数据融合包括:陀螺仪传感器、加速度计传感器,磁力计传感器、GPS传感器、超声 波传感器、气压计传感器采集的并经过低通滤波后的信息,及建立在此基础上的角速度、欧 拉角内环信息、速度、位置外环信息。
8. 根据权利要求7所述的方法,其特征在于,还包括: 在实践工程中,对确定的反步鲁棒补偿控制算法进行离散化处理,离散化程度由反步 鲁棒补偿控制器的控制性能和传感器的采样频率决定。
9. 根据权利要求1所述的方法,其特征在于,所述根据所述四旋翼飞行器数学模型和四 旋翼飞行器模型的不确定性、外界干扰、欠驱动、强耦合特性,对所述四旋翼飞行器模型进 行分析解耦,确定基于内外环控制的反步鲁棒补偿控制器之后包括: 在理论研究阶段,根据确定的反步鲁棒补偿控制器,建立四旋翼飞行器仿真模型,并调 节反步鲁棒补偿控制器的调节参数,直至控制性能满足控制性能要求,对基于反步鲁棒补 偿控制器的四旋翼飞行器仿真模型进行初步验证,其中,所述控制性能包括:响应时间、超 调、抗干扰能力; 在实践工程中,对基于反步鲁棒补偿控制器的四旋翼飞行器的实际飞行效果进行后期 验证。
CN201510355319.0A 2015-06-24 2015-06-24 一种基于mimo非线性不确定反步法的四旋翼位姿控制方法 CN104932512B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510355319.0A CN104932512B (zh) 2015-06-24 2015-06-24 一种基于mimo非线性不确定反步法的四旋翼位姿控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510355319.0A CN104932512B (zh) 2015-06-24 2015-06-24 一种基于mimo非线性不确定反步法的四旋翼位姿控制方法

Publications (2)

Publication Number Publication Date
CN104932512A CN104932512A (zh) 2015-09-23
CN104932512B true CN104932512B (zh) 2017-07-04

Family

ID=54119716

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510355319.0A CN104932512B (zh) 2015-06-24 2015-06-24 一种基于mimo非线性不确定反步法的四旋翼位姿控制方法

Country Status (1)

Country Link
CN (1) CN104932512B (zh)

Families Citing this family (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105607640B (zh) * 2016-01-20 2018-02-09 南京工业大学 四旋翼飞行器的位姿控制器
CN106200666A (zh) * 2016-08-31 2016-12-07 佛山市安尔康姆航空科技有限公司 无人飞行器飞行控制方法
CN107975519B (zh) * 2016-10-21 2020-07-28 北京精密机电控制设备研究所 一种伺服液压能源双闭环控制系统及方法
WO2018086087A1 (zh) * 2016-11-14 2018-05-17 钟玲珑 无人飞行控制系统
US10093415B1 (en) * 2017-03-20 2018-10-09 Bell Helicopter Textron Inc. System and method for rotorcraft heading control
CN106970646B (zh) * 2017-05-23 2020-12-01 四川理工学院 基于自适应积分反步的四旋翼飞行器控制方法
CN107844123B (zh) * 2017-10-11 2021-03-02 中国空气动力研究与发展中心计算空气动力研究所 一种非线性飞行器航迹控制方法
CN107807522A (zh) * 2017-10-17 2018-03-16 西北工业大学 水下机器人轨迹跟踪反步控制方法
CN107957730B (zh) * 2017-11-01 2020-02-18 华南理工大学 一种无人飞行器稳定飞行控制方法
CN108181919B (zh) * 2018-01-11 2020-11-03 哈尔滨模豆科技有限责任公司 一种基于卡尔曼滤波的小型运输器姿态控制方法
CN108196561A (zh) * 2018-01-18 2018-06-22 北京航空航天大学 一种无人飞行器的鲁棒抗风扰位置控制方法和装置
CN109062242B (zh) * 2018-10-25 2021-03-16 国网四川省电力公司电力科学研究院 一种新的旋翼无人机控制方法
CN109976150B (zh) * 2018-11-28 2020-12-18 中南大学 一类欠驱动多输入多输出系统的集中式自抗扰控制方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
RU2380277C1 (ru) * 2008-06-25 2010-01-27 Государственное образовательное учреждение высшего профессионального образования "Иркутское высшее военное авиационное инженерное училище (военный институт)" Министерства обороны Российской Федерации Крыло самолета
CN102880060A (zh) * 2012-10-25 2013-01-16 北京理工大学 再入飞行器自适应指数时变滑模姿态控制方法
CN103217981A (zh) * 2013-04-18 2013-07-24 东南大学 一种基于积分变结构控制的四旋翼飞行器速度控制方法
CN104102225A (zh) * 2014-06-27 2014-10-15 金陵科技学院 基于执行器动态的无人飞行器姿态分散式容错控制方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
RU2380277C1 (ru) * 2008-06-25 2010-01-27 Государственное образовательное учреждение высшего профессионального образования "Иркутское высшее военное авиационное инженерное училище (военный институт)" Министерства обороны Российской Федерации Крыло самолета
CN102880060A (zh) * 2012-10-25 2013-01-16 北京理工大学 再入飞行器自适应指数时变滑模姿态控制方法
CN103217981A (zh) * 2013-04-18 2013-07-24 东南大学 一种基于积分变结构控制的四旋翼飞行器速度控制方法
CN104102225A (zh) * 2014-06-27 2014-10-15 金陵科技学院 基于执行器动态的无人飞行器姿态分散式容错控制方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
小型无人直升机的建模与控制器设计;周洪波;《中国博士学位论文全文数据库 工程科技II辑》;20111215(第12期);第C031-7页 *

Also Published As

Publication number Publication date
CN104932512A (zh) 2015-09-23

Similar Documents

Publication Publication Date Title
Zhao et al. Nonlinear robust adaptive tracking control of a quadrotor UAV via immersion and invariance methodology
Choi et al. Nonlinear control of quadrotor for point tracking: Actual implementation and experimental tests
Liu et al. Quaternion-based robust attitude control for uncertain robotic quadrotors
Hoffer et al. A survey and categorization of small low-cost unmanned aerial vehicle system identification
Hoffmann et al. Quadrotor helicopter flight dynamics and control: Theory and experiment
CN106873611B (zh) 一种多通道线性自抗扰控制器的设计方法
CN102692225B (zh) 一种用于低成本小型无人机的姿态航向参考系统
Lupashin et al. Stabilization of a flying vehicle on a taut tether using inertial sensing
Lee et al. Adaptive image-based visual servoing for an underactuated quadrotor system
Mahony et al. Dynamic image-based visual servo control using centroid and optic flow features
Mettler Identification modeling and characteristics of miniature rotorcraft
Ahmed et al. Flight control of a rotary wing UAV using backstepping
Paw Synthesis and validation of flight control for UAV.
CN103611324B (zh) 一种无人直升机飞行控制系统及其控制方法
Mettler et al. System identification of small-size unmanned helicopter dynamics
Guenard et al. A practical visual servo control for an unmanned aerial vehicle
Mettler et al. System identification modeling of a small‐scale unmanned rotorcraft for flight control design
Sharf et al. Ground effect experiments and model validation with Draganflyer X8 rotorcraft
CN106933104B (zh) 一种基于dic-pid的四旋翼飞行器姿态与位置的混合控制方法
US6922618B2 (en) System and method for kinematic consistency processing
Mahony et al. Nonlinear complementary filters on the special orthogonal group
Bryson et al. Vehicle model aided inertial navigation for a UAV using low-cost sensors
Smeur et al. Cascaded incremental nonlinear dynamic inversion for MAV disturbance rejection
CN107608367B (zh) 多变量干扰补偿四旋翼无人机轨迹与姿态协同控制方法
Mahony et al. Complementary filter design on the special orthogonal group SO (3)

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant