CN110377058B - 一种飞行器的偏航角修正方法、装置及飞行器 - Google Patents

Abstract

本发明涉及飞行器技术领域，公开了一种飞行器的偏航角修正方法、装置及飞行器，所述方法包括：获取IMU数据以及磁力计数据，其中，所述IMU数据包括IMU加速度信息和IMU角速度信息；根据所述磁力计数据，确定磁力计偏航角；根据所述磁力计偏航角，确定偏航角初始值；根据所述磁力计数据，确定偏航角角速度补偿量；根据所述IMU角速度信息以及所述偏航角角速度补偿量，确定修正后的角速度；根据所述修正后的角速度，确定偏航角相对值；根据所述偏航角初始值以及所述偏航角相对值，生成融合偏航角。通过上述方式，本发明解决室内的飞行器依赖视觉信息进行偏航角修正以及室内磁干扰影响偏航角修正的问题，提高飞行器在室内飞行或悬停的稳定性。

Description

一种飞行器的偏航角修正方法、装置及飞行器

技术领域

本发明涉及飞行器技术领域，特别是涉及一种飞行器的偏航角修正方法、装置及飞行器。

背景技术

飞行器，如无人飞行器(Unmanned Aerial Vehicle，UAV)，也称无人机，以其具有体积小、重量轻、机动灵活、反应快速、无人驾驶、操作要求低等优点，得到了越来越广泛的应用。无人飞行器的各个动作(或姿态)通常是通过控制无人飞行器的动力系统中的多个驱动电机不同转速实现的。其中，偏航角是对无人飞行器的飞行姿态进行控制中的重要参数，也即无人飞行器的偏航角融合对无人飞行器的姿态控制尤其重要，若无人飞行器的偏航角融合误差大，或者融合精度低，轻则无人飞行器无法按照预设的方向或轨迹飞行，重则出现刷锅现象，甚至可能失稳以致炸机。

室内环境下飞行器的磁干扰严重，并且GPS信息较差，飞行器在室内进行飞行或悬停，由于没有GPS信息修正，磁力计也受到严重干扰，没有可用的信息来进行偏航角修正，而陀螺仪积分本身存在漂移特性，因此室内飞行或悬停时，飞机容易偏航角漂移。

目前，飞行器在室内的飞行主要靠视觉信息修正或磁力计修正来修正偏航角，而视觉信息修正对于无视觉的飞机来说不可取，并且，由于视觉运算量大，对于视觉单元运算力较弱的飞机，会影响其他视觉信息的解算，而若要不影响，则需要更换更好的视觉模块，增加成本，而采用磁力计修正的方法容易受到在干扰时，飞行器偏航角偏差严重或漂移。因此，飞行器如何在室内对偏航角进行修正，是本发明需要解决的问题。

发明内容

本发明实施例提供一种飞行器的偏航角修正方法、装置及飞行器，解决室内的飞行器依赖视觉信息进行偏航角修正以及室内磁干扰影响偏航角修正的问题，提高飞行器在室内飞行或悬停的稳定性。

为解决上述技术问题，本发明实施例提供以下技术方案：

第一方面，本发明实施例提供一种飞行器的偏航角修正方法，应用于飞行器，所述方法包括：

获取IMU数据以及磁力计数据，其中，所述IMU数据包括IMU加速度信息和IMU角速度信息；

根据所述磁力计数据，确定磁力计偏航角；

根据所述磁力计偏航角，确定偏航角初始值；

根据所述磁力计数据，确定偏航角角速度补偿量；

根据所述IMU角速度信息以及所述偏航角角速度补偿量，确定修正后的角速度；

根据所述修正后的角速度，确定偏航角相对值；

根据所述偏航角初始值以及所述偏航角相对值，生成融合偏航角。

在一些实施例中，所述根据所述磁力计数据，确定所述磁力计偏航角，包括：

对所述磁力计数据进行校准，生成校准后的磁力计数据；

获取所述飞行器的姿态角并根据所述飞行器的姿态角，生成旋转变换矩阵；

利用所述旋转变换矩阵对所述校准后的磁力计数据进行坐标变换，以生成所述地面坐标系下的磁力计数据；

根据所述地面坐标系下的磁力计数据，对比所述飞行器在当前位置下的标准磁场的磁力计数据，计算所述磁力计偏航角。

在一些实施例中，所述根据所述磁力计偏航角，确定所述偏航角初始值，包括：

判断所述飞行器在当前时刻是否由静止状态变为运动状态；

若是，则将所述磁力计偏航角作为所述偏航角初始值。

在一些实施例中，所述根据所述磁力计数据，确定偏航角角速度补偿量，包括：

根据所述磁力计偏航角，确定偏航角偏差角；

根据所述偏航角偏差角，确定偏航角相对偏差角；

根据所述偏航角相对偏差角，确定所述偏航角角速度补偿量。

在一些实施例中，所述根据所述磁力计偏航角，确定偏航角偏差角，包括：

根据所述磁力计偏航角和上一时刻的融合偏航角，确定所述偏航角偏差角。

在一些实施例中，所述根据所述偏航角偏差角，确定偏航角相对偏差角，包括：

获取所述飞行器的对地高度和所述飞行器的飞行高度；

根据所述偏航角偏差角、所述飞行器的对地高度和所述飞行器的飞行高度，确定所述偏航角相对偏差角。

在一些实施例中，所述根据所述偏航角偏差角、所述飞行器的对地高度和所述飞行器的飞行高度，确定所述偏航角相对偏差角，包括：

根据所述飞行器的对地高度和所述飞行器的飞行高度，确定偏航角偏差相对偏移量；

根据所述偏航角偏差角和所述偏航角偏差相对偏移量，确定所述偏航角相对偏差角。

在一些实施例中，所述根据所述飞行器的对地高度和所述飞行器的飞行高度，确定所述偏航角偏差相对偏移量，包括：

当满足以下条件中的任一项时，确定所述偏航角偏差角为所述偏航角偏差相对偏移量：

所述飞行器的对地高度满足第一预设条件；

所述飞行器的飞行高度满足第二预设条件时；以及

所述偏航角偏差角的微分满足第三预设条件。

在一些实施例中，所述第一预设条件为：

所述飞行器的对地高度大于0.4m，且持续时间不小于0.5s。

在一些实施例中，所述第二预设条件为：

所述飞行器的飞行高度大于0.4m，且持续时间不小于0.5s。

在一些实施例中，所述第三预设条件为：

所述偏航角偏差角的微分的绝对值小于0.1且持续时间不小于0.5s。

在一些实施例中，所述根据所述偏航角偏差角和所述偏航角偏差相对偏移量，确定所述偏航角相对偏差角，包括：

当均满足以下条件时，确定所述偏航角误差相对补偿值为所述偏航角相对偏差角：

所述飞行器的对地高度满足所述第一预设条件或当所述飞行器的飞行高度满足所述第二预设条件；

所述偏航角偏差角的微分满足所述第三预设条件；且

偏航角误差相对补偿值满足第四预设条件，其中，所述偏航角误差相对补偿值为所述偏航角偏差角与所述偏航角偏差相对偏移量的差。

在一些实施例中，所述第四预设条件为：

所述偏航角误差相对补偿值的绝对值小于0.1且持续时间不小于0.5s。

在一些实施例中，所述根据所述偏航角相对偏差角，确定所述偏航角角速度补偿量，包括：

通过反馈控制算法对所述偏航角相对偏差角进行计算，以确定所述偏航角角速度补偿量。

第二方面，本发明实施例提供一种飞行器的偏航角修正装置，应用于飞行器，所述装置包括：

获取模块，用于获取IMU数据以及磁力计数据，其中，所述IMU数据包括IMU加速度信息和IMU角速度信息；

确定模块，用于：

根据所述磁力计数据，确定磁力计偏航角；

根据所述磁力计偏航角，确定偏航角初始值；

根据所述磁力计数据，确定偏航角角速度补偿量；

根据所述IMU角速度信息以及所述偏航角角速度补偿量，确定修正后的角速度；以及

根据所述修正后的角速度，确定偏航角相对值；

融合偏航角生成模块，用于根据所述偏航角初始值以及所述偏航角相对值，生成融合偏航角。

在一些实施例中，所述确定模块包括校准及坐标系转换模块，所述校准及坐标系转换模块用于：

对所述磁力计数据进行校准，生成校准后的磁力计数据；

获取所述飞行器的姿态角并根据所述飞行器的姿态角，生成旋转变换矩阵；

