一种火星阵风强干扰环境下四旋翼飞行器的姿态控制方法技术

本发明专利技术公开了一种火星阵风强干扰环境下四旋翼飞行器的姿态控制方法，通过构建四旋翼飞行器的姿态动力学模型，分析其内在特征，在此基础上设计双环自抗扰非线性控制器，通过内外环的扩张状态观测器，对外部扰动进行补偿，实现四旋翼飞行器对设定好的期望姿态角的精确跟踪，从而完成对四旋翼飞行器姿态的控制。从而完成对四旋翼飞行器姿态的控制。从而完成对四旋翼飞行器姿态的控制。

【技术实现步骤摘要】
一种火星阵风强干扰环境下四旋翼飞行器的姿态控制方法


[0001]本专利技术属于无人机和自抗扰控制
，具体涉及一种火星阵风强干扰环境下四旋翼飞行器的姿态控制方法。

技术介绍

[0002]多旋翼无人机是一种非常灵活的飞行器，由于具有悬停和垂直起飞降落的特殊优势，在军事侦察、农业测绘、航拍等方面都有着广泛的应用。在过去的数十年里，如何对无人机进行有效控制一直是工业界和学术界研究的热点问题。
[0003]目前确定的火星探测科学目标主要包括确定火星上是否存在生命、了解火星气候的演变过程和历史及了解火星作为一个地质系统的起源和演化等。即便人类已经用了半个多世纪来探测火星、研究宇宙，但就目前的探测水平来看，还远远达不到对火星探测清晰明了的程度。
[0004]火星表面飞行条件恶劣、流场变化剧烈等特点对无人机性能指标要求苛刻，为保证火星无人机完成火星探测任务，亟需解决无人机无GPS条件下的飞行控制与导航以及无人机的系统集成等技术难题。在旋翼式火星无人机的飞行控制中，稀薄的火星大气会导致无人机旋翼升力随旋翼转速变化的幅度远小于在地球环境的变化幅度，因而火星无人机的飞行姿态调整过程会非常迟缓。然而火星风、尘暴等现象会严重影响火星无人机飞行的稳定性，这就要求火星无人机针对环境的变化能够做出快速调整以保证无人机的飞行安全。目前旋翼式火星无人机的控制主要是通过调整翼端路径平面(Tip path plane，TPP)与无人机质心的相对位置，来实现火星无人机的转向控制与姿态调整。
[0005]特别是四旋翼飞行器因其具有体积小、机械设计简单、飞行操作便捷等特点更是受到了多个行业的广泛关注。然而，四旋翼飞行器是一个具有强耦合和欠驱动特性的非线性系统，它具有六个自由度，但仅具有四个控制输入；同时由于其体积和重量较小，导致阵风等外部干扰对它产生的影响较大。因此，设计一种针对四旋翼系统稳定姿态的可靠控制策略是一项颇具挑战的工作。

技术实现思路

