一种磁力计校准数据采集方法、装置以及飞行器与流程

本发明涉及磁力校准技术领域，尤其涉及一种磁力计校准数据采集方法、装置以及飞行器。

背景技术：

飞行器的航向控制，直接关系到飞行器的飞行稳定性和飞行安全性。通常情况下，飞行器航向通过各传感器的数据进行融合得到。飞行器滚转角度、俯仰角度、偏航角度三个通道姿态中，偏航角度也称航向角，其是由磁力计给出初值，其他传感器对其进行后期修正最终得到融合后的航向角。磁力计测量地磁场数据，其给出的采样数据极易受环境影响，所以其给定的初值往往会偏离真正的航向。

随着飞行器飞行，其他传感器参数与航向角融合过程，准确的航向角信息会被获得，当该航向角与磁力计给定的初始航向角具有较大偏差时，飞机会对航向进行大幅度修正，体现在飞行过程中，就是航向角会出现较大的变化，轻则飞斜线，重则出现诸如航向角大幅修正导致的失控炸机。

因此，如何获取较为精准的磁力计校准数据，以减小航向角的初值误差是本领域技术人员亟待解决的技术问题。

技术实现要素：

本发明提供一种磁力计校准数据采集方法、装置以及飞行器，旨在获取较为精准的磁力计校准数据。

为实现上述目的，本发明提供一种磁力计校准数据采集方法，应用于飞行器，所述飞行器设置有磁力计，所述方法包括：

获取所述飞行器的姿态参数，其中，所述姿态参数用于表征所述飞行器的机身的当前姿态；

根据所述姿态参数判断所述机身的当前姿态是否为预设姿态；

若所述机身的当前姿态为所述预设姿态，则根据采样指令和所述飞行器的加速度控制所述磁力计进行数据采集以获取多组磁力数据，其中，所述采样指令为与所述飞行器通信连接的终端设备发送的以使所述磁力计进行数据采集的指令；

计算获取的所述磁力数据的组数是否超过预设的组数阈值；

若获取的所述磁力数据的组数超过所述组数阈值，则输出所述多组磁力数据。

优选地，所述姿态参数包括翻滚角，所述预设姿态为所述机身与地面平行，则，所述根据所述姿态参数判断所述机身的当前姿态是否为预设姿态，包括：

判断所述翻滚角的角度值是否处于预设的第一角度值区间；

若所述翻滚角的角度值处于所述第一角度值区间，则判断所述机身与地面平行。

优选地，所述姿态参数包括俯仰角，所述预设姿态为所述机身与地面平行，则，所述根据所述姿态参数判断所述机身的当前姿态是否为预设姿态，包括：

判断所述俯仰角的角度值是否处于预设的第二角度值区间；

若所述俯仰角的角度值处于所述第二角度值区间，则判断所述机身与地面平行。

优选地，所述姿态参数包括俯仰角，所述预设姿态为所述机身与地面垂直，则，所述根据所述姿态参数判断所述机身的当前姿态是否为预设姿态，包括：

判断所述俯仰角的角度值是否处于预设的第三角度值区间；

若所述俯仰角的角度值处于所述第三角度值区间，则判断所述机身与地面垂直。

优选地，所述飞行器设置有加速度计，所述姿态参数包括所述加速度计的z轴输出参数，所述预设姿态为所述机身与地面垂直，则，所述根据所述姿态参数判断所述机身的当前姿态是否为预设姿态，包括：

判断所述加速度计的z轴输出参数是否超过加速参数阈值；

若所述加速度计的z轴输出参数超过所述加速参数阈值，则计算所述加速度计的z轴输出参数的维持时间；

判断所述维持时间是否超过预设的时间阈值；

若所述维持时间超过所述时间阈值，则判断所述机身与地面垂直。

优选地，所述根据采样指令和所述飞行器的加速度控制所述磁力计进行数据采集以获取多组磁力数据，包括：

根据所述采样指令控制所述磁力计采集第一组磁力数据，并控制所述磁力计以所述加速度每变化一次预设变化量时进行下一次的磁力数据采样，以获取所述多组磁力数据。