利用所述旋转变换矩阵对所述校准后的磁力计数据进行坐标变换，以生成所述地面坐标系下的磁力计数据；

根据所述地面坐标系下的磁力计数据，对比所述飞行器在当前位置下的标准磁场的磁力计数据，计算所述磁力计偏航角。

在一些实施例中，所述确定模块还包括静止状态检测模块，所述静止状态检测模块用于：

判断所述飞行器在当前时刻是否由静止状态变为运动状态；

若是，则将所述磁力计偏航角作为所述偏航角初始值。

在一些实施例中，所述确定模块还包括偏航角偏差判定及处理模块，所述偏航角偏差判定及处理模块用于：

根据所述磁力计偏航角，确定偏航角偏差角；

根据所述偏航角偏差角，确定偏航角相对偏差角；

根据所述偏航角相对偏差角，确定所述偏航角角速度补偿量。

在一些实施例中，所述偏航角偏差判定及处理模块用于：

根据所述磁力计偏航角和上一时刻的融合偏航角，确定所述偏航角偏差角。

在一些实施例中，所述偏航角偏差判定及处理模块用于：

获取所述飞行器的对地高度和所述飞行器的飞行高度；

根据所述偏航角偏差角、所述飞行器的对地高度和所述飞行器的飞行高度，确定所述偏航角相对偏差角。

在一些实施例中，所述偏航角偏差判定及处理模块包括逻辑或运算模块，所述逻辑或运算模块用于：：

当满足以下条件中的任一项时，确定所述偏航角偏差角为所述偏航角偏差相对偏移量：

所述飞行器的对地高度满足第一预设条件；

所述飞行器的飞行高度满足第二预设条件时；以及

所述偏航角偏差角的微分满足第三预设条件。

在一些实施例中，所述第一预设条件为：

所述飞行器的对地高度大于0.4m，且持续时间不小于0.5s。

在一些实施例中，所述第二预设条件为：

所述飞行器的飞行高度大于0.4m，且持续时间不小于0.5s。

在一些实施例中，所述第三预设条件为：

所述偏航角偏差角的微分的绝对值小于0.1且持续时间不小于0.5s。

在一些实施例中，所述偏航角偏差判定及处理模块包括逻辑与运算模块，所述逻辑与运算模块用于：

当均满足以下条件时，确定所述偏航角误差相对补偿值为所述偏航角相对偏差角：

所述飞行器的对地高度满足所述第一预设条件或当所述飞行器的飞行高度满足所述第二预设条件；

所述偏航角偏差角的微分满足所述第三预设条件；且

偏航角误差相对补偿值满足第四预设条件，其中，所述偏航角误差相对补偿值为所述偏航角偏差角与所述偏航角偏差相对偏移量的差。

在一些实施例中，所述第四预设条件为：

所述偏航角误差相对补偿值的绝对值小于0.1且持续时间不小于0.5s。

在一些实施例中，所述确定模块包括反馈控制模块，所述反馈控制模块用于：

通过反馈控制算法对所述偏航角相对偏差角进行计算，以确定所述偏航角角速度补偿量。

第三方面，本发明实施例提供一种飞行器，包括：

机身；

机臂，与所述机身相连；

动力装置，设于所述机身和/或所述机臂，用于为所述飞行器提供飞行的动力；以及

飞行控制器，设于所述机身；

其中，所述飞行控制器包括：

至少一个处理器；以及，

与所述至少一个处理器通信连接的存储器；其中，

所述存储器存储有可被所述至少一个处理器执行的指令，所述指令被所述至少一个处理器执行，以使所述至少一个处理器能够执行如上所述的飞行器的偏航角修正方法。

第四方面，本发明实施例还提供了一种非易失性计算机可读存储介质，所述计算机可读存储介质存储有计算机可执行指令，所述计算机可执行指令用于使飞行器能够执行如上所述的飞行器的偏航角修正方法。

本发明可解决室内的飞行器依赖视觉信息进行偏航角修正以及室内磁干扰影响偏航角修正的问题，提高了飞行器在室内飞行或悬停的稳定性。

附图说明

一个或多个实施例通过与之对应的附图中的图片进行示例性说明，这些示例性说明并不构成对实施例的限定，附图中具有相同参考数字标号的元件表示为类似的元件，除非有特别申明，附图中的图不构成比例限制。

图1是本发明实施例提供的一种飞行器的具体结构图；

图2是本发明实施例提供的一种飞行器的偏航角修正方法的原理框图；

图3是本发明实施例提供的一种偏航角偏航角偏差判定及处理算法的示意图；

图4是本发明实施例提供的一种飞行器的偏航角修正方法的流程示意图；

图5是图4中的步骤S20的细化流程图；

图6是图4中的步骤S30的细化流程图；

图7是图4中的步骤S40的细化流程图；

图8是图7中的步骤S42的细化流程图；

图9是图8中的步骤S421的细化流程图；

图10是图8中的步骤S423的细化流程图；

图11是本发明实施例提供的一种飞行器的偏航角修正装置的结构示意图；

图12是图11中的确定模块的结构示意图；

图13是图12中的偏航角偏差判定及处理模块的结构示意图；

图14是本发明实施例提供的一种飞行器的硬件结构示意图；

图15是本发明实施例提供的一种飞行器的连接框图；

图16是图15中的动力系统的示意图。

具体实施方式

为使本发明实施例的目的、技术方案和优点更加清楚，下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。

此外，下面所描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。

本发明实施例提供的飞行器的偏航角修正方法可以应用到各种通过电机或马达驱动的可移动物体上，包括但不限于飞行器、机器人等。其中飞行器可包括无人飞行器(unmanned aerial vehicle，UAV)，无人飞船等。

其中，本发明实施例的飞行器的偏航角修正方法，应用于飞行器的飞行控制器。

请参阅图1，图1是本发明实施例提供的一种飞行器的具体结构图；

如图1所示，该飞行器10包括：机身11、与所述机身11相连的机臂12、设置于所述机臂12的动力装置13，连接至该机身11底部的云台14，安装在云台14上的摄像头15以及设置于机身11内的飞行控制器(图未示)。

其中，飞行控制器与动力装置13连接，动力装置13安装在所述机身11上，用于为所述飞行器10提供飞行动力。具体的，飞行控制器用于执行上述的飞行器的偏航角修正方法以修正飞行器的偏航角，并根据融合后的飞行器的偏航角生成控制指令，并将该控制指令发送给动力装置13的电调，电调通过该控制指令控制动力装置13的驱动电机。或者，飞行控制器用于执行飞行器的偏航角修正方法以修正飞行器的偏航角，并将修正后的飞行器的偏航角发送至电调，电调根据修正后的飞行器的偏航角生成控制指令，并通过该控制指令控制动力装置13的驱动电机。

机身11包括：中心壳体以及与中心壳体连接的一个或多个机臂，一个或多个机臂呈辐射状从中心壳体延伸出。机臂与中心壳体的连接可以是一体连接或者固定连接。动力装置安装于机臂上。

飞行控制器用于执行上述飞行器的偏航角修正方法以修正飞行器的偏航角，并根据修正后的飞行器的偏航角生成控制指令，并将该控制指令发送给动力装置的电调，以便电调通过该控制指令控制动力装置的驱动电机。控制器为具有一定逻辑处理能力的器件，如控制芯片、单片机、微控制单元(Microcontroller Unit，MCU)等。

动力装置13包括：电调，驱动电机和螺旋桨。电调位于机臂或中心壳体所形成的空腔内。电调分别与控制器及驱动电机连接。具体的，电调与驱动电机电连接，用于控制所述驱动电机。驱动电机安装在机臂上，驱动电机的转动轴连接螺旋桨。螺旋桨在驱动电机的驱动下产生使得飞行器10移动的力，例如，使得飞行器10移动的升力或者推力。

飞行器10完成各个规定速度、动作(或姿态)是通过电调控制驱动电机以实现的。电调全称电子调速器，根据控制信号调节飞行器10的驱动电机的转速。其中，控制器为执行上述飞行器的偏航角修正方法的执行主体，电调基于融合后的飞行器的偏航角所生成控制指令来控制驱动电机。电调控制驱动电机的原理大致为：驱动电机是将电脉冲信号转变为角位移或线位移的开环控制元件。在非超载的情况下，驱动电机的转速、停止的位置只取决于脉冲信号的频率和脉冲数，而不受负载变化的影响，当驱动器接收到一个脉冲信号，它就驱动动力装置的驱动电机按设定的方向转动一个固定的角度，它的旋转是以固定的角度运行的。因此，电调可以通过控制脉冲个数来控制角位移量，从而达到准确定位的目的；同时可以通过控制脉冲频率来控制驱动电机转动的速度和加速度，从而达到调速的目的。

