基于MPC和ESO-DO的四旋翼轨迹跟踪控制.pdf

指挥控制与仿真 （）引用格式：孙嫚憶，毕文豪，张安，等基于 和 的四旋翼轨迹跟踪控制指挥控制与仿真，（）：，（）：基于 和 的四旋翼轨迹跟踪控制孙嫚憶，毕文豪，张 安，刁玉豪（西北工业大学，陕西 西安）摘 要：针对扰动作用和模型不确定性下四旋翼无人机精确轨迹跟踪控制问题，提出了一种主动干扰抑制和模型预测控制（，）策略。模型预测控制器通过扩张状态观测器（，）和扰动观测器（，）来估计和补偿干扰，从而实现位置环精确控制。在存在外部干扰和参数不确定性的情况下，通过仿真实验，证明了所提出的方法提高了对建模误差和干扰的鲁棒性，同时实现了对参考轨迹的平滑跟踪。关键词：四旋翼无人机；模型预测控制；扩张状态观测器；扰动观测器；轨迹跟踪中图分类号：文献标志码：，（，）：（）（）（），：；收稿日期：修回日期：基金项目：国家自然科学基金项目（，）资助课题作者简介：孙嫚憶（），女，硕士研究生，研究方向为无人机控制。毕文豪（），男，博士，副研究员。近年来，在机器人领域，多旋翼特别是四旋翼飞行器正在迅速普及，四旋翼飞行器已经成为机器人研究的标准平台，由于其控制简单，质量轻巧，反应敏捷，被全球大学、企业和科研单位持续关注，广泛应用在国防和国民经济建设的各个领域。在军用方面，可用于执行空中预警、目标侦察与打击和电子干扰等战术任务；在民用领域，可用于农林植保、森林防火、三维测绘、油气管道勘探等各个方面。四旋翼无人机系统是一个强耦合、欠驱动的非线性系统，其控制问题是研究的热点。近年来相关的控制方法有很多，如 控制法、反步法、滑模控制、控制、自适应控制等。等提出了用非线性 控制器来实现四旋翼的轨迹跟踪，利用 函数证明了闭环控制系统的有界性，在确保跟踪期望位置、姿态准确的情况下，确定了增益调整准则，仿真证明了该控制方法的有效性。等采用了三个二阶滑模控制器（超扭滑模控制器，改进的超扭滑模式控制器和非奇异终端超扭滑模态控制器）来实现四旋翼飞机的高度跟踪，减少了抖振现象，同时保证了系统的鲁棒性。等针对轨迹跟踪过程中存在的外部扰动，利用鲁棒自适应跟踪控制器来补偿扰动，仿真结果表明，该控制器对轨迹跟踪过程中存在的扰动不确定性的情况具有较强的鲁棒性。模型预测控制（，）的机理可以描述为：在每一采样时刻，根据获得的当前测量信息，在线求解一个有限时域开环优化问题，并将得到的控制序列的第一个元素作用于被控对象；在下一个采样时刻，重复上述过程，用新的测量值刷新优化问题并重新求解，在线求解开环优化问题获得开环优化序列是模型预测控制和传统控制方法的主要区别，后者通常是离线求解一个反馈控制律，并将得到的反馈控制律作用于系统。本文针对扰动作用和模型不确定性下四旋翼无人机精确轨迹跟踪控制问题，提出了一种主动干扰抑制和模型预测控制策略，将基于误差的状态空间预测控制策略应用于外环的位置控制。为了获得更好的控制第 期指挥控制与仿真 效果，本文将四旋翼在飞行过程中受到的扰动进行分类，在前馈的位置引入扩张状态观测器（，）和扰动观测器（，）对扰动进行针对性补偿，从而提高了控制器抑制干扰的能力；在存在外部干扰和参数不确定性的情况下，通过仿真实验，证明本方法提高了对建模误差和干扰的鲁棒性，同时实现了对参考轨迹的平滑跟踪。四旋翼无人机动力学模型四旋翼无人机是一个典型的多输入多输出、非线性、强耦合、欠驱动的复杂系统。因此，需要在表征出四旋翼飞行器运动特性的基础上，简化其数学模型。本文以“”型四旋翼为例，假设在地面坐标系 下，飞行器相对于原点的坐标为 ，欧拉角为 ，在机体坐标系 下，飞行器转动的角速度为 ，四旋翼无人机结构如图 所示。图 四旋翼飞行器结构图 四旋翼飞行器的动力学方程可表述为如下形式：（）（），（）式中，为飞行器的质量，为螺旋桨产生的总拉力，、为螺旋桨上产生的力矩，具体表示为 （）（）（）（）（）、分别为四旋翼无人机沿 轴、轴、轴的转动惯量，是电机在产生俯仰和滚转动作的陀螺仪扭矩，可以表示为，（），（），（）其中，（、）表示四个螺旋桨的转速，是推力系数，是扭矩系数，表示飞行器质心到旋翼旋转轴之间的距离，是总惯性矩。基于 的四旋翼轨迹跟踪针对四旋翼飞行过程中所面临的外部干扰、参数不确定性和未建模动力学的情况，本文提出了基于误差模型的状态空间预测控制方法进行轨迹跟踪，控制结构如图 所示。首先，由轨迹生成器模块离线提供平移运动的参考轨迹。从轨迹跟踪的期望路线、及其导数开始，计算参考控制输入、。偏航角期望值单独定义。该轨迹是在以下假设条件下生成的：图 四旋翼飞行器控制结构图 孙嫚憶，等：基于 和 的四旋翼轨迹跟踪控制第 卷 ）四旋翼飞行器不存在外部干扰；）四旋翼飞行器的姿态是稳定的。在提供期望状态轨迹的基础上，提出了一种预测控制器来实现四旋翼外环位置的平移运动。基于误差模型的状态空间预测控制器在状态向量中包含位置误差的积分，以便在考虑实时干扰时实现零稳态误差。位置控制器分为两个阶段。第一阶段中，依据四旋翼的期望高度，求解控制输入 的大小，为螺旋桨产生的总推力。在第二阶段，依据、的大小解算出俯仰角和滚转角的期望值。在这一阶段，控制变量 被视为时变参数。由期望俯仰角、偏航角和滚转角的大小，计算出作用于三个轴上的扭矩输入，从而实现四旋翼的内环稳定。基于误差模型的状态空间预测控制器，根据误差模型，设计两个预测控制器，第一个控制器依据四旋翼的期望高度，求解控制输入 的大小。第二个控制器依据、的大小，解算俯仰角和滚转角的期望值。系统状态可以用向量表示为（），则有：（）（）（）（）（）（）（），其中、是四旋翼质心的线速度，（）、（）、（）是外部扰动。根据式（）可以将四旋翼位置子系统写成如下形式：（）（）（）（）（）（）（）（）（）（）（）（）（）（）（）其中，（）（）（）（）（）（）（）（）（）（）（）（）（）系统（）可以解耦为两个子系统，这两个子系统分别控制 平面和 方向运动。对于 方向的高度子系统，模型如下所示：（）（）（）（）（）（）（）其中，（）（）（）。由轨迹生成器（见图）离线生成期望轨迹。轨迹是时变的，因此本文提出了一种具有与四旋翼相同动力学特性的虚拟参考飞行器。假设虚拟参考飞行器没有外部干扰，参考飞行器的动力学可以用以下形式表示：（）（）（）（）（）其中，（）（）（）。则可以获得控制输入：（）（）（）（）（）通过从位置系统（）减去虚拟系统（），可以得到位置误差模型：（）（）（）（）（）（）（）其中，（）（）（）表示位置误差向量，（）（）表示速度误差，（）（）（）表示控制输入误差。下面设计预测高度控制器，考虑以下形式的标称系统：（）（）（）（）（）（）首先，将状态误差向量定义为（）（）（）（）（）（）（）（）（）将系统离散化，可以得到（）（）（）（）（）是采样时间，通常选择足够小的采样时间，以便更好地获得轨迹跟踪的动态误差。横滚角、俯仰角、偏航角（，）被视为时变参数。设计控制律使得所定义的代价最小：（）（）（）其中 ，是对角正权重矩阵，是预测范围，是控制范围，和 形式如下：（）（），（）（）（）参考矢量为第 期指挥控制与仿真 （）（）（）（）（）（）（）（）（）（）是定义的终端状态代价函数，其具体形式为 （）（）（）（）（）（）（）其中，是终端状态的对角权重矩阵，。预测的系统输出量 （）由标称状态空间模型（）得出，故可得 （）（）（）（）其中，（）（）（）（）（）（）（）（）（）（）为了计算简便，定义作为（）的最后一行：（）（）（）（）所以（）（）将式（）中的 最小化，可以构造如下的控制律，用终端代价函数来加快收敛速度：（）（）（）控制输入，在每一时刻，只将最优控制输入序列的第一分量（）作用于系统。因此，时刻高度系统的控制输入为（）（）（）（）类似地，平面也可以用相同的方法来设计，则平面 的控制律为 （）（）（）（），是对角正权重矩阵。令控制输入，其他矩阵的计算与前面的矩阵类似。因此控制输入可以写成如下形式：（）（）（）（）（）（）（）由式（）可得（）（）（）（）（）（）（）（）（）（）（）（）（）基于 的 四旋翼轨迹跟踪为了提高基于误差模型的状态空间预测控制器的抗干扰能力，在控制器中引入了基于 的前馈补偿。是一种特殊的状态观测器，它不仅估计系统的状态，同时估计由系统的未知动态和外部扰动组成的扩张状态。适当设计的观测器可以提供相对准确的估计，从而在控制输入中进行补偿。本文以 平面为例，提出控制策略框图如图 所示。在高度子系统中，将扩张状态向量定义为 ，代表系统输出量。那么式（）的状态空间形式为 （）其中，（）（）。因此，三阶线性扩张状态观测器（，）可以构造如下：（）（）孙嫚憶，等：基于 和 的四旋翼轨迹跟踪控制第 卷图 平面上基于 的 四旋翼轨迹跟踪结构图 其中，是观测器的状态向量，提供 的估计值，为观测器增益向量，是 的输出估计量。（）是总扰动，包括内部不确定性和外部扰动。以高度控制系统为例，考虑非结构不确定性和参数不确定性，可得到下式：（）（）（）（）（）（）（）（）（）（）（）（）（）（）（）（）其中，是 的不确定参数，（）是非结构不确定性，可能与时刻 和状态量、及其导数有关。（）（）（）（）（）（）（）是总扰动，可以将上述方程转化为式（）。在式（）中，扰动的形式为（）（）。此外，由于本章假设由阵风引起的位置和角加速度的扰动是可微且有界的，所以，此处（）是可微且有界的。其他方向上与此类似。对于观测器（）的设计，对系统信息的唯一要求是确定。然而，在某些情况下，四旋翼的动力学并不完全符合模型（），因此，可以使用估计值代替。实验证明，当（）很小时，控制器仍能正常工作，因此可以将（）视为（）的一部分，由 估计得到。将观测器的带宽定义为 ，观测器的增益可以参数化，得到 ，。定理 对于系统（），如果（）是有界的，根据参数化调整增益，三阶（）是有界输入和有界输出（）稳定的。证明假设估计误差 ，将的取值代入式（）中，与式（）相减，误差方程为 （）其中，。的特征多项式：（）（）（）（）是 稳定的，所有的特征值为，选择适当的，则所有的极点都位于左半平面内足够远的位置，而且 是有上界的，因此，是 稳定的。可以用其他形式设计，只要确保 是 稳定的。上述方法的目的在于简化参数调优过程，这样就只需要 一个参数。通过调整好的观测器，使得 ，。更重要的是，总扰动（）是由 估计的，可以在控制输入中进行补偿，控制输入的形式 表示为（）其中 可以根据式（）计算得到，可以根据式（）计算得到。将式（）代入式（），可得（）（）（）（）（）（）（）（）其中，扰动 （）（）（），这比调整好的 的原始扰动小得多，假设 的估计误差可以忽略，则式（）是与式（）相同形式的系统。此时，可以通过基于 的误差模型的状态空间预测控制方法第 期指挥控制与仿真 进行控制，因为扰动要小得多。对于 通道，计算方法一样，则 通道的控制输入可以写作：（）其中 由式（）计算得到。基于 的 四旋翼轨迹跟踪考虑四旋翼飞行器载荷变化的情况，为了更好地模拟四旋翼飞行状态，本节将四旋翼在飞行过程中的扰动分类处理，加入，如图 所示。的用途是抑制可以被建模为外生系统的扰动，而 可以处理没有任何先验知识的干扰（，）。通过这种方式可以使系统的抗干扰能力得到加强。四旋翼无人机在完成实际任务中受到载荷、风、旋翼阻力、模型不确定性等多种干扰。通常扰动可分为两类：）由外生系统建模引起的扰动（例如周期性扰动和斜率扰动），记为；）导数有界变量的扰动（例如风扰动和模型不确定性），记为（，）。图 基于 的 四旋翼轨迹跟踪 在自然界中，风的干扰是很难准确预测的，特别是它的方向和速度。对于四旋翼无人机来说，如果风的干扰横向侵入，它主要影响无人机的位置。当风向上或向下吹时，则主要影响无人机的姿态，使得无法与质心准确对齐。在大多数情况下，风扰动对四旋翼无人机的影响是前面两种情况的结合，其变化可以认为是有界的。因此，可以认为干扰主要分为两种类型：力干扰部分和扭矩干扰部分。为了方便计算，这部分干扰视为整体，记作（，）。在不丧失一般性的前提下，假设四旋翼无人机所受到的风扰动具有一定的变化，的上界用正标量 表示，即 。定义位置误差和线速度误差为 （）其中，和 是四旋翼无人机的期望轨迹和速度，和 是当前位置和速度。的设计理念类似于状态观测器，可以估计动态系统的不可测状态。则根据 估计 可以得到如下式子：（，），（，）（）（）其中，（，）是 的增益函数，和分别是 和 的估计值，是通过 得到的 的估计值，（），对速度导数 的测量是有噪声的，在实践中使用会带来不必要的影响。为了规避这个问题，引入了辅助状态变量 和辅助函数（，）：（，）（，）（，），（）将式（）代入式（），可得到：（，）（，）（，）（，）（）（，）（）观察器增益（，）与辅助函数（，）的关系为（，）（，），（，）（）仿真分析在本节中，对所提出的控制策略进行仿真，以证明该算法的有效性。模拟中使用的四旋翼飞行器参数如表 所示。表 四旋翼飞行器参数 参数符号物理意义数值四旋翼飞行器的质量 旋翼中心到质心的距离 重力加速度 升力系数 反扭矩系数 轴 轴转动惯量 轴转动惯量 旋翼转动惯量 下面通过悬停控制和轨迹控制两方面的仿真实验，对比基于 的轨迹跟踪控制和基于 的 孙嫚憶，等：基于 和 的四旋翼轨迹跟踪控制第 卷 轨迹跟踪控制两种控制方法的效果（以下简称 和），为了排除姿态环的影响，两种控制方法均采用相同的 控制器控制姿态环。仿真中用到的其他参数如下：，（，），（，）（，），（，）（，），（，）（，），（）其中，上述控制器和观测器的增益可以通过带宽法调参得到：，悬停仿真实验假设飞行器的初始位置为（，），为了验证 的鲁棒性，实验过程在螺旋桨产生的推力中加入如图 所示的信号来模拟外部扰动。图 扰动信号图 图 图 从位置、速度、姿态角三个方面表现四旋翼飞行器从初始位置达到稳定悬停状态的过程。从图 图 可以看出，位置（）使用 控制时调节时间约为 ，的调节时间约为 ；（）、（）的输出几乎没有超调量，调节时间约为 ；两种方法对姿态角的控制效果都比较理想，四旋翼飞行器在 和 的控制下都能较快回到零点，但 明显抗扰动性能要好一些。本节选用均方根误差即 值作为两种控制方法控制精度的比较指标，位置和速度的悬停状态跟踪误差图如图 和 所示，位置和速度的 值如表 所示。由表 可以看出，位置的 值比图 方向跟踪 图 方向跟踪 图 方向跟踪 少 ，速度的 值比 少 。很明显，的跟踪性能更好一些。表 悬停状态 值 位置速度 轨迹跟踪仿真实验本节仿真中给出的参考轨迹为第 期指挥控制与仿真 图 跟踪 图 跟踪 图 跟踪 图 角跟踪 图 角跟踪 图 角跟踪 图 位置均方根误差 图 速度均方根误差 孙嫚憶，等：基于 和 的四旋翼轨迹跟踪控制第 卷 （）为了验证 的鲁棒性，实验过程在螺旋桨产生的推力中加入如图 所示的信号来模拟外部扰动。轨迹跟踪如图 所示，可以看出，两种方法都能较快跟踪上给定轨迹，总体上保持稳定。图 轨迹跟踪图 从图 可以看出，在、三个方向两种控制方法都能较好跟上给定的轨迹；图 可以看出，两种控制方法跟踪效果接近，但 的抗扰性能明显优于。图 方向跟踪 位置和速度的轨迹跟踪误差图如图 和 所示，位置和速度指标如表 所示，由表 可以看出，位置的 值比 少 ，速度的 值比 少 。对此 值可以看出，的跟踪性能更好一些。结束语本文主要研究了四旋翼的轨迹跟踪问题。总体控制策略由两个独立的控制器组成。将基于误差的状态空间预测控制策略应用于外环的位置控制，在前馈的图 方向跟踪 图 方向跟踪 图 跟踪 位置引入 和 进行补偿，可提高控制器抑制干扰的能力。仿真结果显示了对指定轨迹的良好跟踪和鲁棒性。表 轨迹跟踪 值 位置速度 第 期指挥控制与仿真 图 跟踪 图 跟踪 图 角跟踪 图 角跟踪 图 角跟踪 图 位置均方根误差 图 速度均方根误差 参考文献：许喆 四旋翼无人机控制系统的设计与实现 南京：南京理工大学，：，亓岳鑫 四旋翼无人机控制系统的设计与实现 哈尔滨：哈尔滨工业大学，：，孙嫚憶，等：基于 和 的四旋翼轨迹跟踪控制第 卷 姬江涛，扈菲菲，贺智涛，等 四旋翼无人机在农田信息获取中的应用 农机化研究，（）：，（）：，（），（）：，（）：，（）：，（）：薛晶勇，王斌锐 指数型时变增益反步滑模四旋翼姿态控制 控制工程，（）：，（）：，（）：，：，：，：，（）：，（）：，：，：，（），：，：，：，：金辉宇，刘丽丽，兰维瑶 二阶系统线性自抗扰控制的稳定性条件 自动化学报，（）：，（）：，（）：，（）：，（）：刘一莎，杨晟萱，王伟 四旋翼飞行器的自抗扰飞行控制方法 控制理论与应用，（）：，（）：（责任编辑：张培培）