本发明还提供一种磁力计校准数据采集装置，应用于飞行器，所述飞行器设置有磁力计，所述磁力计校准数据采集装置包括：

姿态获取模块，获取所述飞行器的姿态参数，其中，所述姿态参数用于表征所述飞行器的机身的当前姿态；

判断模块，用于根据所述姿态参数判断所述机身的当前姿态是否为预设姿态；

采集模块，用于若所述机身的当前姿态为所述预设姿态，则根据采样指令和所述飞行器的加速度控制所述磁力计进行数据采集以获取多组磁力数据，其中，所述采样指令为与所述飞行器通信连接的终端设备发送的以使所述磁力计进行数据采集的指令；

计数模块，用于计算获取的所述磁力数据的组数是否超过预设的组数阈值；

输出模块，用于若获取的所述磁力数据的组数超过所述组数阈值，则输出所述多组磁力数据。

优选地，所述飞行器设置有加速度计，所述姿态参数包括所述加速度计的z轴输出参数，所述预设姿态为所述机身与地面垂直，所述判断模块用于：

判断所述加速度计的z轴输出参数是否超过加速参数阈值；

若所述加速度计的z轴输出参数超过所述加速参数阈值，则计算所述加速度计的z轴输出参数的维持时间；

判断所述维持时间是否超过预设的时间阈值；

若所述维持时间超过所述时间阈值，则判断所述机身与地面垂直。

优选地，所述采集模块还用于：

根据所述采样指令控制所述磁力计采集第一组磁力数据，并控制所述磁力计以所述加速度每变化一次预设变化量时进行下一次的磁力数据采样，以获取所述多组磁力数据。

本发明还提供一种飞行器，所述飞行器包括机身，设置于所述机身的磁力计，与所述机身相连的机臂，设置于所述机臂的动力装置，所述飞行器还包括：

存储器以及处理器；

所述存储器用于存储计算机可执行的磁力计校准程序；

所述处理器用于调取存储在所述存储器中的可执行的磁力计校准程序，以执行前述的磁力计校准数据采集方法。

与现有设计相比，本发明提供的一种磁力计校准数据采集方法通过获取所述飞行器的姿态参数，其中，所述姿态参数用于表征所述飞行器的机身的当前姿态；根据所述姿态参数判断所述机身的当前姿态是否为预设姿态；若所述机身的当前姿态为所述预设姿态，则根据采样指令和所述飞行器的加速度控制所述磁力计进行数据采集以获取多组磁力数据，其中，所述采样指令为与所述飞行器通信连接的终端设备发送的以使所述磁力计进行数据采集的指令；计算获取的所述磁力数据的组数是否超过预设的组数阈值；若获取的所述磁力数据的组数超过所述组数阈值，则输出所述多组磁力数据。

也即，通过获取飞行器的姿态参数，根据状态参数判断飞行器是否符合磁力参数采样条件，若飞行器符合采样条件时，则根据采样指令和飞行器的加速度控制所述磁力计进行数据采集以获取多组磁力数据，从而确保磁力计可以较为有序采集多组磁力数据，当所获取的磁力数据数量达到预设值时，输出该多组磁力数据，从而可以用获取的多组磁力数据作为磁力计的采样数据初值对磁力计进行校准，以提高磁力计校准结果准确性，从而减小甚至避免由于磁力计校准结果不准确导致的航向角误差。

附图说明

图1为本发明提供的飞行器与终端设备通信连接的场景示意图；

图2为本发明提供的磁力计校准数据采集方法的步骤流程图；

图3a为飞行器的机身姿态角的结构示意图；

图3b为飞行器机体坐标系z轴和惯性坐标系z轴之间的位置坐标关系示意图；

图4为本发明提供的飞行器进行磁力计校准的运动轨迹图示意图；

图5为本发明提供的一种磁力计校准数据采集装置的框图结构示意图；

图6为本发明提供的一种飞行器的框图结构示意图。

具体实施方式

为了使本发明的目的、技术方案及优点更加清楚明白，如下结合附图及实施例，对本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅用以解释本发明，并不用于限定本发明。