目前飞行器10主要功能为航拍、影像实时传输、高危地区探测等。为了实现航拍、影像实时传输、高危地区探测等功能，飞行器10上会连接有摄像组件。具体的，飞行器10和摄像组件通过连接结构，如减振球等进行连接。该摄像组件用于在飞行器10进行航拍的过程中，获取拍摄画面。

具体的，摄像组件包括：云台及拍摄装置。云台与飞行器10连接。其中，拍摄装置搭载于所述云台上，拍摄装置可以为图像采集装置，用于采集图像，该拍摄装置包括但不限于：相机、摄影机、摄像头、扫描仪、拍照手机等。云台用于搭载拍摄装置，以实现拍摄装置的固定、或随意调节拍摄装置的姿态(例如，改变拍摄装置的高度、倾角和/或方向)以及使所述拍摄装置稳定保持在设定的姿态上。例如，当飞行器10进行航拍时，云台主要用于使所述拍摄装置稳定保持在设定的姿态上，防止拍摄装置拍摄画面抖动，保证拍摄画面的稳定。

云台14与飞行控制器连接，以实现云台14与飞行控制器之间的数据交互。例如，飞行控制器发送偏航指令至云台14，云台14获取偏航的速度和方向指令并执行，且将执行偏航指令后所产生的数据信息发送至飞行控制器，以便飞行控制器检测当前偏航状况。

云台包括：云台电机及云台基座。其中，云台电机安装于云台基座。飞行控制器也可通过动力装置13的电调来控制云台电机，具体的，飞行控制器与电调连接，电调与云台电机电连接，飞行控制器生成云台电机控制指令，电调通过云台电机控制指令以控制云台电机。

云台基座与飞行器的机身连接，用于将摄像组件固定安装于飞行器的机身上。

云台电机分别与云台基座及拍摄装置连接。该云台可以为多轴云台，与之适应的，云台电机为多个，也即每个轴设置有一个云台电机。云台电机一方面可带动拍摄装置的转动，从而满足拍摄转轴的水平旋转和俯仰角度的调节，通过手动远程控制云台电机旋转或利用程序让电机自动旋转，从而达到全方位扫描监控的作用；另一方面，在飞行器进行航拍的过程中，通过云台电机的转动实时抵消拍摄装置受到的扰动，防止拍摄装置抖动，保证拍摄画面的稳定。

拍摄装置搭载于云台上，拍摄装置上设置有惯性测量单元(Inertialmeasurement unit，IMU)，该惯性测量单元用于测量物体三轴姿态角(或角速率)以及加速度的装置。一般的，一个IMU内会装有三轴的陀螺仪和三个方向的加速度计，来测量物体在三维空间中的角速度和加速度，并以此解算出物体的姿态。为了提高可靠性，还可以为每个轴配备更多的传感器。一般而言IMU要安装在飞行器的重心上。

在对飞行器的姿态进行控制的过程中，飞行器的偏航角是对飞行器的姿态进行控制中的重要参数，需要基于飞行器的偏航角，来控制驱动电机。通过飞行器的控制器实时获取飞行器的偏航角，为飞行器的姿态控制提供必要的姿态信息。也即飞行器的偏航角正确估算对飞行器的姿态控制尤其重要，若飞行器的偏航角估算错误，飞行器轻则无法按照预设的方向或轨迹飞行，重则可能失稳以致炸机。

在室内环境中，由于没有GPS信息修正，磁力计也受到严重干扰，因此导致存在缺乏足够的可用信息来进行偏航角的修正的问题，而且，由于陀螺仪积分本身存在漂移特性，因此在室内飞行或悬停时，飞行器容易发生偏航角偏移。

目前，飞行器在室内的飞行主要靠视觉信息修正或磁力计修正来修正偏航角，而视觉信息修正对于无视觉的飞机来说不可取，并且，由于视觉运算量大，对于视觉单元运算力较弱的飞机，会影响其他视觉信息的解算，而若要不影响，则需要更换更好的视觉模块，增加成本，而采用磁力计修正的方法容易受到在干扰时，飞行器偏航角偏差严重或漂移。

因此，基于上述问题，本发明实施例主要目的在于提供一种飞行器的偏航角修正方法、装置及飞行器，可以基于IMU数据以及磁力计数据，对飞行器的偏航角进行修正，解决室内的飞行器依赖视觉信息进行偏航角修正以及室内磁干扰影响偏航角修正的问题，从而提高飞行器在室内飞行或悬停的稳定性。

本发明实施例通过获取IMU数据以及磁力计数据，计算偏航角初始值以及偏航角相对值，并对偏航角初始值以及偏航角相对值进行融合，该融合方法可避免室内的磁干扰，也即在缺乏GPS信号与强磁干扰环境下，也能保证飞行器的飞行或悬停的稳定性。

下面结合附图，对本发明实施例作进一步阐述。

实施例一

请参阅图2，图2是本发明实施例提供的一种飞行器的偏航角修正方法的原理框图；

如图2所示，通过获取IMU数据以及磁力计数据，通过对所述IMU数据进行校准、坐标系转换，获取IMU加速度以及IMU角速度，对飞行器进行静止检测，生成静止标志位信号，将所述静止标志位信号输入飞行器的使能模块，根据所述静止标志位信号的上升沿，将磁力计偏航角输出作为偏航角初始值，并且，通过对磁力计数据进行标准矩阵旋转变换，生成磁力计偏航角，根据磁力计偏航角与当前的融合偏航角，计算偏航角偏差角，对所述偏航角偏差角进行判定及处理，生成偏航角相对偏差角，根据所述偏航角相对偏差角，生成偏航角角速度补偿量，还通过将IMU角速度以及根据磁力计数据生成的偏航角角速度补偿量进行融合，生成修正后的加速度，对所述修正后的加速度进行积分，得到偏航角相对值，将所述偏航角初始值和偏航角相对值进行融合，生成融合偏航角。

请再参阅图3，图3是本发明实施例提供的一种偏航角偏航角偏差判定及处理算法的示意图；

如图3所示，通过获取对地高度、飞行高度等数据，并对上述数据进行相应的逻辑运算或处理，生成偏航角相对偏差角。

请参阅图4，图4是本发明实施例提供的一种飞行器的偏航角修正方法的流程示意图；

其中，该飞行器的偏航角修正方法可由各种具有一定逻辑处理能力的电子设备执行，如飞行器、控制芯片等，该飞行器可以包括无人机、无人船等。以下电子设备以飞行器为例进行说明。其中，飞行器连接有云台，云台包括云台电机及云台基座，其中，云台可以为多轴云台，如两轴云台、三轴云台，以下三轴云台为例进行说明。对于该飞行器及云台的具体结构的描述可以参考上述描述，因此，在此处不作赘述。

如图4所示，所述方法应用于飞行器，比如，无人机，所述方法包括：

步骤S10：获取IMU数据以及磁力计数据，所述IMU数据包括IMU加速度信息和IMU角速度信息；

具体的，所述飞行器设置有姿态传感器组件，所述姿态传感器组件包括：惯性测量单元(Inertial measurement unit，IMU)、磁力计等，其中，所述IMU用于获取IMU数据，所述磁力计用于获取磁力计数据，所述惯性测量单元包括陀螺仪以及加速度计，所述陀螺仪用于获取IMU角速度，所述加速度计用于获取IMU加速度信息，所述IMU数据包括：IMU加速度信息以及IMU角速度信息，所述磁力计数据包括：磁场强度信息。

具体的，通过惯性测量单元获取IMU数据，并对所述IMU数据进行校准、坐标系转换，生成IMU加速度信息以及IMU角速度信息，其中，所述IMU加速度信息为惯性测量单元的测量数据经过校准矩阵进行校准以及机体坐标系到地面坐标系的坐标变换之后，所得到的地面坐标系下的加速度信息。可以理解的是，所述校准矩阵是用户在要飞行的地方校准得到的，校准矩阵在地球上任意地方都不同，飞行器在报磁力计干扰，要求用户校准之后才能确定所述校准矩阵。

