一种基于自适应互补融合的无人机姿态控制系统及方法技术方案

本发明专利技术公开了一种基于自适应互补融合的无人机姿态控制系统及方法，首先读取传感器数据并对进行相应滤波；然后针对不同传感器的频域特性进行自适应互补融合，得到当前飞行器的空中姿态信息，进而得到控制所需的欧拉角；接着对飞行器进行数学建模并设计了两个控制器，其一是用来对俯仰角和横滚角控制；其二用来对航向角控制；最后对两个控制器输出进行叠加获得一个总的输出，并通过驱动器改变电机转速实现对飞行器的平稳控制。本发明专利技术实现了姿态宽范围高精度解算，数据收敛更快，精度更高。

【技术实现步骤摘要】

本专利技术属于飞行器控制、信息处理、导航
，具体涉及一种基于自适应互补 融合的无人机姿态控制系统及方法。
技术介绍
常见无人机按其结构可分为固定翼无人机和旋翼式无人机，与固定翼无人机相 比，旋翼无人机具有能够向后飞行、垂直起降和悬停的特点，对起飞、降落场地的条件要求 很少，控制起来非常灵活，能够满足多种用途，因此旋翼无人机具有更大的研宄价值。四 旋翼飞行器与普通旋翼飞行器相比，具有结构简单、故障率低、控制灵活和单位体积能够产 生更大的升力等优点，并且非常适合在狭小的空间内执行任务，拥有广泛的应用前景。 但是四旋翼飞行器同时又是一个典型的欠驱动系统，具有多变量、强耦合、非线性 等特性的系统，而且涉及学科多，领域广，包括机体的合理设计、传感器数据的融合、整机的 控制算法等。加上飞行过程中状态复杂，飞行器本身承受多种物理作用和气流等外部环境 的干扰，如旋翼的弹性形变、振动、机身自旋等问题，以及传感器的温漂对控制性能产生的 影响。上述问题给飞行器及其控制系统的设计带来很大的困难。
技术实现思路
本专利技术的目的在于提供， 以克服上述现有技术存在的缺陷，本专利技术实现了姿态宽范围高精度解算，数据收敛更快，精 度更高。 为达到上述目的，本专利技术采用如下技术方案： 一种基于自适应互补融合的无人机姿态控制系统，包括电机和与其连接的电机驱 动器，电机驱动器的控制信号输入端连接至并联的第一控制器和第二控制器； 所述的第一控制器的信号输入端连接自互补型自适应滤波器的信号输出端，互补 型自适应滤波器的输入端分别连接第一低通滤波器和四元数微分方程模块，第一低通滤波 器的输入端连接加速度计的信号输出端，四元数微分方程模块的信号输入端连接至陀螺仪 的信号输出端； 所述的第二控制器的信号输入端连接互补滤波器的信号输出端，互补滤波器的输 出端连接四元数微分方程模块和第二低通滤波器，第二低通滤波器的输入端连接至磁力计 的信号输出端； 所述第一控制器和第二控制器的信号输入端均连接至遥控器。 进一步地，所述的陀螺仪为MPU-6050六轴传感器。 进一步地，所述的磁力计为HMC5883L磁力计。 进一步地，所述的电机驱动器为电子调速器，电机为无刷电机。 一种基于自适应互补融合的无人机姿态控制系统的控制方法，包括以下步骤： 步骤一：获取加速度计、陀螺仪和磁力计传感器测得的数据，并对加速度计和磁力 计测得的数据进行低通滤波处理； 步骤二：对陀螺仪测得的数据以及低通滤波处理后的加速度计和磁力计数据进行 融合获得机体姿态数据； 步骤三：根据机体姿态数据和遥控器指令，控制器控制电机，最终控制飞行器姿 ??τ O 进一步地，步骤二中对陀螺仪测得的数据以及低通滤波处理后的加速度计和磁力 计数据进行融合获得机体姿态数据的方法为： Α)陀螺仪数据通过四元数微分方程得到第一姿态四元数； 四元数微分方程为： 其中为上一周期求得的最终四元数向量，为当前周期四元数的 导数；为角速度四元数向量；对该方程近似求解得到第 一姿态四元数；T为系统更新周期。 Β)加速度计数据通过梯度下降法得到第二姿态四元数； 最速下降法求取第二姿态四元数公式为 式中(为上一周期所求姿态四元数， 为当前周期所要求的第二姿态四元 数；μ A步长，IGW) = 乂:⑷，其中， C)将第一姿态四元数和第二姿态四元数进行互补滤波获得宽范围姿态数据； 互补滤波公式为：Qt= (l-α )Q v，t + a Qu，t，〇 彡 α 彡 1 式中Qtst为通过步骤Α)所求的，Qt为最终姿态四元数，Q v，t为步骤Β)中所求得， a为互补滤波动态系数，通过步骤D)自适应调整； D)引入加速度计值与重力值之差作为互补滤波动态系数，实现自适应调整参数；,式中ax、ay、a z为加速度计测量值，g为当地重力加速 度，K是调节系数，B为静止时滤波系数； E)将步骤C求得的最终姿态四元数转换成横滚角和俯仰角； Θ = arcsin2(q1；tq3；t-q〇；tq2；t) 其中，Θ为俯仰角，γ为横滚角； F)磁力计数据结合步骤Ε)的γ和Θ求得航向角； 航向角计算公式如下： 式中mx、my、mz为磁力计输出数据，Θ为俯仰角，γ为横滚角，φ _^为所求航向角； G)步骤F)求得的航向角与通过步骤Α)求得航向角数据互补融合获取宽范围航向 角； 其融合方式为：Itt= (1-β) Φ w+β Φ ω;?，0彡β彡1，式中Itt为最终所求 姿态航向角，为依据步骤Α)中的第一姿态四元数 进一步地，第一控制器采用PID控制，第二控制器采用ro控制；且第一控制器和第 二控制器输出与遥控器输出指令线性耦合叠加输出，通过电机驱动器驱动电机，进而控制 飞行姿态，实现水平运动、垂直运动和旋转运动。 与现有技术相比，本专利技术具有以下有益的技术效果： 本专利技术一种基于自适应互补融合的无人机姿态控制系统，通过加速度计传感器、 陀螺仪传感器和磁力计同时采集信号，之后通过低通滤波器、四元数微分方程模块、自适应 互补滤波器对信号进行处理，并将处理后的信号分别传输给控制器，控制器通过控制电机 驱动器对电机进行控制，从而实现了对四轴无人机姿态的控制。 一种基于自适应互补融合的无人机姿态控制方法通过获取加速度计、陀螺仪和磁 力计传感器数据，并进行滤波处理；对处理后的数据进行数据融合获取机体姿态；根据机 体姿态数据和遥控数据通过控制器控制电机转速，最终控制飞行器姿态。采用了精炼高效 的算法，可以使程序在低成本处理器下实时运行。并达到精确控制。对比与同类互补滤波 算法，本专利技术在四元数基础上引入自适应控制，实现了姿态宽范围高精度解算，数据收敛更 快，精度更高。本专利技术有效的将磁场数据有效的分离出来，无人机在受到磁场干扰时不会出 现全姿态错误，避免了在磁场受到干扰时坠机事故的发生。【附图说明】 图1为本专利技术系统总体流程图； 图2为本专利技术最速下降法融合自适应互补滤波算法流程图； 图3为本专利技术磁力计单独计算航向角流程图； 图4为本专利技术程序执行流程图； 图5为本专利技术与传统控制方法姿态响应精度比较图。【具体实施方式】 下面结合附图对本专利技术作进一步详细描述： 参见图1至图4,一种基于自适应互补融合的无人机姿态控制系统，包括电机和与 其连接的电机驱动器，电机驱动器的控制信号输入端连接至并联的第一控制器和第二控制 器； 所述的第一控制器的信号输入端连接自互补型自适应滤波器的信号输出端，互补 型自适应滤波器的输入端分别连接第一低通滤波器和四元数微分方程模块，第一低通滤波 器的输入端连接加速度计的信号输出端，四元数微分方程模块的信号输入端连接至陀螺仪 的信号输出端； 所述的第二控制器的信号输入端连接互补滤波器的信号输出端，互补滤波器的输 出端连接四元数微分方程模块和第二低通滤波器，第二低通滤波器的输入端连接至磁力计 的信号输出端； 所述第一控制器和第二控制器的信号输入端均连接至遥控器。 本专利技术所用加速度计要求ADC精度不低于12位，陀螺仪要求ADC精度不低于14 位，这里采用invensense公司的MPU-6050六轴传感器，整合了三轴加速度计和三轴陀螺 仪，16ADC位精度，数字输出；所用磁力计要求ADC精度不低于12位，这里采用HMC5883L 磁力计，12位精度，数字本文档来自技高网...

【技术保护点】
一种基于自适应互补融合的无人机姿态控制系统，其特征在于，包括电机和与其连接的电机驱动器，电机驱动器的控制信号输入端连接至并联的第一控制器和第二控制器；所述的第一控制器的信号输入端连接自互补型自适应滤波器的信号输出端，互补型自适应滤波器的输入端分别连接第一低通滤波器和四元数微分方程模块，第一低通滤波器的输入端连接加速度计的信号输出端，四元数微分方程模块的信号输入端连接至陀螺仪的信号输出端；所述的第二控制器的信号输入端连接互补滤波器的信号输出端，互补滤波器的输出端连接四元数微分方程模块和第二低通滤波器，第二低通滤波器的输入端连接至磁力计的信号输出端；所述第一控制器和第二控制器的信号输入端均连接至遥控器。

【技术特征摘要】

【专利技术属性】
技术研发人员：黄鹤，孟庆彬，王萍，郭璐，张懿璞，李杰，黄莺，易盟，雷旭，李艳波，王会峰，陈志强，
申请(专利权)人：长安大学，
类型：发明
国别省市：陕西;61