[0006]有鉴于此，本专利技术提供了一种火星阵风强干扰环境下四旋翼飞行器的姿态控制方法，实现了在模拟的火星阵风强干扰环境下对四旋翼飞行器的姿态控制。
[0007]本专利技术提供的一种火星阵风强干扰环境下四旋翼飞行器的姿态控制方法，包括以下步骤：
[0008]步骤1、建立四旋翼飞行器的姿态动力学模型；
[0009]步骤2、构建外环控制器和内环控制器，其中，外环控制器包括外环非线性扩张状态观测器和外环非线性控制器，内环控制器包括内环非线性扩张状态观测器和内环非线性控制器；
[0010]步骤3、实际控制中，外环非线性扩张状态观测器以外环非线性控制器输出的角速
度期望值和四旋翼飞行器输出的角度反馈值为输入，计算得到输出的状态估计值外环非线性控制器以直接输入的期望角度、四旋翼飞行器输出的角度以及状态估计值为输入，计算得到角速度期望值v
j
作为输出；内环非线性扩张状态观测器以四旋翼飞行器输出的角速度反馈值和内环非线性控制器输出的控制量为输入，计算得到输出的状态估计值内环线性控制器以外环控制器输出的角速度期望值、四旋翼飞行器输出的角速度反馈值及内环非线性扩张状态观测器输出的状态估计值为输入，计算得到输出的四旋翼飞行器的控制量u
i
；将控制量u
i
输入到四旋翼飞行器的姿态动力学模型中实现对四旋翼飞行器的控制。
[0011]进一步地，所述步骤2中的外环非线性扩张状态观测器的构造形式如下所示：
[0012][0013]其中，y1＝η＝[φ,θ,ψ]T
＝[y
1j
]3×1∈R3×1,j＝φ,θ,ψ和y2＝[y
2j
]3×1∈R3×1,j＝φ,θ,ψ分别表示外部扰动值，φ为四旋翼飞行器的俯仰角，θ为四旋翼飞行器的滚转角，ψ为四旋翼飞行器的偏航角，和分别表示y1和y2所对应的状态估计值，v
j
表示外环非线性控制器的输出值，为状态估计值的一阶导数值，为状态估计值的一阶导数值，β
1j
和ε
1j
均为正的可调节的常数，为非线性函数其表达式为：
[0014][0015]其中，σ为正的可调节常数。
[0016]进一步地，所述外环非线性控制器的构造形式如下所示：
[0017][0018]其中，e
η
＝η
‑
η
d
＝[e
ηj
]3×1∈R3×1,j＝φ,θ,ψ为俯仰角、滚转角和偏航角的误差值；k
0j
,k
1j
,k
2j
均为正常数；为可调整的正常数；v
j
为外环非线性控制器输出的角速度期望值。
[0019]进一步地，所述内环非线性扩张状态观测器的构造形式如下所示：
[0020][0021]其中，α
1i
、α
2i
和ε
0i
均为非负常数，为非线性函数，和分别为x
1i
和x
2i
两个状态的估计值，b
i
为各通道转动惯量的倒数，p,q,r为四旋翼飞行器在机体坐标系下的角速
度。
[0022]进一步地，所述内环非线性控制器的构造形式如下所示：
[0023][0024]其中，e
Ω
＝ω
‑
ω
r
＝[e
ωi
]3×1∈R3×1为三个通道角速度的误差值，k
pi
,k
di
,k
Ni
分别为比例项、微分项和非线性项的正常数，为各通道转动惯量的倒数，为非线性函数。
[0025]有益效果：
[0026]本专利技术通过构建四旋翼飞行器的姿态动力学模型，分析其内在特征，在此基础上设计双环自抗扰非线性控制器，通过内外环的扩张状态观测器，对外部扰动进行补偿，实现四旋翼飞行器对设定好的期望姿态角的精确跟踪，从而完成对四旋翼飞行器姿态的控制。
附图说明
[0027]图1为本专利技术提供的一种火星阵风强干扰环境下四旋翼飞行器的姿态控制方法的控制示意图。
具体实施方式
[0028]下面结合附图并举实施例，对本专利技术进行详细描述。
[0029]自抗扰控制技术具有处理系统内部的未知动态和外部扰动等广泛问题的能力，已经成为控制工程中的一项新兴技术。自抗扰控制器由跟踪微分器、扩张状态观测器和非线性控制律组成，其中，扩张状态观测器是整个控制器中最重要的部分，它通过系统的输出估计系统的状态。因此，在模拟火星的强阵风干扰情况下，将自抗扰控制技术应用于四旋翼姿态系统中，将有助于抵抗外部具有不确定性的干扰对四旋翼飞行器飞行效果的影响，从而实现无人机的稳定飞行。
[0030]基于上述考虑，本专利技术提供了一种火星阵风强干扰环境下四旋翼飞行器的姿态控制方法，其核心思想是：首先将期望的姿态角输入四旋翼飞行器，然后通过外环角度控本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种火星阵风强干扰环境下四旋翼飞行器的姿态控制方法，其特征在于，包括以下步骤：步骤1、建立四旋翼飞行器的姿态动力学模型；步骤2、构建外环控制器和内环控制器，其中，外环控制器包括外环非线性扩张状态观测器和外环非线性控制器，内环控制器包括内环非线性扩张状态观测器和内环非线性控制器；步骤3、实际控制中，外环非线性扩张状态观测器以外环非线性控制器输出的角速度期望值和四旋翼飞行器输出的角度反馈值为输入，计算得到输出的状态估计值外环非线性控制器以直接输入的期望角度、四旋翼飞行器输出的角度以及状态估计值为输入，计算得到角速度期望值v
j
作为输出；内环非线性扩张状态观测器以四旋翼飞行器输出的角速度反馈值和内环非线性控制器输出的控制量为输入，计算得到输出的状态估计值内环线性控制器以外环控制器输出的角速度期望值、四旋翼飞行器输出的角速度反馈值及内环非线性扩张状态观测器输出的状态估计值为输入，计算得到输出的四旋翼飞行器的控制量u
i
；将控制量u
i
输入到四旋翼飞行器的姿态动力学模型中实现对四旋翼飞行器的控制。2.根据权利要求1所述的姿态控制方法，其特征在于，所述步骤2中的外环非线性扩张状态观测器的构造形式如下所示：其中，y1＝η＝[φ,θ,ψ]
T
＝[y
1j
]3×1∈R3×1,j＝φ,θ,ψ和y2＝[y
2j
]3×1∈R3×1,j＝φ,θ,ψ分别表示外部扰动值，φ为四旋翼飞行器的俯仰角，θ为四旋翼飞行器的滚转角，ψ为四旋翼飞行器的偏航角，和分别表示y1和y2所对应的状态估计值，v
j
表示外环非线性控制器的输出值，为状态估计值的一阶导数值，为状态估计值的一阶导数值，β

【专利技术属性】
技术研发人员：夏元清，王泰祺，田翰文，孙中奇，翟弟华，詹玉峰，戴荔，张元，刘坤，吴楚格，李怡然，邹伟东，崔冰，杨辰，高寒，郭泽华，
申请(专利权)人：北京理工大学，
类型：发明
国别省市：