本发明的说明书和权利要求书及上述附图中的术语“第一”、“第二”、“第三”、“第四”等(如果存在)是用于区别类似的对象，而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换，以便这里描述的实施例能够以除了在这里图示或描述的内容以外的顺序实施。此外，术语“包括”和“具有”以及他们的任何变形，意图在于覆盖不排他的包含，示例性地，包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元，而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。

需要说明的是，在本发明中涉及“第一”、“第二”等的描述仅用于描述目的，而不能理解为指示或暗示其相对重要性或者隐含指明所指示的技术特征的数量。由此，限定有“第一”、“第二”的特征可以明示或者隐含地包括至少一个该特征。另外，各个实施例之间的技术方案可以相互结合，但是必须是以本领域普通技术人员能够实现为基础，当技术方案的结合出现相互矛盾或无法实现时应当认为这种技术方案的结合不存在，也不在本发明要求的保护范围之内。

本发明提供了一种磁力计校准数据采集方法、装置以及飞行器，所述方法通过获取所述飞行器的姿态参数，其中，所述姿态参数用于表征所述飞行器的机身的当前姿态；根据所述姿态参数判断所述机身的当前姿态是否为预设姿态；若所述机身的当前姿态为所述预设姿态，则根据采样指令和所述飞行器的加速度控制所述磁力计进行数据采集以获取多组磁力数据，其中，所述采样指令为与所述飞行器通信连接的终端设备发送的以使所述磁力计进行数据采集的指令；计算获取的所述磁力数据的组数是否超过预设的组数阈值；若获取的所述磁力数据的组数超过所述组数阈值，则输出所述多组磁力数据。

也即，通过获取飞行器的姿态参数，根据状态参数判断飞行器是否符合磁力参数采样条件，若飞行器符合采样条件时，则根据采样指令和飞行器的加速度控制所述磁力计进行数据采集以获取多组磁力数据，从而确保磁力计可以较为有序采集多组磁力数据，当所获取的磁力数据数量达到预设值时，输出该多组磁力数据，从而可以用获取的多组磁力数据作为磁力计的采样数据初值对磁力计进行校准，以提高磁力计校准结果准确性，从而减小甚至避免由于磁力计校准结果不准确导致的航向角误差。

请参阅图1，本发明提供一种飞行器10，该飞行器10包括机身101、与机身101相连的机臂102、设于机臂102的动力装置103、设于机身101的控制系统(图未示)。动力装置103用于提供飞行器10飞行的推力、升力等，控制系统是飞行器10的中枢神经，可以包括多个功能性单元，例如飞控系统、路径规划系统以及其他具有特定功能的系统。其中，跟踪系统用于获得待跟踪目标的位置、跟踪距离，即飞行器10距待跟踪目标的距离。飞控系统包括各类传感器，例如陀螺仪、加速计、磁力计等，飞控系统用于控制飞行器10的飞行姿态等。路径规划系统用于基于跟踪目标的位置对飞行器10的飞行路径进行规划，并指示飞控系统控制飞行器10的飞行姿态以使飞行器10按指定路径飞行。

在飞行器10的一些应用场景中，飞行器10与终端设备20通信连接，用户可以通过操控终端设备20向飞行器10发送控制指令。

其中，终端设备20例如智能手机、平板电脑、电脑、遥控器等。用户可以通过任何合适类型的一种或者多种用户交互设备与终端设备20交互，这些用户交互设备可以是鼠标、按键、触摸屏等。飞行器10和终端设备20之间，可以通过分别设置在各自内部的无线通信模块，例如信号接收器、信号发送器等建立通信连接，上传或者下发数据/指令。

请参阅图2，本发明提供一种磁力计校准数据采集方法，该方法应用于飞行器10，该方法包括：

步骤s101：获取所述飞行器的姿态参数，其中，所述姿态参数用于表征所述飞行器的机身的当前姿态。

