【技术实现步骤摘要】
一种基于MEMS陀螺寻北仪的二位置平滑精准寻北方法
[0001]本专利技术涉及陀螺寻北仪的寻北方法,特别是一种MEMS陀螺寻北仪的二位置平滑精准寻北方法。
技术介绍
[0002]定向技术有着广泛的应用领域,不仅在导弹、火箭和火炮的发射,飞机、坦克和舰船的航行都离不开方位基准,而且在地球物理探测、矿产资源开采、大地测量和隧道建设等民用领域也需要方位记住。定向技术的研究与产品开发,对国防现代化、国民经济发展具有重要意义。其中,矿产资源开采所用的随钻系统的钻井测斜仪就是定向技术的典型应用。由于陀螺仪应用于钻井测斜仪时,相对于磁通门方位传感器而言,不受磁场环境的影响,具备更高可靠性,是当前主要的井下测斜寻北仪。
[0003]目前基于MEMS陀螺仪的井下测斜寻北仪正逐步被国内外研究机构进行开发研究和应用。其相比于光纤陀螺和动力调谐陀螺而言,具备低成本、低功耗、小型化、高可靠以及抗冲击振动等优势,将成为未来随钻系统中的主流钻井测斜仪产品。虽然目前MEMS陀螺仪可通过阵列配置方式有效提升其测量精度,满足一定的寻北精度要求,但现有基 ...
【技术保护点】
【技术特征摘要】
1.一种基于MEMS陀螺寻北仪的二位置精准寻北方法,其特征在于,所述方法包括如下步骤:S1.将MEMS惯性传感器寻北仪在预设的初始零位静止设定采样时长,存储三轴MEMS陀螺的其中两轴数据和MEMS加速度计的其中两轴数据;利用自动旋转机构将MEMS陀螺寻北仪从初始零位旋转180度后到第二位置,继续静止采集预设时长的MEMS陀螺仪数据和MEMS加速度计数据,存储与预设零位相同的两轴数据;S2.利用所述初始零位和所述第二位置的一段时长的两轴MEMS陀螺仪数据和MEMS加速度计数据,求解一组航向角,即寻北结果,并进行存储;S3.继续所述步骤S1中初始零位静止的MEMS陀螺仪和MEMS加速度计预设固定采样时长的采集,并存储与所述步骤S1中陀螺仪和加速度计相同的两个轴的数据,然后继续旋转180度到第二位置后,采集预设时长的两轴陀螺仪数据和加速度计数据,再利用步骤S2求解另一组寻北结果;S4.重复所述步骤S3求解多组寻北结果,对多组结果直利用所述初始零位和所述第二位置的一段时长的两轴MEMS陀螺仪数据和MEMS加速度计数据,求解一组航向角,即寻北结果,并进行存储接做平滑处理,得到最终寻北结果。2.根据权利要求1所述的基于MEMS陀螺寻北仪的二位置精准寻北方法,所述步骤S1中,所述三轴MEMS陀螺和MEMS加速度计的其中两轴数据,其中选择的一个轴与寻北仪共轴,另一轴垂直于寻北仪轴向。所述的采集预设时长数据,该时长与MEMS陀螺仪采集频率相关。3.根据权利要求1所述的基于MEMS惯性传感器寻北仪的二位置精准寻北方法,其特征在于:所述步骤S2中第一组寻北结果记为在于:所述步骤S2中第一组寻北结果记为的计算方法,包括:S21.初始零位上MEMS陀螺仪存储的数据在载体坐标系中的投影为:其中ω
b
(1)为MEMS陀螺仪在初始零位输出,上标b表示载体坐标系,存储的其中...
【专利技术属性】
技术研发人员:杭义军,吕印新,贾文峰,
申请(专利权)人:原极上海科技有限公司,
类型:发明
国别省市:
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。