其中，所述机体坐标系到地面坐标系的转换通过旋转变换矩阵完成，具体的，根据所述飞行器的姿态角，生成旋转变换矩阵，通过所述旋转变换矩阵，将所述IMU数据从机体坐标系转换到地面坐标系，生成所述IMU加速度信息以及所述IMU角速度信息。具体的，所述飞行器的姿态角包括：偏航角、俯仰角以及翻滚角，其中，所述偏航角为当前的融合偏航角，即实时的融合偏航角会用于计算旋转变换矩阵，进而用于下一次的融合，不断更新所述融合偏航角。例如：所述旋转变换矩阵为3*3的矩阵，其中包含了所述偏航角、俯仰角、翻滚角的正弦余弦函数，并根据具体情况选择不同的函数，一般而言，通过先转动偏航角，再转动俯仰角，最后转动翻滚角，例如：所述旋转变换矩阵为：

其中，(φ,θ,ψ)为所述姿态角，φ为所述姿态角中的翻滚角，θ为所述姿态角中的俯仰角，ψ为所述姿态角中的偏航角。

步骤S20：根据所述磁力计数据，确定磁力计偏航角；

其中，所述磁力计数据通过磁力计获取，所述磁力计数据包括：磁场强度信息，所述磁场强度为三轴磁场强度，由于磁力计测量的磁力计数据是机体坐标系下的三轴磁场强度，因此需要通过校准矩阵去除bias和交叉耦合，并且，通过旋转矩阵将其变换至地面坐标系下。具体的，请再参阅图5，图5是图4中的步骤S20的细化流程图；

如图5所示，所述根据所述磁力计数据，确定磁力计偏航角，包括：

步骤S21：对所述磁力计数据进行校准，生成校准后的磁力计数据；

其中，根据预设的校准矩阵对所述磁力计数据进行校准，生成校准后的磁力计数据；具体的，所述预设的校准矩阵是用户在要飞行的地方校准得到的，校准矩阵在地球上任意地方都不同，飞行器在报磁力计干扰，要求用户校准之后才能确定所述校准矩阵。

步骤S22：获取所述飞行器的姿态角并根据所述飞行器的姿态角，生成旋转变换矩阵；

具体的，所述旋转变换矩阵用于将机体坐标系转换为地面坐标系，所述飞行器的姿态角包括：偏航角、俯仰角、翻滚角，通过获取所述飞行器的姿态角，其中，所述偏航角为当前的融合偏航角，即实时的融合偏航角会用于计算旋转变换矩阵，进而用于下一次的融合，不断更新所述融合偏航角。所述旋转变换矩阵为3*3的矩阵，其中包含了所述偏航角、俯仰角、翻滚角的正弦余弦函数，并根据具体情况选择不同的函数，一般而言，通过先转动偏航角，再转动俯仰角，最后转动翻滚角，例如：所述旋转变换矩阵为：

其中，(φ,θ,ψ)为所述姿态角，φ为所述姿态角中的翻滚角，θ为所述姿态角中的俯仰角，ψ为所述姿态角中的偏航角。

步骤S23：利用所述旋转变换矩阵对所述校准后的磁力计数据进行坐标变换，以生成所述地面坐标系下的磁力计数据；

具体的，将所述校准后的磁力计数据，即所述磁场强度，乘以所述旋转变换矩阵，生成所述地面坐标系下的磁场强度，相当于对所述磁力计数据进行机体坐标系和地面坐标系之间的变换，通过坐标变换后，以生成所述地面坐标系下的磁力计数据。

步骤S24：根据所述地面坐标系下的磁力计数据，对比所述飞行器在当前位置下的标准磁场的磁力计数据，计算所述磁力计偏航角。

具体的，所述飞行器的当前位置对应一标准磁场，所述磁力计三轴读数组成一个向量，所述当前位置的标准磁场的磁力计数据对应一向量，通过将所述地面坐标系下的磁力计数据，对比所述飞行器的当前位置的标准磁场的磁力计数据，计算两者之间的向量夹角，将所述向量夹角作为所述磁力计偏航角。

步骤S30：根据所述磁力计偏航角，确定偏航角初始值；

具体的，所述飞行器设置有使能模块，所述使能模块包括输入端和输出端，当所述使能模块接受到静止标志位信号的上升沿时，所述使能模块将所述磁力计偏航角输出，作为偏航角初始值。

具体的，请再参阅图6，图6是图4中的步骤S30的细化流程图；

如图6所示，所述根据所述磁力计偏航角，确定偏航角初始值，包括：

步骤S31：判断所述飞行器在当前时刻是否由静止状态变为运动状态；

具体的，根据所述飞行器的静止状态，确定所述飞行器的静止标志位的信号；其中，所述飞行器的静止标志位用于表征所述飞行器的静止状态，所述根据所述飞行器的静止状态，确定所述飞行器的静止标志位的信号，包括：获取所述IMU数据中的IMU加速度以及IMU角速度，通过对所述IMU加速度以及IMU角速度进行静止检测，确定所述飞行器的静止状态，若所述飞行器的静止状态为静止，则所述静止状态位的值为1，若所述飞行器的静止状态为运动，则所述静止状态位的值为0，可以理解的是，静止时所述IMU加速度以及IMU角速度的数据波动特别小，很稳定，运动时所述IMU加速度以及IMU角速度的数据波动变化大，根据此原理确定所述飞行器的静止状态。其中，所述方法具体包括：根据旋转变换矩阵，对所述IMU数据进行机体坐标系和地面坐标系的转换，生成地面坐标系下的IMU加速度以及地面坐标系下的IMU角速度；根据所述地面坐标系下的IMU加速度以及地面坐标系下的IMU角速度，确定所述飞行器的静止状态，生成所述飞行器的静止标志位。

步骤S32：若是，则将所述磁力计偏航角作为所述偏航角初始值。

具体的，将所述静止状态位的信号输入所述飞行器的使能模块，当所述使能模块检测到所述静止状态位的信号存在上升沿，将所述磁力计偏航角输出作为所述偏航角初始值。其中，所述静止状态位的信号在飞行器静止时为0，在飞行器运动时为1，将所述静止状态位的信号输入所述飞行器的使能模块，当所述使能模块检测到所述静止状态位的信号存在上升沿，即所述静止状态位从0到1时，所述使能模块将所述磁力计偏航角输出作为所述偏航角初始值。

步骤S40：根据所述磁力计数据，确定偏航角角速度补偿量；

具体的，由于室内磁干扰严重，因此IMU测量的IMU数据需要进行修正，所述偏航角角速度补偿量用于对IMU获取的IMU角速度进行修正，需要通过所述磁力计偏航角，确定偏航角角速度补偿量，具体的，请参阅图7，图7是图4中的步骤S40的细化流程图；

如图7所示，所述根据所述磁力计偏航角，确定偏航角角速度补偿量，包括：

步骤S41：根据所述磁力计偏航角，确定偏航角偏差角；

具体的，所述根据所述磁力计偏航角，确定偏航角偏差角，包括：根据所述磁力计偏航角和上一时刻的融合偏航角，确定所述偏航角偏差角。其中，所述当前的融合偏航角为实时的融合偏航角，将所述当前的融合偏航角与所述磁力计偏航角的差值作为所述偏航角偏差角。

步骤S42：根据所述偏航角偏差角，确定偏航角相对偏差角；

具体的，所述根据所述偏航角偏差角，确定偏航角相对偏差角，包括：

获取所述飞行器的对地高度和所述飞行器的飞行高度；

根据所述偏航角偏差角、所述飞行器的对地高度和所述飞行器的飞行高度，确定所述偏航角相对偏差角。

具体的，所述根据所述偏航角偏差角、所述飞行器的对地高度和所述飞行器的飞行高度，确定所述偏航角相对偏差角，包括：

根据所述飞行器的对地高度和所述飞行器的飞行高度，确定偏航角偏差相对偏移量；

根据所述偏航角偏差角和所述偏航角偏差相对偏移量，确定所述偏航角相对偏差角。

具体的，所述根据所述飞行器的对地高度和所述飞行器的飞行高度，确定所述偏航角偏差相对偏移量，包括：

当满足以下条件中的任一项时，确定所述偏航角偏差角为所述偏航角偏差相对偏移量：

所述飞行器的对地高度满足第一预设条件；

所述飞行器的飞行高度满足第二预设条件时；以及

所述偏航角偏差角的微分满足第三预设条件。

其中，所述第一预设条件为：所述飞行器的对地高度大于0.4m，且持续时间不小于0.5s，所述第二预设条件为：所述飞行器的飞行高度大于0.4m，且持续时间不小于0.5s，所述第三预设条件为：所述偏航角偏差角的微分的绝对值小于0.1且持续时间不小于0.5s。

