一种基于MEMS陀螺寻北仪的二位置平滑精准寻北方法

技术领域

本发明涉及陀螺寻北仪的寻北方法，特别是一种MEMS陀螺寻北仪的二位置平滑精准寻北方法。

背景技术

定向技术有着广泛的应用领域，不仅在导弹、火箭和火炮的发射，飞机、坦克和舰船的航行都离不开方位基准，而且在地球物理探测、矿产资源开采、大地测量和隧道建设等民用领域也需要方位记住。定向技术的研究与产品开发，对国防现代化、国民经济发展具有重要意义。其中，矿产资源开采所用的随钻系统的钻井测斜仪就是定向技术的典型应用。由于陀螺仪应用于钻井测斜仪时，相对于磁通门方位传感器而言，不受磁场环境的影响，具备更高可靠性，是当前主要的井下测斜寻北仪。

目前基于MEMS陀螺仪的井下测斜寻北仪正逐步被国内外研究机构进行开发研究和应用。其相比于光纤陀螺和动力调谐陀螺而言，具备低成本、低功耗、小型化、高可靠以及抗冲击振动等优势，将成为未来随钻系统中的主流钻井测斜仪产品。虽然目前MEMS陀螺仪可通过阵列配置方式有效提升其测量精度，满足一定的寻北精度要求，但现有基于MEMS陀螺仪的多位置寻北精度仍受到MEMS陀螺仪性能制约。在MEMS陀螺仪自身测量精度固定情况下，为了满足更高精度的随钻系统寻北精度需求，本发明提出一种基于MEMS陀螺寻北仪的二位置平滑精准寻北方法。

发明内容

本发明要解决的技术问题就在于：针对MEMS陀螺仪寻北精度与MEMS陀螺仪性能直接相关，在MEMS陀螺仪性能固定时，寻北精度无法有效提升的技术瓶颈问题。

为解决上述技术问题，本发明提出的技术方案为：一种基于MEMS陀螺寻北仪的二位置平滑精准寻北方法，包括如下步骤：

S1.将MEMS惯性传感器寻北仪在预设的初始零位静止设定的采样时长，存储三轴MEMS陀螺的其中两轴数据和MEMS加速度计的其中两轴数据；利用自动旋转机构将MEMS陀螺寻北仪从初始零位旋转180度后到第二位置，继续静止采集预设时长的MEMS陀螺仪数据和MEMS加速度计数据，存储与预设零位相同的两轴数据；

S2.利用所述初始零位和所述第二位置的一段时长的两轴MEMS陀螺仪数据和MEMS加速度计数据，求解一组航向角，即寻北结果，并进行存储；

S3.继续所述步骤S1中初始零位静止的MEMS陀螺仪和MEMS加速度计预设固定采样时长的采集，并存储与所述步骤S1中陀螺仪和加速度计相同的两个轴的数据，然后继续旋转180度到第二位置后，采集预设时长的两轴陀螺仪数据和加速度计数据。再利用步骤S2求解另一组寻北结果；

S4.重复所述步骤S3求解多组寻北结果，对多组结果直利用所述初始零位和所述第二位置的一段时长的两轴MEMS陀螺仪数据和MEMS加速度计数据，求解一组航向角，即寻北结果，并进行存储接做平滑处理，得到最终寻北结果。

进一步地，所述步骤S1中，所述三轴MEMS陀螺和MEMS加速度计的其中两轴数据，其中选择的一个轴与寻北仪共轴，另一轴垂直于寻北仪轴向。所述的采集预设时长数据，该时长与MEMS陀螺仪采集频率相关。

进一步地，所述步骤S2中第一组寻北结果记为

S21.初始零位上MEMS陀螺仪存储的数据在载体坐标系中的投影为：

其中ω

则存储的两轴陀螺仪数据

同理可得初始零位MEMS加速度计中存储的两轴数据，记为

其表达式为：

其中g为重力加速度数值，

S22.从初始零位旋转180度后到第二位置上，MEMS陀螺仪在载体坐标系中进行投影后存储的两轴陀螺仪数据

同理第二位置上MEMS加速度计中存储的两轴数据，记为

S23.利用式(4)和式(6)计算出两个位置处的横滚角γ和俯仰角θ；

S24.将式(3)与式(5)相减后可以得到下式：

利用式(7)可消除刻度系数因子K，并求解得到

进一步地，所述步骤S2中，利用所述初始零位和所述第二位置的一段时长的两轴MEMS陀螺仪数据，在空间中相当于采集了四个位置的角速率数据，能有效消除MEMS陀螺仪零偏、刻度因子误差对寻北结果的影响。

进一步地，所述步骤S2寻北结果的求解，与所述步骤S3旋转结构转动陀螺仪静置采集数据的过程时不间断连续执行。