飞行器10在进行磁力计校准前，需要确保飞行器10的姿态符合预设姿态，以便于传感器组件中的磁力计的校准，通过设置于飞行器10内传感器组件获取飞行器10的姿态参数，该姿态参数用于表征飞行器10的机身101的当前姿态，飞行器10的飞控系统可以根据所获取的姿态参数判定该飞行器10的姿态是否为预设姿态。

步骤s102：根据所述姿态参数判断所述机身的当前姿态是否为预设姿态，若所述机身的当前姿态为所述预设姿态，则执行步骤s103，若所述机身的当前姿态为非所述预设姿态，则返回执行步骤s101。

在部分实施例中，所述姿态参数包括翻滚角，所述预设姿态为所述机身与地面平行，则，所述根据所述姿态参数判断所述机身的当前姿态是否为预设姿态，包括：

判断所述翻滚角的角度值是否处于预设的第一角度值区间；

若所述翻滚角的角度值处于所述第一角度值区间，则判断所述机身与地面平行。

示例性地，预设飞行器10的翻滚角α在第一角度值区间时，该飞行器10的机体101与地面平行，其中，该第一角度值区间可以[0-10°]、[0-20°]或[0-30°]。

飞行器10通过内置的传感器获取相关参数，并经过解算获取翻滚角α，若翻滚角α在[0-10°]、[0-20°]或[0-30°]任一区间，则表明飞行器10的机体101与地面平行，如图3a所示，翻滚角α即为飞行器10沿着x轴翻滚的角度。

在部分实施例中，所述姿态参数包括俯仰角，所述预设姿态为所述机身与地面平行，则，所述根据所述姿态参数判断所述机身的当前姿态是否为预设姿态，包括：

判断所述俯仰角的角度值是否处于预设的第二角度值区间；

若所述俯仰角的角度值处于所述第二角度值区间，则判断所述机身与地面平行。

示例性地，预设飞行器10的俯仰角β在第二角度值区间时，该飞行器10的机体101与地面平行，其中，该第二角度值区间可以是[0-10°]、[0-20°]或[0-30°]。

飞行器10通过内置的传感器获取相关参数，并经过解算获取俯仰角β，若俯仰角β在[0-10°]、[0-20°]或[0-30°]任一区间，则表明飞行器10的机体101与地面平行，如图3a所示，俯仰角β即为飞行器10沿着y轴旋转时倾仰的角度。

在部分实施例中，所述姿态参数包括俯仰角，所述预设姿态为所述机身与地面垂直，则，所述根据所述姿态参数判断所述机身的当前姿态是否为预设姿态，包括：

判断所述俯仰角的角度值是否处于预设的第三角度值区间；

若所述俯仰角的角度值处于所述第三角度值区间，则判断所述机身与地面垂直。

示例性地，预设飞行器10的俯仰角β在第三角度值区间时，该飞行器10的机体101与地面平行，其中，该第三角度值区间可以是[70-80°]或[70-90°]。

飞行器10通过内置的传感器获取相关参数，并经过解算获取俯仰角β，若俯仰角β在[70-80°]或[70-90°]任一区间，则表明飞行器10的机体101与地面平行，如图3a所示，俯仰角β即为飞行器10沿着y轴旋转时倾仰的角度。

在部分实施例中，所述飞行器设置有加速度计，所述姿态参数包括所述加速度计的z轴输出参数，所述预设姿态为所述机身与地面垂直，则，所述根据所述姿态参数判断所述机身的当前姿态是否为预设姿态，包括：

判断所述加速度计的z轴输出参数是否超过加速参数阈值；

若所述加速度计的z轴输出参数超过所述加速参数阈值，则计算所述加速度计的z轴输出参数的维持时间；

判断所述维持时间是否超过预设的时间阈值；

若所述维持时间超过所述时间阈值，则判断所述机身与地面垂直。

示例性地，飞行器10有机体坐标系，当飞行器10的机体与地面垂直时飞行器10的机体坐标系的z轴与惯性坐标系的z轴呈夹角θ，且θ＝90°。因此，飞行器10的机身101的姿态可以从飞行器10的机体坐标系的z轴与惯性坐标系的z轴呈夹角θ改变分析得出。其中，飞行器10的机体坐标系的z轴与惯性坐标系的z轴呈夹角θ改变又可以从传感器组件中的加速度计z轴输出参数,也即加速度计的z轴读数。