其中，所述偏航角相对偏差角为对所述偏航角偏差角进行判定及处理后的偏航角相对偏差量。具体的，请再参阅图8，图8是图7中的步骤S42的细化流程图；

如图8所示，所述根据所述偏航角偏差角，确定偏航角相对偏差角，包括：

步骤S421：根据所述偏航角偏差角，确定偏航角偏差相对偏移量；

具体的，所述飞行器设置有锁存模块，所述锁存模块用于锁存所述偏航角偏差角，当接收到有效信号时，所述锁存模块将所述偏航角偏差角输出作为所述偏航角偏差相对偏移量，并持续锁存所述偏航角偏差角，直至下一个有效信号到来，才更新所述偏航角偏差相对偏移量。

请再参阅图9，图9是图8中的步骤S421的细化流程图；

如图9所示，所述根据所述偏航角偏差角，确定偏航角偏差相对偏移量，包括：

步骤S4211：获取高度重置脉冲信号以及微分重置脉冲信号；

具体的，所述获取高度重置脉冲，包括：

获取所述飞行器的对地高度以及飞行高度；

具体的，所述飞行器的对地高度指的是飞行器飞行时所在位置距离当前正下方地面的距离，所述飞行器的飞行高度指的是所述飞行器飞行时所在的位置距离起飞点的高度落差，所述飞行器设置有超声波传感器和/或TOF传感器(Time of Flight，TOF)，所述飞行器的对地高度和飞行高度通过所述超声波传感器和/或TOF传感器获取。

根据所述对地高度以及飞行高度，确定所述飞行器的高度判定标志位信号；

其中，所述高度判定标志位信号用于避免地板里面钢筋混凝土的磁干扰，具体的，预设对地高度阈值及其持续时间阈值，若所述飞行器的对地高度大于所述对地高度阈值，并且所述对地高度大于所述对地高度阈值的持续时间大于所述持续时间阈值，则所述高度判定标志位信号输出高电平，否则，所述高度判定标志位信号输出低电平；或者，预设飞行高度阈值及其持续时间阈值，若所述飞行器的飞行高度大于所述飞行高度阈值，并且所述飞行器的飞行高度大于所述飞行高度阈值的持续时间大于所述持续时间阈值，则所述高度判定标志位信号输出高电平，否则，所述高度判定标志位输出低电平，例如：所述预设对地高度阈值及其持续时间阈值分别为0.4m和0.5s，预设飞行高度阈值及其持续时间阈值分别为0.4m和0.5s，当飞机对地高度>0.4m并持续0.5s以上时，高度判定标志位信号输出1；或者，当飞机飞行高度>0.4m并持续0.5s以上时，高度判定标志位信号输出1；否则，高度判定标志位信号输出0。可以理解的是，本发明实施例中的对地高度阈值及其持续时间阈值，以及，飞行高度阈值及其持续时间阈值可以根据具体需求具体设置，均在本发明的保护范围内。

若所述飞行器的高度判定标志位的信号存在上升沿，则生成高度重置脉冲信号。

具体的，所述飞行器的控制器设置有上升沿检测模块，所述上升沿检测模块获取所述高度判定标志位信号，并判断所述高度判定标志位信号是否存在上升沿，若是，则生成高度重置脉冲信号。

具体的，所述获取微分重置脉冲信号，包括：

对所述偏航角偏差角进行微分以及滤波处理，生成偏航角微分值；

具体的，对所述偏航角偏差角进行微分及滤波处理，通过对所述偏航角进行微分，获取初始的偏航角微分值，对所述初始的偏航角微分值进行滤波处理，生成最终的偏航角微分值，即所述偏航角微分值，其中，所述滤波处理包括低通滤波和卡尔曼滤波，分别通过所述飞行器的低通滤波器和卡尔曼滤波器完成。

对所述偏航角微分值进行逻辑判断，确定偏航角微分判定标志位信号；

具体的，所述飞行器的控制器设置有判断逻辑模块，所述判断逻辑模块获取所述偏航角微分值，对所述偏航角微分值进行逻辑判断，生成所述偏航角微分判定标志位信号，其中，所述判断逻辑模块对所述偏航角微分值的判断逻辑，包括：预设微分值绝对值阈值及其持续时间阈值，若所述偏航角微分值小于所述微分值绝对值阈值，并且，所述偏航角微分值小于所述微分值绝对值阈值的持续时间大于所述持续时间阈值，则所述偏航角微分判定标志位信号输出高电平，否则，所述偏航角微分判定标志位信号输出低电平，例如：预设所述微分值绝对值阈值为0.1，所述持续时间阈值为0.5s，若所述偏航角微分值的绝对值小于0.1，并且，所述偏航角微分值的绝对值小于0.1的持续时间大于所述0.5s，则所述偏航角微分判定标志位信号输出1，否则，所述偏航角微分判定标志位信号输出0。可以理解的是，所述微分值绝对值阈值及其持续时间阈值可以根据具体需求具体设置，均在本发明的保护范围内。

若所述偏航角微分判定标志位的信号存在上升沿，则生成微分重置脉冲信号。

具体的，所述飞行器的上升沿检测模块获取所述偏航角微分判定标志位信号，并判断所述偏航角微分判定标志位信号是否存在上升沿，若存在，则生成微分重置脉冲信号，并且所述微分重置脉冲信号输出高电平，否则，所述微分重置脉冲信号输出低电平。

步骤S4212：对所述高度重置脉冲信号以及所述微分重置脉冲信号进行逻辑判断，生成偏航角相对偏移量重置脉冲标志位信号；

具体的，对所述高度重置脉冲信号以及所述微分重置脉冲信号进行逻辑或运算，并将逻辑或运算之后的结果作为所述偏航角相对偏移量重置脉冲标志位信号。例如：所述高度重置脉冲信号或者所述微分重置脉冲信号任意一个为高电平，则所述偏航角相对偏移量重置脉冲标志位信号为高电平，若所述高度重置脉冲信号以及所述微分重置脉冲信号均为低电平，则所述偏航角相对偏移量重置脉冲标志位信号为低电平。

步骤S4213：向所述飞行器的锁存模块发送所述偏航角相对偏移量重置脉冲标志位信号，若所述飞行器的锁存模块接收到所述偏航角相对偏移量重置脉冲标志位的有效信号，将所述偏航角偏差角输出作为偏航角偏差相对偏移量。

具体的，所述有效信号指的是高电平信号，即1，若所述偏航角相对偏移量重置脉冲标志位信号为高电平，则所述飞行器的锁存模块将所述偏航角偏差角输出作为偏航角偏差相对偏移量，若所述偏航角相对偏移量重置脉冲标志位信号为低电平，则所述飞行器的锁存模块持续锁存所述偏航角偏差角，直至接受到所述偏航角相对偏移量重置脉冲标志位信号的有效信号，即所述偏航角相对偏移量重置脉冲标志位信号为高电平信号。

步骤S422：根据所述偏航角偏差角以及所述偏航角偏差相对偏移量，确定偏航角误差相对补偿值；

具体的，通过公式：偏航角误差相对补偿值＝偏航角偏差角-偏航角偏差相对偏移量，计算所述偏航角误差相对补偿值。

步骤S423：根据所述偏航角误差相对补偿值，确定所述偏航角相对偏差角。

具体的，请参阅图10，图10是图8中的步骤S423的细化流程图；

如图10所示，所述根据所述偏航角误差相对补偿值，确定所述偏航角相对偏差角，包括：

步骤S4231：对所述偏航角误差相对补偿值进行逻辑判断，生成偏航角误差相对补偿值判定标志位信号；

具体的，所述飞行器的判断逻辑模块获取所述偏航角误差相对补偿值，并对所述偏航角误差相对补偿值进行逻辑判断，其中，所述判断逻辑模块对所述偏航角误差相对补偿值的判断逻辑，包括：预设补偿值绝对值阈值及其持续时间阈值，若所述偏航角误差相对补偿值小于所述补偿值绝对值阈值，并且，所述偏航角误差相对补偿值小于所述补偿值绝对值阈值的持续时间大于所述持续时间阈值，则所述偏航角误差相对补偿值判定标志位信号输出高电平，否则，所述偏航角误差相对补偿值判定标志位信号输出低电平，例如：预设所述补偿值微分值绝对值阈值为0.1，所述持续时间阈值为0.5s，若所述偏航角误差相对补偿值的绝对值小于0.1，并且，所述偏航角误差相对补偿值的绝对值小于0.1的持续时间大于所述0.5s，则所述偏航角误差相对补偿值判定标志位信号输出1，否则，所述偏航角误差相对补偿值判定标志位信号输出0。可以理解的是，所述补偿值绝对值阈值及其持续时间阈值可以根据具体需求具体设置，均在本发明的保护范围内。

