基于积分反步法的四旋翼飞行器控制设计

郭妍, 吴美平, 唐康华, 王雪莹

【摘要 】针对目前利用反步法设计控制律模型复杂且工程难以实现的问题，提出一种基于积分反步法的四旋翼飞行器控制律设计方法。该方法利用基于李雅普诺夫稳定性理论的反步法控制技术，实现了飞行器位置和姿态的有效跟踪控制，保证了四旋翼飞行控制器的稳定性；进一步分析飞行器模型特性，提出在对姿态控制的反步法设计中加入积分项，并通过设置适当的积分项常数来简化控制律模型，增强控制算法的实用性。仿真实验结果表明，该控制器能够无误差地实现姿态跟踪、定点到达和轨迹跟踪。

【关键词】   欠驱动四旋翼飞行器;  李雅普诺夫稳定性;  积分项;  反步法

引用格式 郭妍, 吴美平, 唐康华, 王雪莹.基于积分反步法的四旋翼飞行器控制设计. 智能科学与技术学报[J], 2019, 1(2):  133-139

Integral back-stepping algorithm for designing the quadrotor aircraft controller

GUO Yan, WU Meiping, TANG Kanghua, WANG Xueying

Abstract In view of the problem that the back-stepping algorithm control model is complex and physically difficult to realize,a method of integral back-stepping algorithm for the under-actuated quadrotor aircraft was proposed in this paper.The back-stepping technique based on the Lyapunov stability theory was used to realize the effective tracking control of position and attitude,and ensure the stability of the quadrotor aircraft controller.In order to simplify the controller model,it is proposed to add the integral term in the process of the back-stepping attitude controller design according to the characteristics of the aircraft model,and set the appropriate integral term constant to reduce the burden of the controller and to enhance the practicability of the control algorithm.The controller can realize the stabilization of each attitude,the fixed point,the trajectory track of the position and yaw without error.

Keywords：  the under-actuated quadrotor aircraft ;  Lyapunov stability ;  the integral term ;  the back-stepping algorithm

Citation GUO Yan.Integral back-stepping algorithm for designing the quadrotor aircraft controller. Chinese Journal of Intelligent Science and Technology[J], 2019, 1(2):  133-139

1 引言

四旋翼飞行器通过电机带动螺旋桨旋转，能够完成垂直起降、定点悬停等行为动作，且其操作简易，因此备受青睐^[1,2,3,4]。但是，四旋翼飞行器的强非线性、强耦合性和欠驱动性，使得其控制方法偏难、控制模型复杂，因此一直是国内外学者研究的重点和难点^[5]。

传统的PID（比例（proportion）、积分（integral）、微分（differential））控制算法原理简单，但是控制参数很难随着环境的变化进行自我调节^[6,7,8,9,10]。文献[11]提出利用神经网络（neural networks）的自学习能力对PID控制参数进行实时优化，但是该方法的实时性较差，这是因为控制参数的自学习过程需要时间。文献[12]在文献[11]的基础上，加入了自适应环节来提高系统的收敛速度，解决了实时性差的问题。但是，加入神经网络辅助的PID控制算法复杂度较高，在工程上难以实现。

反步法在四旋翼飞行器系统控制设计中越来越多地受到重视，但是存在虚拟控制量表达形式复杂，以及控制算法设计复杂和物理实现困难的问题^{[13,14,15,16]}。本文提出了一种基于积分反步法（integral back- stepping algorithm）的四旋翼飞行器控制律设计方法。该方法先对四旋翼飞行器进行数学建模，并利用基于李雅普诺夫（Lyapunov）稳定性理论的反步法实现了飞行器位置和姿态的有效跟踪控制，同时在对姿态控制的反步法设计中加入了积分项，并通过设置适当的积分项常数来简化控制器模型。仿真实验验证，该控制器能够无误差地实现姿态跟踪、定点到达和轨迹跟踪。

2 四旋翼飞行器模型的简化

四旋翼飞行器的非线性数学模型可以简化为

其中，(x,y,z)和(φ,θ,ψ)分别为机体的位置坐标和姿态信息，m为机体的质量，I为桨叶中心到机体中心的距离，J_x、J_y和J_z分别为机体围绕x、y、z轴旋转的转动惯量，u_i(i=1,2,3,4)为模型控制输入。

令

则可将式（1）拆分成针对姿态控制的转动子系统S₁和针对位置控制的平动子系统S₂，即

3 基于积分反步法的控制律设计

由式（1）可知，四旋翼飞行器控制研究问题是一个欠驱动控制问题，下面将对其进行具体分析。

