一种无人机非奇异自适应非光滑姿态跟踪控制方法技术

本发明专利技术提供了一种四旋翼无人机的非奇异自适应非光滑姿态跟踪控制方法，包括:预设给定姿态角、给定转动速度和给定转动加速度；并获取所述四旋翼无人机的当前姿态角和当前转动速度；计算给定姿态角、给定转动速度同当前姿态角、当前转动加速度的计算误差值，并根据姿态角和转动加速度计算回归向量；根据所述计算误差值计算非光滑控制项；根据所述回归向量和计算误差值得到参数估计量；根据所述回归向量、参数估计量、非光滑控制项得到控制量；根据所述控制量、所需升力及旋翼类型计算生成旋翼转速；本发明专利技术消除了光滑控制导致的奇异问题，改善了控制器性能，提高了四旋翼无人机的姿态跟踪控制动态与静态品质，同时改善了控制器的实用性。

A Nonsingular Adaptive Nonsmooth Attitude Tracking Control Method for UAV

【技术实现步骤摘要】
一种无人机非奇异自适应非光滑姿态跟踪控制方法
本专利技术涉及无人机控制
，特别是一种无人机非奇异自适应非光滑姿态跟踪控制方法。技术背景随着自动化技术、计算机技术、芯片技术等技术水平的不断提高，无人机的应用领域已经从单纯的军事领域扩展到民用领域；作为多旋翼无人机的一种，四旋翼无人机具有结构简单、体积小、飞行速度快、续航能力强等多种优点，可广泛用于侦察监视、交通监管、航空拍摄等领域具有极大的应用前景，而且四旋翼无人机具有垂直升降和悬停能力，能较好的应用于城市环境。目前在四旋翼无人机的高品质姿态跟踪控制方面主要有以下几种方法：一是利用传统的自适应控制方法设计的控制器，该类方法可以消除参数不确定性的影响，但在轨迹跟踪误差收敛速度及外部扰动的抑止方面性能有限；二是利用滑模变结构控制方法设计的滑模控制器，这类方法可以使得系统状态在滑模面上对参数摄动和外干扰时具有不变性，且具有无需系统在线辨识参数、物理实现简单等优点。但在实际应用中存在抖振问题，因此工程应用方面存在较大困难。三是有限时间控制，该方法具有更快的收敛速度，且稳态误差边界更小，具有更强的抗扰动能力，但对于负载变化不具有自适应能力，因此其控制品质受扰动影响较大。
技术实现思路
本专利技术提供了一种无人机非奇异自适应非光滑姿态跟踪控制方法，通过非光滑控制和自适应控制有机结合，并引入改进的QIN函数优化控制器结构消除了控制器的奇异问题，且提高了控制器的性能。为实现上述目的，本专利技术提供的技术方案为：提供一种无人机非奇异自适应非光滑姿态跟踪控制方法，所述方法应用于四旋翼无人机的处理器，所述方法包括：预设给定姿态角、给定转动速度和给定转动加速度；并获取所述四旋翼无人机的当前姿态角和当前转动速度；计算给定姿态角、给定转动速度同当前姿态角、当前转动加速度的计算误差值，并根据姿态角和转动加速度计算回归向量；根据所述计算误差值计算非光滑控制项；根据所述回归向量和计算误差值得到参数估计量；根据所述回归向量、参数估计量、非光滑控制项得到控制量；根据所述控制量、所需升力及旋翼类型计算生成旋翼转速。进一步的，所述“计算给定姿态角、给定转动速度同当前姿态角、当前转动加速度的计算误差值，并根据姿态角和转动加速度计算回归向量”具体为：通过下述公式，计算计算误差值z及回归向量Φ：其中，为3*3的正定对角增益矩阵，g(q-qr,α1,σ)＝[g(φ-φr,α1,σ)g(θ-θr,α1,σ)g(ψ-ψr,α1,σ)]T，其中sign(·)为符号函数，α1为控制参数满足0＜α1＜1，0＜σ＜1为光滑区域宽度，q1＝σα-1,q2＝-(α-1)σα-2,q3＝(α-1)σα-3；由四旋翼无人机动力学建模推导获得模型回归向量为：其中表示函数g(q-qr)对时间的导数。进一步的，所述“根据所述计算误差值计算非光滑控制项”具体为：通过下述公式，非光滑控制项f(z)：为3*3的正定对角增益矩阵，α2为控制参数，0＜α2＜1；运算符号定义如下进一步的，所述“根据所述回归向量和计算误差值得到参数估计量”具体为：通过下述公式，计算参数部分的估计值由投影自适应律获得，具体通过下式确定其中，dτ表示时间的微分，t表示当前时间。其中：ε＞0为边界系数值，θmax为待估计参数向量θ的上界，表示函数g的梯度函数，<a,b>代表向量a,b的叉乘，代表求向量的范数值。进一步的，所述“根据所述回归向量、参数估计量、非光滑控制项得到控制量”具体为：通过下述公式，计算控制量U：进一步的，所述“根据所述控制量、所需升力及旋翼类型计算生成旋翼转速”具体为：通过下述公式，计算旋翼转速：其中，ω1，ω2，ω3，ω4为四个旋翼的转速，Up为飞行所需升力控制量，所述所需升力控制量由高度控制算法得到。本专利技术的有益效果：本专利技术将非光滑控制与自适应控制的优点相结合，一方面在控制器中引入非光滑控制提高位置跟踪的快速性及抗扰动能力，另一方面，通过在线估计参数及扰动影响进行自适应在线补偿，从而提高姿态跟踪控制的鲁棒性及控制精度，使得四旋翼无人机具有较好的姿态跟踪动态与静态品质，同时改进的控制结构消除了控制器的奇异问题，提高了控制器的实用性。附图说明图1位本专利技术实施例提供的一种无人机非奇异自适应非光滑姿态跟踪控制方法流程图；具体实施方式为了更清楚地说明本专利技术实施例和现有技术中的技术方案，下面将对照附图说明本专利技术的具体实施方式。显而易见地，下面描述中的附图仅仅是本专利技术的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图，并获得其他的实施方式，本专利技术并不限制于该实施例。参阅图1所示的无人机非奇异自适应非光滑姿态跟踪控制方法的流程图，所述方法应用于四旋翼无人机的处理器，包括：S100，预设给定姿态角、给定转动速度和给定转动加速度；并获取所述四旋翼无人机的当前姿态角和当前转动速度；具体为：获取给定姿态轨迹信息qr＝[φrθrψr]T，及分别为给定姿态(翻滚角，俯仰角，偏航角)、给定转动速度、给定转动加速度；通过传感器获取四旋翼无人机当前的姿态q＝[φθψ]T及转动速度信息S102，计算给定姿态角、给定转动速度同当前姿态角、当前转动加速度的计算误差值，并根据姿态角和转动加速度计算回归向量；上述S102具体通过以下方式实现：通过下述公式，计算计算误差值z及回归向量Φ：其中，为3*3的正定对角增益矩阵，g(q-qr,α1,σ)＝[g(φ-φr,α1,σ)g(θ-θr,α1,σ)g(ψ-ψr,α1,σ)]T，其中sign(·)为符号函数，α1为控制参数满足0＜α1＜1，0＜σ＜1为光滑区域宽度，q1＝σα-1,q2＝-(α-1)σα-2,q3＝(α-1)σα-3；由四旋翼无人机动力学建模推导获得模型回归向量为：其中表示函数g(q-qr)对时间的导数。S104，根据所述计算误差值计算非光滑控制项；上述S104具体通过以下方式实现：通过下述公式，非光滑控制项f(z)：为3*3的正定对角增益矩阵，α2为控制参数，0＜α2＜1；运算符号定义如下S106，根据所述回归向量和计算误差值得到参数估计量；上述S106具体通过以下方式实现：通过下述公式，计算参数部分的估计值由投影自适应律获得，具体通过下式确定其中，dτ表示时间的微分，t表示当前时间。其中：ε＞0为边界系数值，θmax为待估计参数向量θ的上界，表示函数g的梯度函数，<a,b>代表向量a,b的叉乘，代表求向量的范数值。S108，根据所述回归向量、参数估计量、非光滑控制项得到控制量；上述S108具体通过以下方式实现：通过下述公式，计算控制量U：S110，根据所述控制量、所需升力及旋翼类型计算生成旋翼转速。上述S110具体通过以下方式实现：通过下述公式，计算旋翼转速：其中，ω1，ω2，ω3，ω4为四个旋翼的转速，Up为飞行所需升力控制量，所述所需升力控制量由高度控制算法得到。四旋翼无人机的精确航迹跟踪是实现无人机自主飞行的基本要求。由于四旋翼无人机自身存在姿态与平动的耦合关系以及模型参数不确定性与外界扰动，因此只有实现姿态的稳定控制才能完成航迹的有效跟踪。在四旋翼无人机的自主控制系统中，姿态稳定控制是实现飞行器自主飞行的基础。其任务是控制四旋翼无本文档来自技高网...