以预设姿态为机身101与地面垂直为例进行说明。

如图3b所示，zb为机体系的z轴，zo为惯性系的z轴，zb和zo之间呈夹角θ，zo在zb上的投影为oa，cosθ＝|oa|/|zo|，其中|zo|对应重力加速度g时，|oa|即为飞行器10在机体系的z轴上的加速度az。

即，飞行器10飞行时，重力加速度g与加速度计的z轴方向的加速度az满足：cosθ＝az/g，也即θ＝arccosaz/g，其中，加速度az可以从加速度计读取，也即夹角θ或加速度az可以作为加速参数反馈出飞行器10的机身101与地面垂直。

通常飞行器10的机体101无法与地面完全垂直，也即夹角θ通常无法达到90°。当夹角θ超过夹角预设值时，即可认为该飞行器10与地面垂直，其中，夹角预设值为70°-90°，即θ大于70°可认为该飞行器10与地面垂直，即飞行器10的机身101姿态为预设姿态，也即,z轴输出参数az小于加速度阈值g*cos70°时，飞行器10的机身101姿态为预设姿态，重力加速度g根据飞行器10进行校准时所在地的纬度进行设置。

如，广州g＝9.788m/s²,武汉g＝9.794m/s²,东京g＝9.798m/s²,纽约g＝9.803m/s²,莫斯科g＝9.816m/s²。

当z轴输出参数az小于加速度阈值g*cos70°时，计算所述加速度计的z轴输出参数的维持时间t，避免因外界干扰因素影响加速度计z轴度数。若为维持时间t超过预设的时间阈值t时，判断机身101与地面垂直，该时间阈值t可以根据需要设置为1s-5s。

在部分实施例中，重力加速度g取值还可以是在9.7-10m/s²之间。

步骤s103：根据采样指令和所述飞行器的加速度控制所述磁力计进行数据采集以获取多组磁力数据，其中，所述采样指令为与所述飞行器通信连接的终端设备发送的以使所述磁力计进行数据采集的指令。

在部分实施例中，所述根据采样指令和所述飞行器的加速度控制所述磁力计进行数据采集以获取多组磁力数据，包括：

根据所述采样指令控制所述磁力计采集第一组磁力数据，并控制所述磁力计以所述加速度每变化一次预设变化量时进行下一次的磁力数据采样，以获取所述多组磁力数据。

本实施例中以加速度为加速度计输出的在z轴方向上的加速度az为例进行说明。

示例性地，飞行器10的机身101的姿态符合磁力数据采样要求时，用户通过终端设备20向飞行器10发送采样指令，飞行器10接收该采样指令，并控制磁力计进行磁力数据采样，获取第一组磁力数据和采集该第一组磁力数据时的z轴方向上的加速度az。并实时监控并获取加速度计输出的在z轴方向上的加速度az的大小，并控制磁力计以所述加速度az每变化一次预设变化量时进行一次数据采样，以获取多组磁力数据。其中该预设变化量可以根据需要进行调整，如，若预设变化量为g*cos0.7°时，az每变化g*cos0.7°时磁力计进行一次数据采样，即，重力加速度g与加速度计的z轴方向的加速度az满足：cosθ＝az/g，也即θ＝arccosaz/g＝0.7°磁力计进行一次数据采样。

如图4所示，飞行器10在外力作用下沿着轨迹a进行“8”字磁力校准。即通过外力使飞行器10的进行划“8”字的方式控制磁力计进行数据采集，以均匀获取地磁数据，从而使得地磁校准结果较为精准。

步骤s104：计算获取的所述磁力数据的组数是否超过预设的组数阈值，若获取的所述磁力数据的组数超过所述组数阈值，则执行步骤s105，若获取的所述磁力数据的组数未超过所述组数阈值，则执行步骤s103。

步骤s105：输出所述多组磁力数据。

