[发明专利]一种基于改进自抗扰控制的四旋翼姿态控制方法

说明书

本发明提供了一种基于改进自抗扰控制的四旋翼姿态控制方法，针对四旋翼无人飞行器的工作原理，建立四旋翼姿态角的数学模型，得到四旋翼无人飞行器的动态耦合模型，然后同时考虑作用在四旋翼无人飞行器的外部扰动，对动态耦合进行解耦处理；根据分离定理和解耦后的四旋翼姿态角数学模型，设计改进的自抗扰控制器组合，通过输入四旋翼无人飞行器的实时姿态角，所述改进的自抗扰控制器组合输出下一刻四旋翼无人飞行器的姿态角控制输出，用来使四旋翼无人飞行器沿着既定的轨迹进行飞行。本发明的有益效果是：提高了四旋翼无人飞行器的抗干扰能力和飞行精度。

技术领域

本发明涉及无人机领域，尤其涉及一种基于改进自抗扰控制的四旋翼姿态控制方法。

背景技术

近年来，四旋翼无人飞行器的姿态控制研究受到了众多科技公司以及高校的广泛关注。四旋翼无人飞行器是一种具有四个控制输入和六个控制输出的欠驱动旋翼式直升机，它作为旋翼类无人机的典型，具有机械结构简单、垂直起降、空中悬停、机动灵活的优点，被广泛的应用于民用和军事等领域。在民用领域，四旋翼无人飞行器可用于监视、勘探测绘、电力巡检和维护、物体捕获等任务，有效的提高了工作效率以及降低了人工作业的风险；在军事领域，四旋翼无人飞行器可用于情报获取、低空军事侦察、目标精准打击和火力支援等危险任务的执行。另一方面，由于四旋翼无人飞行器系统模型具有非线性、欠驱动、强耦合以及静不稳定的动态特性，给控制器的设计带来了巨大的挑战。目前，针对四旋翼的姿态控制，主要的控制方法有PID控制、反步法控制、滑模控制、自适应控制等，这些研究方法虽然都已经取得了一定的进展，但对模型的依赖程度较高，并且抗干扰能力较差。

自抗扰控制技术(active disturbance rejection control,ADRC)由韩京清教授提出，它不依赖于精确的系统模型，而是一种依靠过程误差来消除误差的方法，具有响应速度快、控制精度高、抗干扰能力强、算法简单且易于实现等优点，可以比较有效的解决复杂不确定系统的控制问题。经典的ADRC由跟踪微分器、扩张状态观测器和非线性误差反馈三部分组成。该控制器通过跟踪微分器为指令安排过渡过程；利用扩张状态观测器对作用于系统的“总扰动”进行估计，并依据估计值进行动态补偿，消除扰动对控制系统的影响；最后，通过非线性状态误差反馈控制律计算得出控制量。但是传统ADRC中的扩张状态观测器为李雅普诺夫渐近稳定以及存在收敛速度不能保证的缺点。

发明内容

为了解决上述问题，本发明提供了一种基于改进自抗扰控制的四旋翼姿态控制方法，通过设计高阶滑模观测器代替经典ADRC中的扩张状态观测器，将滚动、偏航和俯仰通道间的动态耦合部分视为内部干扰，同时考虑作用在四旋翼系统上的外部扰动，对内部扰动与外部扰动构成的“总扰动”进行动态估计与补偿，并采用新的非线性函数对传统ADRC的非线性反馈控制构造进行改进。改进后的自抗扰控制器克服了传统ADRC中扩张状态观测器存在的缺点，使得抗干扰能力强，能够更好的实现四旋翼无人飞行器的轨迹跟踪控制。一种基于改进自抗扰控制的四旋翼姿态控制方法，主要包括以下步骤：

S1：针对四旋翼无人飞行器的工作原理，建立四旋翼姿态角的数学模型，得到四旋翼无人飞行器的横滚通道、俯仰通道和偏航通道的动态耦合；

S2：以上述横滚通道、俯仰通道和偏航通道的动态耦合作为四旋翼无人飞行器的内部扰动，同时基于四旋翼无人飞行器受到的外部扰动，对上述动态耦合进行解耦处理；

S3：根据分离定理和解耦后的四旋翼姿态角数学模型，设计改进的自抗扰控制器组合，所述改进的自抗扰控制器组合包括横滚通道、俯仰通道和偏航通道的控制器，由3个改进的自抗扰控制器组成，每个改进的自抗扰控制器由跟踪微分器、高阶滑模观测器和非线性误差反馈控制律三部分组成；

S4：通过输入四旋翼无人飞行器的实时姿态角，所述改进的自抗扰控制器组合输出下一刻四旋翼无人飞行器的姿态角控制输出，用来使四旋翼无人飞行器沿着既定的轨迹进行飞行。

进一步地，所述四旋翼姿态角的数学模型为