进一步地，所述步骤S4中，多组寻北结果的误差呈白噪声形式，平滑处理为直接对多组结果进行求和平均，可得最终寻北结果

与现有技术相比，本发明的优点在于：

本发明在MEMS陀螺仪性能一定的情况下，可以通过本方法实现寻北精度的成倍提升，有效突破因MEMS陀螺仪性能而限制寻北精度的瓶颈问题，提升寻北仪对于复杂井下环境的适应性。

附图说明

参考所附附图，以更加充分的描述本发明的实施例。然而，所附附图仅用于说明和阐述，并不构成对本发明范围的限制。

图1为本发明的MEMS陀螺寻北仪的二位置平滑精准寻北方法流程图。

具体实施例

下面结合具体实施例对本发明进行详细说明。以下实施例将有助于本领域的技术人员进一步理解本发明，但不以任何形式限制本发明。应当指出的是，对本领域的普通技术人员来说，在不脱离本发明构思的前提下，还可以做出若干变形和改进。这些都属于本发明的保护范围。

一种基于MEMS陀螺寻北仪的二位置精准寻北方法，所述方法包括如下步骤：

S1.将MEMS惯性传感器寻北仪在预设的初始零位静止设定的采样时长，存储三轴MEMS陀螺的其中两轴数据和MEMS加速度计的其中两轴数据；利用自动旋转机构将MEMS陀螺寻北仪从初始零位旋转180度后到第二位置，继续静止采集预设时长的MEMS陀螺仪数据和MEMS加速度计数据，存储与预设零位相同的两轴数据；

S2.利用所述初始零位和所述第二位置的一段时长的两轴MEMS陀螺仪数据和MEMS加速度计数据，求解一组航向角，即寻北结果，并进行存储；

S3.继续所述步骤S1中初始零位静止的MEMS陀螺仪和MEMS加速度计预设固定采样时长的采集，并存储与所述步骤S1中陀螺仪和加速度计相同的两个轴的数据，然后继续旋转180度到第二位置后，采集预设时长的两轴陀螺仪数据和加速度计数据。再利用步骤S2求解另一组寻北结果；

S4.重复所述步骤S3求解多组寻北结果，对多组结果直利用所述初始零位和所述第二位置的一段时长的两轴MEMS陀螺仪数据和MEMS加速度计数据，求解一组航向角，即寻北结果，并进行存储接做平滑处理，得到最终寻北结果。

进一步地，所述步骤S1中，所述三轴MEMS陀螺和MEMS加速度计的其中两轴数据，其中选择的一个轴与寻北仪共轴，另一轴垂直于寻北仪轴向。所述的采集预设时长数据，该时长与MEMS陀螺仪采集频率相关。

进一步地，所述步骤S2中第一组寻北结果记为

S21.初始零位上MEMS陀螺仪存储的数据在载体坐标系中的投影为：

其中ω

则存储的两轴陀螺仪数据

同理可得初始零位MEMS加速度计中存储的两轴数据，记为

其表达式为：

其中g为重力加速度数值，

S22.从初始零位旋转180度后到第二位置上，MEMS陀螺仪在载体坐标系中进行投影后存储的两轴陀螺仪数据

同理第二位置上MEMS加速度计中存储的两轴数据，记为

S23.利用式(4)和式(6)计算出两个位置处的横滚角γ和俯仰角θ；

S24.将式(3)与式(5)相减后可以得到下式：

利用式(7)可消除刻度系数因子K，并求解得到

进一步地，所述步骤S2中，利用所述初始零位和所述第二位置的一段时长的两轴MEMS陀螺仪数据，在空间中相当于采集了四个位置的角速率数据，能有效消除MEMS陀螺仪零偏、刻度因子误差对寻北结果的影响。

进一步地，所述步骤S2寻北结果的求解，与所述步骤S3旋转结构转动陀螺仪静置采集数据的过程时不间断连续执行。

进一步地，所述步骤S4中，多组寻北结果的误差呈白噪声形式，平滑处理为直接对多组结果进行求和平均，可得最终寻北结果

综上所述，本发明在MEMS陀螺仪性能一定的情况下，可以通过本方法实现寻北精度的成倍提升，有效突破因MEMS陀螺仪性能而限制寻北精度的瓶颈问题，提升寻北仪对于复杂井下环境的适应性。

通过说明书和附图，本发明给出了具体实施方式的特定结构的典型实施例，基于本发明精神，还可作其他的转换。尽管上述发明提出了现有的较佳实施例，然而，这些内容并不作为局限。

对于本领域的技术人员而言，阅读上述说明后，各种变化和修正无疑将显而易见。因此，所附的权利要求书应看作是涵盖本发明的真实意图和范围的全部变化和修正。在权利要求书范围内任何和所有等价的范围与内容，都应认为仍属本发明的意图和范围内。