一种采用串级自抗扰控制技术的四旋翼飞行器悬停控制方法
【技术领域】
[0001] 本发明应用于无人机控制领域，设及到四旋翼飞行器的悬停控制问题，尤其是如 何消除系统内部参数摄动和存在外部干扰扰动对四旋翼飞行器悬停控制系统性能的影响， 实现一种有效的实时控制方法。
【背景技术】
[0002] 四旋翼飞行器是四奖非共轴多旋翼飞行器的简称。作为非共轴多旋翼飞行器的代 表，与固定翼无人机相比，具有结构简单、体积小、隐蔽性强、载荷高、可垂直起降、定点悬停 和低速飞行等优势，能执行各种危险的特殊任务，比如航拍、灾害现场监视与求援、低空侦 探与检测等，在民用领域和军事领域均体现出极高的研究和应用价值。
[0003] 本发明主要考虑如何降低甚至消除系统内部参数摄动和存在外部干扰扰动对四 旋翼飞行器悬停控制系统性能的影响。针对四旋翼飞行器悬停控制问题，目前使用的方法 主要有PID控制、反步控制、嵌套饱和控制等。基于PID的四旋翼飞行器悬停控制器将控制 系统分为几个独立的通道，分别设计相应的PID控制算法，该方法具有控制技术成熟、易于 实现的特点，但是其抗干扰性较差，如环境改变即要重新调整参数。基于反步法的四旋翼飞 行器悬停控制器通过系统的状态方程设计虚拟控制，构造合适的Lyapunov函数来求控制 律，具有良好的跟踪性能、且具有无超调、调节时间快的优点，但是该方法针对满足严格反 馈控制结构的系统，对系统要求高。基于嵌套饱和的四旋翼飞行器悬停控制具有计算量小、 鲁椿性强和全局渐近稳定的优点，但是应用该方法需要将四旋翼动力学模型转化为严格的 前馈级联结构，而针对四旋翼飞行器该种欠驱动系统只能局部反馈线性化，不能完全反馈 线性化。
【发明内容】
[0004] 本发明要克服上述提到的现有控制方法的局限性，采用串级自抗扰技术设计四旋 翼飞行器悬停控制策略，可W有效地将系统的模型不确定性和系统内外部扰动估计用扩张 状态观测器实时估计并补偿，此方法对系统内外扰动W及模型不确定性均具有很强的抑制 能力。
[0005] 本发明解决其技术问题所采用的技术方案：
[0006] 一种采用串级自抗扰控制技术的四旋翼飞行器悬停控制方法，包括W下步骤：
[0007] 步骤1)建立四旋翼飞行器的动力学模型：
[0008] 四旋翼飞行器是一个多变量、高禪合、非线性的欠驱动系统，要对其设计控制器， 首先要建立合理而准确的动力学模型。四旋翼飞行器的飞行姿态由S个角度（如钟描 述，飞行位置由（x，y，z)描述。根据欧拉及牛顿定理建立小型四旋翼飞行器的动力学模型 为
[0009]
【主权项】
1. 一种采用串级自抗扰控制技术的四旋翼飞行器悬停控制方法，包括以下步骤： 步骤1)建立四旋翼飞行器的动力学模型： 四旋翼飞行器的飞行姿态由三个角度以,久炉)描述，飞行位置由（x，y，z)描述；根据欧 拉及牛顿定理建立小型四旋翼飞行器的动力学模型为
其中，m为四旋翼飞行器的质量，1为四旋翼的旋翼臂展，Ixx、Iyy、Izz分别为X轴、y轴 和z轴的惯量，Ωρ Ω2、Ω#Ρ Ω 4为螺旋桨的角速度，b是推力系数，d是阻力系数； 选择状态向量X为
则将（1)表示为状态空间模型为
步骤2)设计串级ADRC控制器，过程包括： 根据其建模动力学方程双回路、多子系统的结构的特点，可以将悬停控制器设计为串 级结构，内环为姿态环，外环为位置环； 2. 1)外环控制器设计； 四旋翼飞行器的外环为位置环，外环控制分为3个独立的回路，分为X轴控制回路、y轴 控制回路和z轴控制回路；自抗扰控制器由跟踪控制器、扩张状态观测器、线性状态误差反 馈； (211) 跟踪微分器，用来安排过渡过程，给定信号Vtl作为参考输入
其中，参数A为跟踪微分器的快速因子； (212) 扩张状态观测器，对系统的状态和扰动进行实时估计与补偿
其中，βΜ、β%、^ci3为一组待整定的参数，参数的选取可以通过极点配置取β i= 3ω〇，β2=3ω 〇2，β3= ω 〇3; (213)状态误差反馈控制律；
其中，1^和1^分别为比例和微分系数，可以通过极点配置取1^=?。2，1^=2?。； 2. 2)内环控制器的设计； 四旋翼飞行器的内环为姿态环，分为3个独立的控制回路，横滚角控制回路、俯仰角控 制回路和偏航角控制回路； 自抗扰控制器包括跟踪微分器、扩张状态观测器、状态误差反馈控制律三部分，其设计 过程如下： (221) 安排过渡过程，给定信号Vtl作为参考输入
其中，fhan(e，v2, 为最速跟踪控制综合函数，参数Γ(ι为跟踪微分器的快速因子， 参数b为跟踪微分器的滤波因子，h为积分步长； (222) 扩张状态观测器，对系统的状态和扰动进行实时估计与补偿，
其中，fal(e，0.25, δ)为非线性函数，δ、βαι、βα2、0。3为一组待整定的参数； (223) 状态误差反馈控制律
其中，参数C为阻尼因子，fhan(ei，ce2，r，h)为最速跟踪控制综合函数，其表达式为
【专利摘要】一种采用串级自抗扰控制技术的四旋翼飞行器悬停控制方法，包括以下步骤：1)根据欧拉及牛顿定理建立四旋翼飞行器的动力学模型，并解耦为双回路、多子系统的结构；2)其次，根据四旋翼飞行器系统的自身结构特点，设计串级自抗扰控制器，为获取较好的内环输入信号，对外环设计线性ADRC控制器；同时，设计内环非线性ARDC控制器以获得更好的跟踪性能；3)针对系统内部参数摄动和存在外部干扰等不确定性，引入扩张状态观测器对系统的状态和内外扰动进行实时估计，并利用非线性误差反馈控制率进行补偿，消除了内外扰动的影响。本发明对针对四旋翼飞行器系统内部参数摄动和存在外部干扰等不确定性均具有很强的抑制能力。
【IPC分类】G05B13-04, G05D1-10
【公开号】CN104865968
【申请号】CN201510192441
【发明人】张丹, 叶孝璐, 肖紫阳
【申请人】浙江工业大学
【公开日】2015年8月26日
【申请日】2015年4月22日