一种基于积分滑模的浸入不变流型自适应四旋翼控制方法技术

本发明专利技术提供一种基于积分滑模的浸入不变流型自适应四旋翼控制方法，包括：提供一四旋翼无人机，测量其位置数据，并构造一扩张状态观测器对总干扰进行估计；根据位置数据和观测值，构造积分滑模控制器并得到其输出值，以消除扩张状态观测器的观测误差；构造基于浸入不变流型的自适应控制器，将其输出值与积分滑模控制器的输出值叠加得到输出值之和，以消除总干扰，并将该输出值之和发送给一驱动四旋翼无人机的姿态控制器。本发明专利技术采用扩张状态观测器对各类干扰进行观测，构建积分滑模控制器消除观测误差，设计基于自适应控制器的路径跟踪控制器消除干扰，由此实现了对空气干扰等干扰的自适应估计能力，保证在空气阻力等干扰下的稳定性。

An Integrated Sliding Mode Based Immersion Invariant Flow Pattern Adaptive Four Rotor Control Method

【技术实现步骤摘要】
一种基于积分滑模的浸入不变流型自适应四旋翼控制方法
本专利技术属于四旋翼无人机领域，尤其是涉及一种一种基于积分滑模的浸入不变流型自适应四旋翼控制方法。
技术介绍
四旋翼无人机由于其高机动性、悬停能力以及微型化等特点，被广泛应用于军事侦察、灾后救援、地形绘制等场景，也是目前热门研究方向之一。无人机在飞行过程中会面临多种干扰，包括气流干扰、负载干扰、传感器误差以及参数不确定等，这些干扰对无人机的飞行会产生明显的干扰。特别是在四旋翼无人机执行高精度、快速反应任务中，这些干扰会严重影响其飞行品质。因此，设计一种良好的无人机抗干扰算法，对于提高无人机飞行品质和扩展无人机应用范围具有重要的意义。针对无人机的干扰与不确定性问题，目前已经有很多学者发表了相关抗干扰算法文献，包括自适应控制方法、滑模控制方法、H∞控制方法、预测控制、反步法(backstepping)控制、鲁棒控制及基于观测器的控制方法等，这些控制方法通过反馈控制作用在无人机的一闭环系统上。其中，在滑模控制方法中，系统首先从初始状态趋近于并到达滑膜面，接着在滑膜面上滑动并到达平衡位置，其能够在有限时间内收敛至目标值，因此在多种控制问题中表现出优异的性能。为改善四旋翼无人机的控制系统对干扰的不敏感性及鲁棒性，一些学者提出了一种积分滑模控制方法(integralslidingmodecontroller，ISMC)。ISMC方法消除了滑模控制方法从初始状态到达滑模面的过程，从而使其控制初始便处于滑膜面，同时保留滑模控制所具有的优点。但是，由于四旋翼控制器是一个离散控制系统，因此ISMC方法的开关控制方法会引起四旋翼的高频抖振。为解决这一问题，一种常用的方法是使用连续控制项(即单项控制方法)取代滑模控制中的非连续开关控制项以减少抖振，但这种方法同时会降低四旋翼无人机的控制方法的控制品质。近年来，一些学者将滑模控制与干扰观测器结合起来，提出一种新颖的控制方法以在其控制品质不降低的情况下解决抖振问题，其基本思想是利用观测器对干扰进行估计，随后采用干扰观测值抵消大部分干扰，以提升滑模控制方法的控制品质。例如，Ginoya等基于干扰的观测器，以一种特殊形式提出了针对带有非匹配干扰的n阶系统的滑模控制器，并提出了一种新颖的滑模面设计方法及观测器构造方法。针对带有失配干扰的n阶线性系统，Zhang等提出了一种DOB-ISMC(disturbanceobserver-basedintegralsliding-modecontrol)方法，并给出了相应的控制增益设计方法以及一种干扰观测器，该方法减少了ISMC的抖振问题，同时减少了干扰观测器的观测误差。但此类方法无法对状态(无人机的速度加速度)进行估计，在应用时需要构造额外的观测器对未知状态进行观测。其中，由于四旋翼受到的干扰较为复杂，且机体的状态信息如速度、角速度等难以精确测得，通常需要设计多种不同的观测器对不同的干扰、状态分别进行估计，这增加了数学分析的难度与复杂度。对此，现有技术一般采用扩张状态观测器对不同的干扰、状态同时进行估计。在Han提出的扩张状态观测器(extendedstateobserver，ESO)中，多种干扰被视为一体的总干扰，观测器直接对这一总干扰进行估计，因此只需要建立一个观测器即可完成对所有干扰的估计，同时，ESO还可以对未知系统状态进行估计。这种方法不仅降低了观测器构建的难度，而且针对包含多种不同类型干扰的系统具有很好的干扰估计能力。Gao提出了扩张状态观测器(ESO)的参数整定方法——带宽法，进一步减少了观测器在实际问题应用中的困难，但该方法需要较高的观测增益才能实现准确跟踪干扰值。在离散系统条件下，增益无法设置过高，使得ESO在干扰变化过程中会存在一定误差。据此，Yao等提出了一种将扩张状态观测器与积分滑模控制器结合的四旋翼控制方法，其通过使用扩张状态观测器解决了对不同的干扰、状态同时进行估计的问题，并通过仿真验证了该方法具有良好的控制性能。该将扩张状态观测器与积分滑模控制器结合的四旋翼控制方法利用对干扰的观测信息，采取了H∞控制器作为干扰消除控制器，其并未直接对干扰予以抵消。其中，目前所采用的四旋翼无人机的动力学模型系统式如下：式中，为无人机的横滚角；为无人机的俯仰角；ψ∈[0,2π]为无人机的偏航角；x，y，为无人机沿大地坐标系的xE，yE，zE轴方向位置坐标；xB，yB，zB为无人机在机体坐标系(如图2所示)的轴；为4个螺旋桨升力之和；为机体坐标yB轴方向两电机升力之差；为xB轴方向两电机升力之差；为yB轴方向两电机升力和与xB轴方向两电机升力和之差；Ixx，Iyy，Izz为机体绕xB，yB，zB轴的转动惯量。从四旋翼无人机动力学模型中可以看出，其具有4个输入U1、U2、U3、U4和6个输出，是一个欠驱动模型。现有技术中，通常解决该问题的方法是构建级联控制器，上述模型中的4个输入U1、U2、U3、U4被用于控制无人机的3个姿态和位置z，而x与y方向的位置控制器则需要通过向姿态控制器发送命令驱动其姿态倾斜以完成控制。由于一般现有的模型往往忽略姿态控制器的响应过程，认为姿态控制器可以在瞬间控制机体到达位置控制器所需的角度。在实际过程中，如果无人机进行缓慢的运动，这样的忽略不会明显影响控制效果；但在快速控制中，无人机需要做出迅速而准确的运动控制，这样的忽略会对无人机的控制效果产生明显影响。因此，该将扩张状态观测器与积分滑模控制器结合的四旋翼控制方法由于其并未直接对干扰予以抵消，其消除干扰的速度较慢，而空气阻力干扰随无人机速度、姿态变化而发生改变，是一种高频干扰，在实际系统中难以被观测器及时观测。在较为剧烈的速度变化中，观测器对空气阻力错误的估计甚至有可能对控制性能产生负面影响。此外，该方法未对位置变化进行考虑，不能对轨迹实现准确、实时的跟踪。
技术实现思路
本专利技术的目的是提供一种基于积分滑模的浸入不变流型自适应四旋翼控制方法，以实现对无人机的路径跟踪控制，消除空气干扰对四旋翼无人机带来的影响。为了实现上述目的，本专利技术提供一种基于积分滑模的浸入不变流型自适应四旋翼控制方法，包括：步骤S1：提供一四旋翼无人机，测量其位置数据，并构造一扩张状态观测器对四旋翼无人机的总干扰进行估计，得到扩张状态观测器的观测值步骤S2：根据四旋翼无人机的位置数据和扩张状态观测器的观测值，构造积分滑模控制器并得到其输出值u2，以消除扩张状态观测器的观测误差；步骤S3：构造基于浸入不变流型的自适应控制器，将其输出值与步骤S2所述的积分滑模控制器的输出值叠加得到所有控制器的输出值之和，以消除总干扰，并将该输出值之和发送给一驱动所述四旋翼无人机的姿态控制器。在所述步骤S1中，所述四旋翼无人机的位置数据包括四旋翼无人机的xE轴方向和yE轴方向的位置，以及四旋翼无人机的俯仰角θ和横滚角四旋翼无人机的xE轴方向和yE轴方向的位置均采用IMU或GPS测量得到，四旋翼无人机的俯仰角θ和横滚角采用陀螺仪测量得到。在步骤S1中，所述扩张状态观测器是通过使用所述四旋翼无人机的一水平方向控制模型构造的，且所述水平方向控制模型是采用系统辨识方法，通过将四旋翼无人机近似为一个一阶惯性过程来构造的。所述构建一扩张状态观测器，包括：步骤S11：根本文档来自技高网...