步骤S4232：将所述高度判定标志位信号、偏航角微分判定标志位信号以及所述偏航角误差相对补偿值判定标志位信号进行逻辑判断，生成偏航角偏差补偿标志位；

具体的，对所述高度判定标志位信号、偏航角微分判定标志位信号以及所述偏航角误差相对补偿值判定标志位信号进行逻辑与运算，确定所述偏航角偏差补偿标志位的值，所述偏航角偏差补偿标志位用于确定所述偏航角误差相对补偿值能否用于补偿，若所述偏航角偏差补偿标志位为高电平，则代表可以用来补偿，若所述偏航角偏差补偿标志位为低电平，则代表不能用于补偿。例如：所述高度判定标志位信号、偏航角微分判定标志位信号以及所述偏航角误差相对补偿值判定标志位信号均为高电平，则所述飞行器的判断逻辑模块对所述高度判定标志位信号、偏航角微分判定标志位信号以及所述偏航角误差相对补偿值判定标志位信号进行逻辑与运算的值为高电平，则所述偏航角偏差补偿标志位输出高电平，或者，若所述高度判定标志位信号、偏航角微分判定标志位信号以及所述偏航角误差相对补偿值判定标志位信号任意一个为低电平，则所述飞行器的判断逻辑模块对所述高度判定标志位信号、偏航角微分判定标志位信号以及所述偏航角误差相对补偿值判定标志位信号进行逻辑与运算的值为低电平，则所述偏航角偏差补偿标志位输出低电平。

步骤S4233：将所述偏航角偏差补偿标志位的信号输入所述飞行器的使能模块，若所述飞行器的使能模块接收到所述偏航角偏差补偿标志位的有效信号，则所述使能模块将所述偏航角误差相对补偿值输出作为所述偏航角相对偏差角。

具体的，若对所述高度判定标志位信号、偏航角微分判定标志位信号以及所述偏航角误差相对补偿值判定标志位信号进行逻辑与运算的结果为高电平，即所述偏航角偏差补偿标志位输出有效信号，则所述飞行器的使能模块将所述偏航角误差相对补偿值输出作为所述偏航角相对偏差角。

步骤S43：根据所述偏航角相对偏差角，确定所述偏航角角速度补偿量。

具体的，所述飞行器设置有反馈控制器，将所述偏航角相对偏差角输入所述反馈控制器，所述反馈控制器通过反馈控制算法对所述偏航角相对偏差角进行计算，确定所述偏航角角速度补偿量，例如：所述偏航角角速度补偿量与所述偏航角相对偏差角负相关，例如：偏航角角速度补偿量＝-K*偏航角相对偏差角，其中，所述K为工程师设计值。

步骤S50：根据所述IMU角速度信息以及所述偏航角角速度补偿量，确定修正后的角速度；

具体的，对所述IMU角速度信息以及所述偏航角角速度补偿量进行求和，将求得的和作为所述修正后的角速度，例如：所述修正后的角速度＝所述IMU角速度信息+所述偏航角角速度补偿量。

步骤S60：根据所述修正后的角速度，确定偏航角相对值；

具体的，对所述修正后的角速度进行积分，将所述修正后的角速度的积分值作为所述偏航角相对值。

步骤S70：根据所述偏航角初始值以及所述偏航角相对值，生成融合偏航角。

具体的，将所述偏航角初始值和所述偏航角相对值进行求和，将求和的结果作为所述融合偏航角，例如：所述融合偏航角＝所述偏航角初始值+所述偏航角相对值。

具体的，所述飞行器的每一个采样步长都有做一次误差计算，通过反馈回路一直不停歇的无限进行。融合好的融合偏航角要去与磁力计的偏航角作差，生成偏航角误差角，无休止的进行，直到飞机断电。所述融合偏航角也是无休止的在更新，每一个采样时刻对应唯一的融合偏航角，所述偏航角误差角为所述磁力计偏航角和所述融合偏航角的差值。

在本发明实施例中，通过提供一种飞行器的偏航角修正方法，所述方法包括：获取IMU数据以及磁力计数据，其中，所述IMU数据包括IMU加速度信息和IMU角速度信息；根据所述磁力计数据，确定磁力计偏航角；根据所述磁力计偏航角，确定偏航角初始值；根据所述磁力计数据，确定偏航角角速度补偿量；根据所述IMU角速度信息以及所述偏航角角速度补偿量，确定修正后的角速度；根据所述修正后的角速度，确定偏航角相对值；根据所述偏航角初始值以及所述偏航角相对值，生成融合偏航角。通过获取IMU数据以及磁力计数据，计算偏航角初始值以及偏航角相对值，并对偏航角初始值以及偏航角相对值进行融合，充分地、合理地、巧妙地利用磁力计信息来进行Yaw角修正，并且，不依赖视觉信息，只通过受干扰的磁力计来稳定偏航角，提升融合精度，可以有效避免室内的磁干扰，也即在缺乏GPS信号与强磁干扰环境下，也能保证飞行器的飞行或悬停的稳定性。

实施例二

请参阅图11，图11是本发明实施例提供的一种飞行器的偏航角修正装置的示意图；

如图11所示，该飞行器的偏航角修正装置100，应用于飞行器，所述装置包括：

获取模块10，用于获取IMU数据以及磁力计数据，其中，所述IMU数据包括IMU加速度信息和IMU角速度信息；

确定模块20，用于根据所述磁力计数据，确定磁力计偏航角；

根据所述磁力计偏航角，确定偏航角初始值；

根据所述磁力计偏航角，确定偏航角角速度补偿量；

根据所述IMU角速度信息以及所述偏航角角速度补偿量，确定修正后的角速度；

根据所述修正后的角速度，确定偏航角相对值；

融合偏航角生成模块30，用于根据所述偏航角初始值以及所述偏航角相对值，生成融合偏航角。

请再参阅图12，图12是图11中的确定模块的结构示意图；

如图12所示，所述确定模块20包括校准及坐标系转换模块21、静止状态检测模块22、偏航角偏差判定及处理模块23以及反馈控制模块24；

具体的，所述校准及坐标系转换模块21用于：

对所述磁力计数据进行校准，生成校准后的磁力计数据；

获取所述飞行器的姿态角并根据所述飞行器的姿态角，生成旋转变换矩阵；

利用所述旋转变换矩阵对所述校准后的磁力计数据进行坐标变换，以生成所述地面坐标系下的磁力计数据；

根据所述地面坐标系下的磁力计数据，对比所述飞行器在当前位置下的标准磁场的磁力计数据，计算所述磁力计偏航角。

在本发明实施例中，所述确定模块20还包括静止状态检测模块22，所述静止状态检测模块22用于：

判断所述飞行器在当前时刻是否由静止状态变为运动状态；

若是，则将所述磁力计偏航角作为所述偏航角初始值。

具体的，所述偏航角偏差判定及处理模块23用于：

根据所述磁力计偏航角，确定偏航角偏差角；

根据所述偏航角偏差角，确定偏航角相对偏差角；

根据所述偏航角相对偏差角，确定所述偏航角角速度补偿量。

在本发明实施例中，所述偏航角偏差判定及处理模块，用于：

根据所述磁力计偏航角和上一时刻的融合偏航角，确定所述偏航角偏差角。

具体的，所述偏航角偏差判定及处理模块23，用于：

获取所述飞行器的对地高度和所述飞行器的飞行高度；

根据所述偏航角偏差角、所述飞行器的对地高度和所述飞行器的飞行高度，确定所述偏航角相对偏差角。

具体的，请再参阅图13，图13是图12中的偏航角偏差判定及处理模块的结构示意图；

如图13所示，所述偏航角偏差判定及处理模块23，包括：逻辑或运算模块231以及逻辑与运算模块232；

具体的，所述逻辑或运算模块231用于：

当满足以下条件中的任一项时，确定所述偏航角偏差角为所述偏航角偏差相对偏移量：

所述飞行器的对地高度满足第一预设条件；

所述飞行器的飞行高度满足第二预设条件时；以及

所述偏航角偏差角的微分满足第三预设条件。