示例性地，设置磁力数据采样的组数阈值为200组，当磁力计获取的磁力数据组数达到200组时，停止磁力数据采样，并输出该200组磁力数据，请参阅图5，本发明还提供一种磁力计校准数据采集装置20，该磁力计校准数据采集装置20应用于飞行器10，该飞行器10设置有磁力计，该磁力计校准数据采集装置20包括：

姿态获取模块201，获取所述飞行器的姿态参数，其中，所述姿态参数用于表征所述飞行器的机身的当前姿态；

判断模块202，用于根据所述姿态参数判断所述机身的当前姿态是否为预设姿态；

采集模块203，用于若所述机身的当前姿态为所述预设姿态，则根据采样指令和所述飞行器的加速度控制所述磁力计进行数据采集以获取多组磁力数据，其中，所述采样指令为与所述飞行器通信连接的终端设备发送的以使所述磁力计进行数据采集的指令；

计数模块204，用于计算获取的所述磁力数据的组数是否超过预设的组数阈值；

输出模块205，用于若获取的所述磁力数据的组数超过所述组数阈值，则输出所述多组磁力数据。

在部分实施例中，所述姿态参数包括翻滚角，所述预设姿态为所述机身与地面平行，判断模块202还用于：

判断所述翻滚角的角度值是否处于预设的第一角度值区间；

若所述翻滚角的角度值处于所述第一角度值区间，则判断所述机身与地面平行。

在部分实施例中，所述姿态参数包括俯仰角，所述预设姿态为所述机身与地面平行，判断模块202还用于：

判断所述俯仰角的角度值是否处于预设的第二角度值区间；

若所述俯仰角的角度值处于所述第二角度值区间，则判断所述机身与地面平行。

在部分实施例中，所述姿态参数包括俯仰角，所述预设姿态为所述机身与地面垂直，判断模块202还用于：

判断所述俯仰角的角度值是否处于预设的第三角度值区间；

若所述俯仰角的角度值处于所述第三角度值区间，则判断所述机身与地面垂直。

在部分实施例中，所述飞行器设置有加速度计，所述姿态参数包括所述加速度计的z轴输出参数，所述预设姿态为所述机身与地面垂直，判断模块202还用于：

判断所述加速度计的z轴输出参数是否超过加速参数阈值；

若所述加速度计的z轴输出参数超过所述加速参数阈值，则计算所述加速度计的z轴输出参数的维持时间；

判断所述维持时间是否超过预设的时间阈值；

若所述维持时间超过所述时间阈值，则判断所述机身与地面垂直。

在部分实施例中，采集模块203还用于：

根据所述采样指令控制所述磁力计采集第一组磁力数据，并控制所述磁力计以所述加速度每变化一次预设变化量时进行下一次的磁力数据采样，以获取所述多组磁力数据。

在部分实施例中，该飞行器10还包括存储器104、处理器105和总线106，动力装置103以及存储器104通过总线106与处理器105电连接。

其中，存储器104至少包括一种类型的可读存储介质，所述可读存储介质包括闪存、硬盘、多媒体卡、卡型存储器(示例性地，sd或dx存储器等)、磁性存储器、磁盘、光盘等。存储器104在一些实施例中可以是飞行器10的内部存储单元，示例性地该飞行器10的硬盘。存储器104在另一些实施例中也可以是飞行器10的外部存储设备，示例性地飞行器10上配备的插接式硬盘，智能存储卡(smartmediacard,smc)，安全数字(securedigital,sd)卡，闪存卡(flashcard)等。存储器104不仅可以用于存储安装于飞行器10的应用软件及各类数据，示例性地计算机可读程序的代码等，如磁力计校准程序，也即存储器104可以作为存储介质。

处理器105在一些实施例中可以是中央处理器(centralprocessingunit,cpu)、控制器、微控制器、微处理器或其他数据处理芯片，处理器105可调用存储器104中存储的程序代码或处理数据，实现前述的磁力计校准数据采集方法。

以上仅为本发明的优选实施例，并非因此限制本发明的保护范围，凡是利用本发明说明书及附图内容所作的等效结构或等效流程变换，或直接或间接运用在其他相关的技术领域，均同理包括在本发明的保护范围内。