【技术保护点】
1.一种基于积分滑模的浸入不变流型自适应四旋翼控制方法，其特征在于，包括：步骤S1：提供一四旋翼无人机(1)，测量其位置数据，并构造一扩张状态观测器(21)对四旋翼无人机(1)的总干扰进行估计，得到扩张状态观测器(21)的观测值

【技术特征摘要】
2019.03.29 CN 20191025570841.一种基于积分滑模的浸入不变流型自适应四旋翼控制方法，其特征在于，包括：步骤S1：提供一四旋翼无人机(1)，测量其位置数据，并构造一扩张状态观测器(21)对四旋翼无人机(1)的总干扰进行估计，得到扩张状态观测器(21)的观测值步骤S2：根据四旋翼无人机(1)的位置数据和扩张状态观测器(21)的观测值，构造积分滑模控制器(22)并得到其输出值u2，以消除扩张状态观测器(21)的观测误差；步骤S3：构造基于浸入不变流型的自适应控制器(23)，将其输出值与步骤S2所述的积分滑模控制器(22)的输出值叠加得到所有控制器的输出值之和u(t)，以消除总干扰，并将该输出值之和u(t)发送给一驱动所述四旋翼无人机(1)的姿态控制器(3)。2.根据权利要求1所述的基于积分滑模的浸入不变流型自适应四旋翼控制方法，其特征在于，在所述步骤S1中，所述四旋翼无人机(1)的位置数据包括四旋翼无人机(1)的xE轴方向和yE轴方向的位置，以及四旋翼无人机(1)的俯仰角θ和横滚角四旋翼无人机(1)的xE轴方向和yE轴方向的位置均采用IMU或GPS测量得到，四旋翼无人机(1)的俯仰角θ和横滚角采用陀螺仪测量得到。3.根据权利要求1所述的基于积分滑模的浸入不变流型自适应四旋翼控制方法，其特征在于，在步骤S1中，所述扩张状态观测器(21)是通过使用所述四旋翼无人机(1)的一水平方向控制模型构造的，且所述水平方向控制模型是采用系统辨识方法，通过将四旋翼无人机(1)近似为一个一阶惯性过程来构造的。4.根据权利要求3所述的基于积分滑模的浸入不变流型自适应四旋翼控制方法，其特征在于，所述构建一扩张状态观测器(21)，包括：步骤S11：根据水平方向控制模型，增加第四阶状态作为总干扰，构建扩张状态模型；步骤S12：基于该扩张状态模型，构建扩张状态观测器(21)。5.根据权利要求4所述的基于积分滑模的浸入不变流型自适应四旋翼控制方法，其特征在于，所述扩张状态模型为：uo(t)＝[0u0]T，Δe(t)＝[00h]，xo(t)＝[x1x2d]T，其中，u为xE轴方向的加速度，单位为m/s2，分别为四旋翼无人机(1)的xE轴方向的位置、速度，单位分别为m，m/s；d(t)为四旋翼无人机(1)受到的总干扰，单位为m/s2，h为总干扰的微分，单位为m/s3，-Ka为空气阻力系数，单位为kg/s...

【专利技术属性】
技术研发人员：孙琦钰，姚达琛，周照，唐漾，范瑞洋，
申请(专利权)人：华东理工大学，
类型：发明
国别省市：上海,31