其中，所述第一预设条件为：所述飞行器的对地高度大于0.4m，且持续时间不小于0.5s。

其中，所述第二预设条件为：所述飞行器的飞行高度大于0.4m，且持续时间不小于0.5s。

其中，所述第三预设条件为：所述偏航角偏差角的微分的绝对值小于0.1且持续时间不小于0.5s。

具体的，所述逻辑与运算模块232用于：

当均满足以下条件时，确定所述偏航角误差相对补偿值为所述偏航角相对偏差角：

所述飞行器的对地高度满足所述第一预设条件或当所述飞行器的飞行高度满足所述第二预设条件；

所述偏航角偏差角的微分满足所述第三预设条件；且

偏航角误差相对补偿值满足第四预设条件，其中，所述偏航角误差相对补偿值为所述偏航角偏差角与所述偏航角偏差相对偏移量的差。

其中，所述第四预设条件为：所述偏航角误差相对补偿值的绝对值小于0.1且持续时间不小于0.5s。

具体的，所述反馈控制模块24用于：

通过反馈控制算法对所述偏航角相对偏差角进行计算，以确定所述偏航角角速度补偿量。

在本发明实施例中，通过提供一种飞行器的偏航角修正装置，应用于飞行器，所述装置包括：获取模块，用于获取IMU数据以及磁力计数据，其中，所述IMU数据包括IMU加速度信息和IMU角速度信息；确定模块，用于：根据所述磁力计数据，确定磁力计偏航角；根据所述磁力计偏航角，确定偏航角初始值；根据所述磁力计数据，确定偏航角角速度补偿量；根据所述IMU角速度信息以及所述偏航角角速度补偿量，确定修正后的角速度；以及根据所述修正后的角速度，确定偏航角相对值；融合偏航角生成模块，用于根据所述偏航角初始值以及所述偏航角相对值，生成融合偏航角。通过上述方式，本发明解决室内的飞行器依赖视觉信息进行偏航角修正以及室内磁干扰影响偏航角修正的问题，提高飞行器在室内飞行或悬停的稳定性。

请参阅图14，图14是本发明实施例提供一种飞行器的硬件结构示意图。其中，该飞行器可以是无人飞行器(unmanned aerial vehicle，UAV)，无人飞船等电子设备。

如图14所示，该飞行器1400包括一个或多个处理器1401以及存储器1402。其中，图14中以一个处理器1401为例。

处理器1401和存储器1402可以通过总线或者其他方式连接，图14中以通过总线连接为例。

存储器1402作为一种非易失性计算机可读存储介质，可用于存储非易失性软件程序、非易失性计算机可执行程序以及模块，如本发明实施例中的一种飞行器的偏航角修正方法对应的单元(例如，图11至图13所述的各个模块或单元)。处理器1401通过运行存储在存储器1402中的非易失性软件程序、指令以及模块，从而执行飞行器的偏航角修正方法的各种功能应用以及数据处理，即实现上述方法实施例飞行器的偏航角修正方法以及上述装置实施例的各个模块和单元的功能。

存储器1402可以包括高速随机存取存储器，还可以包括非易失性存储器，例如至少一个磁盘存储器件、闪存器件、或其他非易失性固态存储器件。在一些实施例中，存储器1402可选包括相对于处理器1401远程设置的存储器，这些远程存储器可以通过网络连接至处理器1401。上述网络的实例包括但不限于互联网、企业内部网、局域网、移动通信网及其组合。

所述模块存储在所述存储器1402中，当被所述一个或者多个处理器1401执行时，执行上述任意方法实施例中的飞行器的偏航角修正方法，例如，执行以上描述的图4至图10所示的各个步骤；也可实现图11至图13所述的各个模块或单元的功能。

请参阅图15和图16，所述飞行器1400还包括动力系统1403，所述动力系统1403用于飞行器提供飞行动力，所述动力系统1403与处理器1401连接。所述动力系统1403包括：驱动电机14031及电调14032，所述电调14032与驱动电机14031电连接，用于控制所述驱动电机14031。具体的，所述电调14032基于处理器1401执行上述飞行器的偏航角修正方法后得到的融合偏航角，生成控制指令，通过控制指令控制该驱动电机14031。

所述飞行器1400可执行本发明实施例一所提供的飞行器的偏航角修正方法，具备执行方法相应的功能模块和有益效果。未在飞行器实施例中详尽描述的技术细节，可参见本发明实施例一所提供的飞行器的偏航角修正方法。

本发明实施例提供了一种计算机程序产品，所述计算机程序产品包括存储在非易失性计算机可读存储介质上的计算机程序，所述计算机程序包括程序指令，当所述程序指令被计算机执行时，使所述计算机执行如上所述的飞行器的偏航角修正方法。例如，执行以上描述的图4中的方法步骤S10至步骤S70。

本发明实施例还提供了一种非易失性计算机存储介质，所述计算机存储介质存储有计算机可执行指令，该计算机可执行指令被一个或多个处理器执行，例如图14中的一个处理器1401，可使得上述一个或多个处理器可执行上述任意方法实施例中的飞行器的偏航角修正方法，例如，执行上述任意方法实施例中的飞行器的偏航角修正方法，例如，执行以上描述的图4至图10所示的各个步骤；也可实现图11至图13所述的各个模块或单元的功能。

以上所描述的装置或设备实施例仅仅是示意性的，其中所述作为分离部件说明的单元模块可以是或者也可以不是物理上分开的，作为模块单元显示的部件可以是或者也可以不是物理单元，即可以位于一个地方，或者也可以分布到多个网络模块单元上。可以根据实际的需要选择其中的部分或者全部模块来实现本实施例方案的目的。

通过以上的实施方式的描述，本领域的技术人员可以清楚地了解到各实施方式可借助软件加通用硬件平台的方式来实现，当然也可以通过硬件。基于这样的理解，上述技术方案本质上或者说对相关技术做出贡献的部分可以以软件产品的形式体现出来，该计算机软件产品可以存储在计算机可读存储介质中，如ROM/RAM、磁碟、光盘等，包括若干指令用直至得一台计算机设备(可以是个人计算机，服务器，或者网络设备等)执行各个实施例或者实施例的某些部分所述的方法。

最后应说明的是：以上实施例仅用以说明本发明的技术方案，而非对其限制；在本发明的思路下，以上实施例或者不同实施例中的技术特征之间也可以进行组合，步骤可以以任意顺序实现，并存在如上所述的本发明的不同方面的许多其它变化，为了简明，它们没有在细节中提供；尽管参照前述实施例对本发明进行了详细的说明，本领域的普通技术人员应当理解：其依然可以对前述各实施例所记载的技术方案进行修改，或者对其中部分技术特征进行等同替换；而这些修改或者替换，并不使相应技术方案的本质脱离本申请各实施例技术方案的范围。

Claims (28)

1.一种飞行器的偏航角修正方法，应用于飞行器，其特征在于，所述方法包括：

获取IMU数据以及磁力计数据，其中，所述IMU数据包括IMU加速度信息和IMU角速度信息；

根据所述磁力计数据，确定磁力计偏航角；

根据所述磁力计偏航角，确定偏航角初始值；

根据所述磁力计数据，确定偏航角角速度补偿量，其中，所述偏航角角速度补偿量与所述偏航角相对偏差角负相关；

根据所述IMU角速度信息以及所述偏航角角速度补偿量，确定修正后的角速度；

根据所述修正后的角速度，确定偏航角相对值，包括：对所述修正后的角速度进行积分，将所述修正后的角速度的积分值作为所述偏航角相对值；

根据所述偏航角初始值以及所述偏航角相对值，生成融合偏航角。

2.根据权利要求1所述的方法，其特征在于，所述根据所述磁力计数据，确定所述磁力计偏航角，包括：

对所述磁力计数据进行校准，生成校准后的磁力计数据；

获取所述飞行器的姿态角并根据所述飞行器的姿态角，生成旋转变换矩阵；

利用所述旋转变换矩阵对所述校准后的磁力计数据进行坐标变换，以生成地面坐标系下的磁力计数据；

根据地面坐标系下的磁力计数据，对比所述飞行器在当前位置下的标准磁场的磁力计数据，计算所述磁力计偏航角。

3.根据权利要求1所述的方法，其特征在于，所述根据所述磁力计偏航角，确定所述偏航角初始值，包括：

判断所述飞行器在当前时刻是否由静止状态变为运动状态；

若是，则将所述磁力计偏航角作为所述偏航角初始值。