【技术保护点】
1.一种无人机非奇异自适应非光滑姿态跟踪控制方法，其特征在于，所述方法应用于四旋翼无人机的处理器，所述方法包括：预设给定姿态角、给定转动速度和给定转动加速度；并获取所述四旋翼无人机的当前姿态角和当前转动速度；计算给定姿态角、给定转动速度同当前姿态角、当前转动加速度的计算误差值，并根据姿态角和转动加速度计算回归向量；根据所述计算误差值计算非光滑控制项；根据所述回归向量和计算误差值得到参数估计量；根据所述回归向量、参数估计量、非光滑控制项得到控制量；根据所述控制量、所需升力及旋翼类型计算生成旋翼转速。

【技术特征摘要】
1.一种无人机非奇异自适应非光滑姿态跟踪控制方法，其特征在于，所述方法应用于四旋翼无人机的处理器，所述方法包括：预设给定姿态角、给定转动速度和给定转动加速度；并获取所述四旋翼无人机的当前姿态角和当前转动速度；计算给定姿态角、给定转动速度同当前姿态角、当前转动加速度的计算误差值，并根据姿态角和转动加速度计算回归向量；根据所述计算误差值计算非光滑控制项；根据所述回归向量和计算误差值得到参数估计量；根据所述回归向量、参数估计量、非光滑控制项得到控制量；根据所述控制量、所需升力及旋翼类型计算生成旋翼转速。2.根据权利要求1所述的一种无人机非奇异自适应非光滑姿态跟踪控制方法，其特征在于，所述“计算给定姿态角、给定转动速度同当前姿态角、当前转动加速度的计算误差值，并根据姿态角和转动加速度计算回归向量”具体为：通过下述公式，计算计算误差值z及回归向量Φ：其中，为3*3的正定对角增益矩阵g(q-qr，α1，σ)＝[g(φ-φr，α1，σ)g(θ-θr，α1，σ)g(ψ-ψr，α1，σ)]T，其中sign(·)为符号函数，α1为控制参数满足0<α1<1，0<σ<1为光滑区域宽度，q1＝σα-1,q2＝-(α-1)σα-2,q3＝(α-1)σα-3；回归向量为：其中表示函数g(q-qr)对时间的导数。3.根据权利要求1所述的一种无人机非奇异自适应非光滑姿态跟踪控制方法，其特...

【专利技术属性】
技术研发人员：何栋炜，刘丽桑，李建兴，黄靖，廖律超，郑积仕，陈乐，陈彩云，陈兴武，
申请(专利权)人：福建工程学院，
类型：发明
国别省市：福建,35