3.1 四旋翼飞行器的姿态控制

从式（3）可以看出，四旋翼飞行器的姿态φ、θ和ψ可分别由u_i(i=1,2,3)来控制。

（1）横滚角的控制

首先定义横滚角跟踪误差为

3.3 总体控制流程

综合上述分析可得，基于积分反步法的四旋翼飞行器总体控制流程如图1所示。

图1   四旋翼飞行器的总体控制流程

4 仿真结果与性能分析

本文中的实验四旋翼飞行器的主要参数见表1。

4.1 四旋翼飞行器的姿态镇定仿真实验

选取机体姿态的初始状态和目标状态分别为(ϕ₀,θ₀,ψ₀)=(45^∘,30^∘,60^∘)，ϕ_d=θ_d=ψ_d=0^∘，仿真时间为20 s。

图2给出了控制模型简化前、后飞行器各姿态角随时间变化的过程。从图中可以看出，横滚角、俯仰角和偏航角都能在各自控制器的作用下在较短时间内迅速、无稳态误差地收敛至期望的目标姿态角。不同的是，控制模型简化后的控制器由于利用积分项参数调节的方式降低了姿态控制力度，其收敛时间（4s）要略长于控制模型简化前的收敛时间（2s）。

表2给出了四旋翼飞行器在简化前、后的各姿态控制器作用下各步的运算耗时，可以看出，利用积分项简化后，控制模型各步的运行时间较短。

图2和表2说明了本文提出的以积分项参数调节的方式来简化姿态控制模型的方案是可行的，可将其应用到飞行器定点到达和轨迹跟踪的仿真实验中。

4.2 四旋翼飞行器的定点到达仿真实验

下面的实验是为了验证简化后的积分反步法控制器可实现飞行器的定点到达。选定四旋翼飞行器的初始平衡点和目标状态分别为

其中，位置和速度的单位分别为 s 和 m/s，仿真时间为60 s。

图3给出了四旋翼飞行器各位置信息随时间变化的曲线。从图中可以看出，简化后的积分反步法控制器可使飞行器最终到达期望的位置定点。

 图4给出了四旋翼飞行器各姿态角随时间变化的曲线。可以看出，横滚角和俯仰角虽然在简化后的控制器作用下最终都能收敛到一个稳定值，但是其振荡幅值较大且相比于偏航角收敛速度较慢。这是因为期望偏航角是事先设置的，是一个稳定的值，但期望的横滚角和俯仰角是按照无人机的其他参数实时获取的，是不确定的参数，故相对于其他两个姿态角的跟踪过程，偏航角的振荡幅值更小，收敛时间更短。

4.3 四旋翼飞行器的轨迹跟踪仿真实验

下面的实验是为了验证简化后的积分反步法控制器可实现飞行器的轨迹跟踪。选定四旋翼飞行器在平衡点处，即(x₀,y₀,z₀)=(1,1,0)，ϕ₀=θ₀=ψ₀=0^∘。将跟踪轨迹设定为x_d=0.4sin t， y_d=0.5sin t，z_d=0.3sin t，ψ_d =30 sin t。位置、速度的单位分别为s、m/s，仿真时间为100 s。

图5,图6,图7给出了在简化后的控制器作用下四旋翼飞行器的实际飞行位置和期望位置及其偏差曲线。可以看出，简化后的飞行器能较好地跟踪期望轨迹，并且其水平位置和高度位置能分别在10 s和40 s内无误差地稳定跟踪。

图8至图9给出了在简化后的控制器作用下四旋翼飞行器各姿态角随时间变化的曲线。可以看出，简化后的控制器能够使偏航角快速地跟踪上期望的正弦路线，且不会产生稳定的误差；同时，虽然没有给定规则的期望横滚角和俯仰角，但水平位置的稳定会使横滚角和俯仰角形成一个稳定的轨迹。

综合上述实验结果可知，基于积分反步法的四旋翼飞行器控制设计能实现位置和姿态的有效控制。

5 结束语

本文提出了一种基于积分反步法的飞行控制律设计方法。利用反步法的李雅普诺夫稳定性理论，保证了飞行器PID控制器的稳定性，同时鉴于姿态控制子系统的完全驱动特性，通过加入积分项和设置合理的积分项参数等，达到简化控制器模型的目的。仿真实验结果表明，简化后的积分反步法四旋翼飞行器控制设计能够无误差地实现其各姿态跟踪、定点达到、位置与偏航角的轨迹跟踪。