4.根据权利要求1所述的方法，其特征在于，所述根据所述磁力计数据，确定偏航角角速度补偿量，包括：

根据所述磁力计偏航角，确定偏航角偏差角；

根据所述偏航角偏差角，确定偏航角相对偏差角；

根据所述偏航角相对偏差角，确定所述偏航角角速度补偿量。

5.根据权利要求4所述的方法，其特征在于，所述根据所述磁力计偏航角，确定偏航角偏差角，包括：

根据所述磁力计偏航角和上一时刻的融合偏航角，确定所述偏航角偏差角。

6.根据权利要求4所述的方法，其特征在于，所述根据所述偏航角偏差角，确定偏航角相对偏差角，包括：

获取所述飞行器的对地高度和所述飞行器的飞行高度；

根据所述偏航角偏差角、所述飞行器的对地高度和所述飞行器的飞行高度，确定所述偏航角相对偏差角。

7.根据权利要求6所述的方法，其特征在于，所述根据所述偏航角偏差角、所述飞行器的对地高度和所述飞行器的飞行高度，确定所述偏航角相对偏差角，包括：

根据所述飞行器的对地高度和所述飞行器的飞行高度，确定偏航角偏差相对偏移量；

根据所述偏航角偏差角和所述偏航角偏差相对偏移量，确定所述偏航角相对偏差角。

8.根据权利要求7所述的方法，其特征在于，所述根据所述飞行器的对地高度和所述飞行器的飞行高度，确定所述偏航角偏差相对偏移量，包括：

当满足以下条件中的任一项时，确定所述偏航角偏差角为所述偏航角偏差相对偏移量：

所述飞行器的对地高度满足第一预设条件；

所述飞行器的飞行高度满足第二预设条件时；以及

所述偏航角偏差角的微分满足第三预设条件。

9.根据权利要求8所述的方法，其特征在于，所述第一预设条件为：

所述飞行器的对地高度大于0.4m，且持续时间不小于0.5s。

10.根据权利要求8所述的方法，其特征在于，所述第二预设条件为：

所述飞行器的飞行高度大于0.4m，且持续时间不小于0.5s。

11.根据权利要求8所述的方法，其特征在于，所述第三预设条件为：

所述偏航角偏差角的微分的绝对值小于0.1且持续时间不小于0.5s。

12.根据权利要求8-11中任一项所述的方法，其特征在于，所述根据所述偏航角偏差角和所述偏航角偏差相对偏移量，确定所述偏航角相对偏差角，包括：

当均满足以下条件时，确定所述偏航角误差相对补偿值为所述偏航角相对偏差角：

所述飞行器的对地高度满足所述第一预设条件或当所述飞行器的飞行高度满足所述第二预设条件；

所述偏航角偏差角的微分满足所述第三预设条件；且

偏航角误差相对补偿值满足第四预设条件，其中，所述偏航角误差相对补偿值为所述偏航角偏差角与所述偏航角偏差相对偏移量的差。

13.根据权利要求12所述的方法，其特征在于，所述第四预设条件为：

所述偏航角误差相对补偿值的绝对值小于0.1且持续时间不小于0.5s。

14.根据权利要求4所述的方法，其特征在于，所述根据所述偏航角相对偏差角，确定所述偏航角角速度补偿量，包括：

通过反馈控制算法对所述偏航角相对偏差角进行计算，以确定所述偏航角角速度补偿量。

15.一种飞行器的偏航角修正装置，应用于飞行器，其特征在于，所述装置包括：

获取模块，用于获取IMU数据以及磁力计数据，其中，所述IMU数据包括IMU加速度信息和IMU角速度信息；

确定模块，用于：

根据所述磁力计数据，确定磁力计偏航角；

根据所述磁力计偏航角，确定偏航角初始值；

根据所述磁力计数据，确定偏航角角速度补偿量，其中，所述偏航角角速度补偿量与所述偏航角相对偏差角负相关；

根据所述IMU角速度信息以及所述偏航角角速度补偿量，确定修正后的角速度；以及

根据所述修正后的角速度，确定偏航角相对值，包括：对所述修正后的角速度进行积分，将所述修正后的角速度的积分值作为所述偏航角相对值；

融合偏航角生成模块，用于根据所述偏航角初始值以及所述偏航角相对值，生成融合偏航角。

16.根据权利要求15所述的装置，其特征在于，所述确定模块包括校准及坐标系转换模块，所述校准及坐标系转换模块用于：

对所述磁力计数据进行校准，生成校准后的磁力计数据；

获取所述飞行器的姿态角并根据所述飞行器的姿态角，生成旋转变换矩阵；

利用所述旋转变换矩阵对所述校准后的磁力计数据进行坐标变换，以生成地面坐标系下的磁力计数据；

根据所述地面坐标系下的磁力计数据，对比所述飞行器在当前位置下的标准磁场的磁力计数据，计算所述磁力计偏航角。

17.根据权利要求15所述的装置，其特征在于，所述确定模块还包括静止状态检测模块，所述静止状态检测模块用于：

判断所述飞行器在当前时刻是否由静止状态变为运动状态；

若是，则将所述磁力计偏航角作为所述偏航角初始值。

18.根据权利要求15所述的装置，其特征在于，所述确定模块还包括偏航角偏差判定及处理模块，所述偏航角偏差判定及处理模块用于：

根据所述磁力计偏航角，确定偏航角偏差角；

根据所述偏航角偏差角，确定偏航角相对偏差角；

根据所述偏航角相对偏差角，确定所述偏航角角速度补偿量。

19.根据权利要求18所述的装置，其特征在于，所述偏航角偏差判定及处理模块用于：

根据所述磁力计偏航角和上一时刻的融合偏航角，确定所述偏航角偏差角。

20.根据权利要求15所述的装置，其特征在于，所述偏航角偏差判定及处理模块用于：

获取所述飞行器的对地高度和所述飞行器的飞行高度；

根据所述偏航角偏差角、所述飞行器的对地高度和所述飞行器的飞行高度，确定所述偏航角相对偏差角。

21.根据权利要求20所述的装置，其特征在于，所述偏航角偏差判定及处理模块包括逻辑或运算模块，所述逻辑或运算模块用于：

当满足以下条件中的任一项时，确定所述偏航角偏差角为所述偏航角偏差相对偏移量：

所述飞行器的对地高度满足第一预设条件；

所述飞行器的飞行高度满足第二预设条件时；以及

所述偏航角偏差角的微分满足第三预设条件。

22.根据权利要求21所述的装置，其特征在于，所述第一预设条件为：

所述飞行器的对地高度大于0.4m，且持续时间不小于0.5s。

23.根据权利要求21所述的装置，其特征在于，所述第二预设条件为：

所述飞行器的飞行高度大于0.4m，且持续时间不小于0.5s。

24.根据权利要求21所述的装置，其特征在于，所述第三预设条件为：

所述偏航角偏差角的微分的绝对值小于0.1且持续时间不小于0.5s。

25.根据权利要求21-24中任一项所述的装置，其特征在于，所述偏航角偏差判定及处理模块包括逻辑与运算模块，所述逻辑与运算模块用于：

当均满足以下条件时，确定所述偏航角误差相对补偿值为所述偏航角相对偏差角：

所述飞行器的对地高度满足所述第一预设条件或当所述飞行器的飞行高度满足所述第二预设条件；

所述偏航角偏差角的微分满足所述第三预设条件；且

偏航角误差相对补偿值满足第四预设条件，其中，所述偏航角误差相对补偿值为所述偏航角偏差角与所述偏航角偏差相对偏移量的差。

26.根据权利要求25所述的装置，其特征在于，所述第四预设条件为：

所述偏航角误差相对补偿值的绝对值小于0.1且持续时间不小于0.5s。

27.根据权利要求18所述的装置，其特征在于，所述确定模块包括反馈控制模块，所述反馈控制模块用于：

通过反馈控制算法对所述偏航角相对偏差角进行计算，以确定所述偏航角角速度补偿量。

28.一种飞行器，其特征在于，包括：

机身；

机臂，与所述机身相连；

动力装置，设于所述机身和/或所述机臂，用于为所述飞行器提供飞行的动力；以及

飞行控制器，设于所述机身；

其中，所述飞行控制器包括：

至少一个处理器；以及，

与所述至少一个处理器通信连接的存储器；其中，

所述存储器存储有可被所述至少一个处理器执行的指令，所述指令被所述至少一个处理器执行，以使所述至少一个处理器能够执行权利要求1-14中任一项所述的方法。

Images