[go: up one dir, main page]

CN111504288B - 一种寻北装置 - Google Patents

一种寻北装置 Download PDF

Info

Publication number
CN111504288B
CN111504288B CN202010320338.0A CN202010320338A CN111504288B CN 111504288 B CN111504288 B CN 111504288B CN 202010320338 A CN202010320338 A CN 202010320338A CN 111504288 B CN111504288 B CN 111504288B
Authority
CN
China
Prior art keywords
optical fiber
fiber gyroscope
north
inclination angle
seeking
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202010320338.0A
Other languages
English (en)
Other versions
CN111504288A (zh
Inventor
赵子豪
杨晨光
邢成
薛兵
侯泽
庄灿涛
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Gangzhen Science And Technology Co ltd
Original Assignee
Beijing Gangzhen Science And Technology Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beijing Gangzhen Science And Technology Co ltd filed Critical Beijing Gangzhen Science And Technology Co ltd
Priority to CN202010320338.0A priority Critical patent/CN111504288B/zh
Publication of CN111504288A publication Critical patent/CN111504288A/zh
Application granted granted Critical
Publication of CN111504288B publication Critical patent/CN111504288B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C17/00Compasses; Devices for ascertaining true or magnetic north for navigation or surveying purposes
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C19/00Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
    • G01C19/58Turn-sensitive devices without moving masses
    • G01C19/64Gyrometers using the Sagnac effect, i.e. rotation-induced shifts between counter-rotating electromagnetic beams
    • G01C19/72Gyrometers using the Sagnac effect, i.e. rotation-induced shifts between counter-rotating electromagnetic beams with counter-rotating light beams in a passive ring, e.g. fibre laser gyrometers

Landscapes

  • Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • General Physics & Mathematics (AREA)
  • Optics & Photonics (AREA)
  • Electromagnetism (AREA)
  • Power Engineering (AREA)
  • Gyroscopes (AREA)

Abstract

本说明书一个或多个实施例提供一种寻北装置,包括:粗寻北单元、光纤陀螺仪、转台机构、驱动单元及数据处理单元:数据处理单元包括:判断模块,用于根据获取的所述粗寻北单元的方位输出信号,判断所述光纤陀螺仪是否位于非误差角度位置;控制模块,用于当判断所述光纤陀螺仪位于非误差角度位置时,控制所述驱动单元动作,以使所述转台机构带动所述光纤陀螺仪转动至预定位置;倾角计算模块,用于根据获取的所述光纤陀螺仪位于预定位置时的输出信号,计算得到第一倾角结果。本实施例的寻北装置能够实现高精度寻北。

Description

一种寻北装置
技术领域
本说明书一个或多个实施例涉及观测仪器技术领域,尤其涉及一种寻北装置。
背景技术
寻北装置是一种能够自动指示方位的高精度惯性仪器,已经广泛应用于矿山、铁路、航天、军事等工程测量领域。基于光纤陀螺仪实现的寻北装置,受陀螺仪设计工艺的影响,当光纤陀螺仪相对于正北方向的倾角在误差角度位置范围内时会产生零点误差,影响寻北装置的测量精度。
发明内容
有鉴于此,本说明书一个或多个实施例的目的在于提出一种寻北装置,能够提高寻北装置的测量精度。
基于上述目的,本说明书一个或多个实施例提供了一种寻北装置,包括:粗寻北单元、光纤陀螺仪、转台机构、驱动单元及数据处理单元:所述数据处理单元包括:
判断模块,用于根据获取的所述粗寻北单元的方位输出信号,判断所述光纤陀螺仪是否位于非误差角度位置;
控制模块,用于当判断所述光纤陀螺仪位于非误差角度位置时,控制所述驱动单元动作,以使所述转台机构带动所述光纤陀螺仪转动至预定位置;
倾角计算模块,用于根据获取的所述光纤陀螺仪位于预定位置时的输出信号,计算得到第一倾角结果。
可选的,所述数据处理单元还包括:
所述判断模块,用于根据获取的所述粗寻北单元的方位输出信号,判断所述光纤陀螺仪是否位于误差角度位置范围;
所述控制模块,用于当判断所述光纤陀螺仪位于误差角度位置范围时,控制所述驱动单元动作,以使所述转台机构带动所述光纤陀螺仪转动预定角度而达到非误差角度位置;以及所述光纤陀螺仪位于非误差角度位置后,控制所述驱动单元动作,以使所述转台机构带动所述光纤陀螺仪转动至预定位置;
倾角计算模块,用于根据获取的所述光纤陀螺仪位于预定位置时的输出信号,计算得到倾角结果,根据所述倾角结果和所述预定角度,确定第二倾角结果。
可选的,所述倾角计算模块计算所述第一倾角结果的方法为:
Figure BDA0002461146770000021
其中,S为第一倾角结果,P1i为所述光纤陀螺仪转动至第一预定位置时,第i次获取的所述光纤陀螺仪的输出信号,P2i为所述光纤陀螺仪转动至第二预定位置时,第i次获取的所述光纤陀螺仪的输出信号,P3i为所述光纤陀螺仪转动至第三预定位置时,第i次获取的所述光纤陀螺仪的输出信号,P4i为所述光纤陀螺仪转动至第四预定位置时,第i次获取的所述光纤陀螺仪的输出信号,m为所述光纤陀螺仪转动至预定位置时,获取的所述光纤陀螺仪的输出信号的总次数。
可选的,装置还包括光电编码器,所述数据处理单元还包括:
位置判断模块,用于根据获取的所述光电编码器的输出信号,判断所述光纤陀螺仪是否达到所述预定位置。
可选的,所述位置判断模块,用于根据获取的所述光电编码器的转动参数,确定所述驱动单元的第一转动角度,根据所述驱动单元的驱动参数以及控制所述驱动单元动作以使所述光纤陀螺仪达到所述预定位置所对应的控制参数,确定所述驱动单元的第二转动角度,判断所述第一转动角度和所述第二转动角度是否相等,若是,所述光纤陀螺仪达到所述预定位置。
可选的,装置还包括MEMS倾角传感器,所述数据处理单元还包括:
倾斜角计算模块,用于根据获取的所述光纤陀螺仪位于预定位置时,所述MEMS倾角传感器的输出信号,计算得到倾斜角结果。
可选的,所述倾斜角计算模块计算倾斜角结果的方法是:
Figure BDA0002461146770000031
Figure BDA0002461146770000032
Figure BDA0002461146770000033
其中,β为MEMS倾角传感器相对于水平方向的倾斜角,L为光纤陀螺仪位于预定位置时,获取的MEMS倾角传感器的输出信号的总数,Yj为所述光纤陀螺仪位于第j预定位置时,MEMS倾角传感器的Y轴方向的输出信号,Xj为所述光纤陀螺仪位于第j预定位置时,MEMS倾角传感器的X轴方向的输出信号。
可选的,装置包括底板、第一支撑板、转台、第二支撑板、光电编码器、滑环、上盖,所述底板与所述第一支撑板通过支柱相连接,所述驱动单元的输出轴与减速机的输入端相连接,所述减速机固定于所述第一支撑板的一侧,所述光电编码器固定于所述第一支撑板的另一侧,所述光电编码器的光栅盘与所述减速机的输出轴同轴连接,所述转台的一侧与所述减速机的输出轴端面相连接,所述转台的另一侧与所述第二支撑板的一侧通过固定架相连接,所述光纤陀螺仪固定于所述固定架上;所述滑环的一端与所述第二支撑板的另一侧相连接,所述光纤陀螺仪、光电编码器的信号输出端通过所述滑环与数据处理单元的数据输入端相连接,所述数据处理单元的控制信号端通过所述滑环与所述驱动单元的控制端相连接,所述数据处理单元基于电路板实现,所述电路板与所述上盖固定连接。
可选的,所述寻北装置还包括外筒体,所述外筒体与所述底板、上盖密封固定连接。
可选的,所述数据处理单元还包括:
授时模块,用于提供授时时间;
存储模块,用于按照所述授时时间的时间格式存储所述第一倾角结果或第二倾角结果。
从上面所述可以看出,本说明书一个或多个实施例提供的寻北装置,包括粗寻北单元、光纤陀螺仪、转台机构、驱动单元及数据处理单元,数据处理单元包括判断模块,用于根据获取的粗寻北单元的方位输出信号,判断光纤陀螺仪是否位于非误差角度位置;控制模块,用于当判断光纤陀螺仪位于非误差角度位置时,控制驱动单元动作,以使转台机构带动光纤陀螺仪转动至预定位置;倾角计算模块,用于根据获取的光纤陀螺仪位于预定位置时的输出信号,计算得到第一倾角结果。本实施例的寻北装置能够实现高精度寻北。
附图说明
为了更清楚地说明本说明书一个或多个实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本说明书一个或多个实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本说明书一个或多个实施例的装置的立体结构示意图;
图2A、2B、2C为图1所示装置的不同角度的平面结构示意图;
图3为本说明书一个或多个实施例的装置的外形示意图;
图4为本说明书一个或多个实施例的数据处理单元的结构示意图;
图5为本说明书另一个实施例的数据处理单元的结构框图。
具体实施方式
为使本公开的目的、技术方案和优点更加清楚明白,以下结合具体实施例,并参照附图,对本公开进一步详细说明。
需要说明的是,除非另外定义,本说明书一个或多个实施例使用的技术术语或者科学术语应当为本公开所属领域内具有一般技能的人士所理解的通常意义。本说明书一个或多个实施例中使用的“第一”、“第二”以及类似的词语并不表示任何顺序、数量或者重要性,而只是用来区分不同的组成部分。“包括”或者“包含”等类似的词语意指出现该词前面的元件或者物件涵盖出现在该词后面列举的元件或者物件及其等同,而不排除其他元件或者物件。“连接”或者“相连”等类似的词语并非限定于物理的或者机械的连接,而是可以包括电性的连接,不管是直接的还是间接的。“上”、“下”、“左”、“右”等仅用于表示相对位置关系,当被描述对象的绝对位置改变后,则该相对位置关系也可能相应地改变。
如图1-4所示,本说明书一个或多个实施例提供一种寻北装置,包括粗寻北单元、光纤陀螺仪8、转台机构、驱动单元3及数据处理单元,所述数据处理单元包括:
判断模块,用于根据获取的粗寻北单元的方位输出信号,判断光纤陀螺仪8是否位于非误差角度位置;
控制模块,用于当判断光纤陀螺仪8位于非误差角度位置时,控制驱动单元3动作,以使转台机构带动光纤陀螺仪8转动至预定位置;
倾角计算模块,用于根据获取的光纤陀螺仪8位于预定位置时的输出信号,计算得到第一倾角结果。
本实施例中,数据处理单元获取粗寻北单元的方位输出信号,判断模块根据方位输出信号判断光纤陀螺仪8是否位于非误差角度位置,若是,确定光纤陀螺仪8于此位置不会产生零点误差,控制模块控制驱动单元3动作,驱动单元3驱动转台机构转动,带动光纤陀螺仪8转动至预定位置,当光纤陀螺仪8转动至预定位置时,倾角计算模块根据光纤陀螺仪8的输出信号,计算第一倾角结果,计算结果不存在零点误差,能够实现高精度寻北。
一些实施例中,光纤陀螺仪相对于正北方向的倾角在345°~360°以及0°~15°的范围内时会产生零点误差,因此,将光纤陀螺仪相对于正北方向的倾角在345°~360°以及0°~15°的范围作为误差角度位置范围,先利用粗寻北单元采集光纤陀螺仪8的方位输出信号,若根据粗寻北单元的方位输出信号,判断光纤陀螺仪8不在误差角度位置范围之内,则光纤陀螺仪8位于非误差角度位置,于非误差角度位置,不会产生零点误差,可基于当前位置计算确定寻北结果。可选的,粗寻北单元可使用电子罗盘14等可检测方位的仪器。
本实施例中,倾角计算模块根据获取的光纤陀螺仪位于预定位置时的输出信号,计算得到第一倾角结果的计算方法为:
Figure BDA0002461146770000051
其中,S为第一倾角结果,即光纤陀螺仪8相对于正北方向的倾角(也可以是寻北装置与地理北极之间的夹角),P1i为光纤陀螺仪8转动至第一预定位置时,第i次获取的光纤陀螺仪8的输出信号,P2i为光纤陀螺仪8转动至第二预定位置时,第i次获取的光纤陀螺仪8的输出信号,P3i为光纤陀螺仪8转动至第三预定位置时,第i次获取的光纤陀螺仪8的输出信号,P4i为光纤陀螺仪8转动至第四预定位置时,第i次获取的光纤陀螺仪8的输出信号,m为光纤陀螺仪8转动至预定位置时,获取的光纤陀螺仪8的输出信号的总次数。
一些实施例中,基于光纤陀螺仪的四位置寻北算法计算第一倾角结果,其中,光纤陀螺仪位于第一预定位置、第二预定位置、第三预定位置、第四预定位置为间隔90度的四个位置,即分别为对应于Φ,Φ+90°,Φ+180°,Φ+270°的位置。
一些实施例中,数据处理单元还包括:
判断模块,用于根据获取的粗寻北单元的方位输出信号,判断光纤陀螺仪8是否位于误差角度位置范围;
控制模块,用于当判断光纤陀螺仪8位于误差角度位置范围时,控制驱动单元3动作,以使转台机构带动光纤陀螺仪8转动预定角度而达到非误差角度位置;以及当光纤陀螺仪8位于非误差角度位置后,控制驱动单元3动作,以使转台机构带动光纤陀螺仪8转动至预定位置;
倾角计算模块,用于根据获取的光纤陀螺仪8位于预定位置时的输出信号,计算得到倾角结果,根据倾角结果和预定角度,确定第二倾角结果。
本实施例中,数据处理单元获取粗寻北单元的方位输出信号,判断模块根据方位输出信号判断光纤陀螺仪8是否位于误差角度位置范围,若是,为避免光纤陀螺仪8于此位置产生零点误差,控制模块控制驱动单元3动作,驱动单元3驱动转台机构转动,带动光纤陀螺仪8转动预定角度而达到非误差角度位置;之后,控制驱动单元3动作,以使转台机构带动光纤陀螺仪8转动至预定位置,当光纤陀螺仪8转动至预定位置时,倾角计算模块根据光纤陀螺仪8的输出信号,计算得到倾角结果,再根据倾角结果和预定角度,计算得到第二倾角结果,由于倾角结果不包含零点误差,因而,第二倾角结果不存在零点误差,能够实现高精度寻北。
一些方式中,当判断光纤陀螺仪8位于误差角度位置范围内时,通过控制驱动单元3动作,控制光纤陀螺仪8顺时针转动45度以达到非误差角度位置,然后,在光纤陀螺仪8位于非误差角度位置的条件下,控制光纤陀螺仪8转动至预定位置,根据光纤陀螺仪8于预定位置采集的输出信号,利用公式(1)计算倾角结果,之后,将得到的倾角结果减去45度,得到第二倾角结果,作为寻北结果,能够消除零点误差,提高寻北测量精度。
如图所示,本实施例中,寻北装置还包括光电编码器6,数据处理单元还包括:
位置判断模块,用于根据获取的光电编码器6的输出信号,判断光纤陀螺仪8是否达到预定位置。
一些实施例中,位置判断模块,用于根据获取的光电编码器6的转动参数,确定驱动单元3的第一转动角度,根据驱动单元3的驱动参数以及控制驱动单元3动作以使光纤陀螺仪8达到预定位置所对应的控制参数,确定驱动单元3的第二转动角度,判断第一转动角度和第二转动角度是否相等,若是,确定光纤陀螺仪8达到预定位置。
一些实施例中,驱动单元3为步进电机,步进电机的输出轴转动,通过转台机构带动光电编码器6、光纤陀螺仪8随之转动,控制模块根据光电编码器6的转动参数,确定驱动单元3的第一转动角度,计算方法是:
Figure BDA0002461146770000071
其中,θt为步进电机在时间t内的转动角度,nt为光电编码器在时间t内转过的码盘数,N为光电编码器的码盘总数,可根据所选用的光电编码器所确定。可选的,所选取的光电编码器的码盘总数为2000。
一些实施例中,根据驱动单元3的驱动参数以及控制驱动单元3动作以使光纤陀螺仪8达到预定位置所对应的控制参数,确定驱动单元3的第二转动角度,计算方法是:
Figure BDA0002461146770000072
其中,θc为控制光纤陀螺仪8达到预定位置所对应的第c个预设的转动角度,uc为为达到第c个预设的转动角度,需要发送的脉冲个数,r为减速机的减速比,D为步进电机驱动的细分。可选的,所选取的减速机的减速比为50,步进电机驱动的细分为2000。
根据公式(2)计算得到第一转动角度θt,根据公式(3)计算得到第二转动角度θc,当θt=θc时,判断光纤陀螺仪8已达到预定位置。若θ1为光纤陀螺仪8达到第一预定位置所对应的第1个预设的转动角度,则当θ1=θt时,判断光纤陀螺仪8已达到第一预定位置;若θ2为光纤陀螺仪8达到第二预定位置所对应的第2个预设的转动角度,则当θ2=θt时,判断光纤陀螺仪8已达到第二预定位置;若θ3为光纤陀螺仪8达到第三预定位置所对应的第3个预设的转动角度,则当θ3=θt时,判断光纤陀螺仪8已达到第三预定位置;若θ4为光纤陀螺仪8达到第四预定位置所对应的第4个预设的转动角度,则当θ4=θt时,判断光纤陀螺仪8已达到第四预定位置,光纤陀螺仪8达到四个预定位置的时间t不同,光电编码器6在时间t内转过的码盘数不同。
如图2A及图5所示,本实施例中,寻北装置不仅能够测量倾角,实现精确寻北,而且,能够测量装置相对于水平方向的倾斜角。寻北装置还包括MEMS倾角传感器15,数据处理单元还包括:
倾斜角计算模块,用于根据获取的光纤陀螺仪8位于预定位置时,MEMS倾角传感器15的输出信号,计算得到倾斜角结果。
一些实施例中,倾斜角计算模块计算倾斜角结果的方法是:
Figure BDA0002461146770000081
Figure BDA0002461146770000082
Figure BDA0002461146770000083
其中,β为MEMS倾角传感器15相对于水平方向的倾斜角(也可以是寻北装置与水平方向之间的夹角),L为光纤陀螺仪8位于预定位置时,获取的MEMS倾角传感器15的输出信号的总数,Yj为光纤陀螺仪8位于第j预定位置时,MEMS倾角传感器的Y轴方向的输出信号,Xj为光纤陀螺仪8位于第j预定位置时,MEMS倾角传感器的X轴方向的输出信号。
可选的,基于前述的寻北装置的四位置寻北算法,j=1,2,3,4,L=4,即,在装置位于第一预定位置、第二预定位置、第三预定位置、第四预定位置时,计算装置的倾斜角结果。
本实施例中,当光纤陀螺仪8位于预定位置时,根据获取的MEMS倾角传感器15的输出信号,计算得到寻北装置相对于水平方向的倾斜角,不仅扩展了寻北装置的功能,而且测量的倾斜角精度较高。
一些方式中,MEMS倾角传感器15的X轴与光纤陀螺仪8的刻度线重合,光纤陀螺仪8的刻度线用于指示光纤陀螺仪8的敏感轴方向,根据公式(1)计算得到的第一倾角结果是刻度线与正北方向的夹角,也是步进电机的初始位置。可选的,MEMS倾角传感器15为具有X轴、Y轴输出的倾角传感器,例如,可选用型号为ADIS16209的MEMS倾角传感器。
如图1、2A、2B、2C所示,一些实施方式中,寻北装置包括底板1、第一支撑板5、转台7、第二支撑板9,底板1与第一支撑板5通过至少一根支柱2相连接,驱动单元3的输出轴与减速机4的输入端相连接,减速机4固定于第一支撑板5的一侧,光电编码器6固定于第一支撑板5的另一侧,光电编码器6的光栅盘与减速机4的输出轴同轴连接,转台7的一侧与减速机输出轴端面相连接,能够随减速机4转动而转动,转台7的另一侧与第二支撑板9的一侧通过固定架12相连接,光纤陀螺仪8固定于固定架12上,MEMS倾角传感器15固定于第二支撑板9的一侧,滑环13的一端与第二支撑板9的另一侧相连接,滑环13的信号端与数据处理单元的数据输入端相连接,光纤陀螺仪8、光电编码器6的信号输出端通过滑环13与数据处理单元的数据输入端相连接,数据处理单元的控制信号端通过滑环13与驱动电机3的控制端相连接,电子罗盘14的信号输出端通过数据线与数据处理单元的数据输入端相连接,数据处理单元基于电路板10实现,电路板10与上盖11通过连接件固定连接。
如图3所示,本实施例中,寻北装置还包括外筒体16,外筒体16与底板1、上盖11密封固定连接,可选的,装置的高为326毫米,上盖11直径为100毫米;整个寻北装置结构紧凑,布局合理,体积较小,尤其适用于井下使用,能够为安装于井下的各种观测仪器提供精确的测量倾角、倾斜角功能。
如图5所示,一些实施方式中,数据处理单元包括主控芯片,电子罗盘14、光纤陀螺仪8、光电编码器6的信号输出端分别与主控芯片的信号输入端相连接,主控芯片的控制信号输出端与驱动单元3的控制端相连接,驱动单元3的输出轴与减速机4的输入端相连接,减速机4的输出轴与光电编码器6相连接,减速机4的输出轴端面与转台7相连接,主控芯片控制驱动单元3的输出轴转动,经减速机4减速后,能够带动光电编码器6、转台7及转台7上的光纤陀螺仪8转动。
寻北装置的工作过程是,主控芯片根据获取的电子罗盘14采集的方位输出信号,快速判断出光纤陀螺仪8的当前位置是否在误差角度位置范围之内,若否,主控芯片控制驱动单元3动作,使得光纤陀螺仪8达到四个预定位置,根据光电编码器6的输出信号,判断光纤陀螺仪8达到四个预定位置时,根据获取的光纤陀螺仪8的输出信号,计算得到第一倾角结果,实现寻北;若判断光纤陀螺仪8的当前位置在误差角度位置范围之内,主控芯片控制驱动单元3动作,将光纤陀螺仪8顺时针旋转45度,以使光纤陀螺仪8位于非误差角度位置,然后,主控芯片控制驱动单元3动作,使得光纤陀螺仪8达到四个预定位置,根据光电编码器6的输出信号,判断光纤陀螺仪8达到四个预定位置时,根据获取的光纤陀螺仪8的输出信号,计算倾角结果,再将倾角结果减去45度,得到第二倾角结果,实现寻北。
同时,当光纤陀螺仪8达到四个预定位置时,主控芯片根据获取的MEMS倾角传感器15的输出信号,计算得到倾斜角结果。
如图5所示,数据处理单元还包括授时模块、数据传输接口、存储模块,授时模块用于为寻北装置提供精确的授时时间;存储模块用于存储第一倾角结果或第二倾角结果、倾斜角结果以及对应的时间,具体的,可根据授时时间,按照年月日时分秒的时间格式存储所测量的第一倾角结果或第二倾角结果、倾斜角结果;主控芯片计算得到的第一倾角结果或第二倾角结果、倾斜角结果以及对应的时间经数据传输接口传输给终端,特别是,当寻北装置应用于井下时,数据处理单元经数据传输接口、CAN总线与地面设备相连接,可将测量得到的第一倾角结果或第二倾角结果、倾斜角结果以及测量结果数据对应的时间传输至地面设备,由于井下观测周期长,可利用本实施例的寻北装置所测量的倾角结果和倾斜角结果,长期观测分析倾角和倾斜角是否有变化,以及具体的变化规律。
所属领域的普通技术人员应当理解:以上任何实施例的讨论仅为示例性的,并非旨在暗示本公开的范围(包括权利要求)被限于这些例子;在本公开的思路下,以上实施例或者不同实施例中的技术特征之间也可以进行组合,步骤可以以任意顺序实现,并存在如上所述的本说明书一个或多个实施例的不同方面的许多其它变化,为了简明它们没有在细节中提供。
另外,为简化说明和讨论,并且为了不会使本说明书一个或多个实施例难以理解,在所提供的附图中可以示出或可以不示出与集成电路(IC)芯片和其它部件的公知的电源/接地连接。此外,可以以框图的形式示出装置,以便避免使本说明书一个或多个实施例难以理解,并且这也考虑了以下事实,即关于这些框图装置的实施方式的细节是高度取决于将要实施本说明书一个或多个实施例的平台的(即,这些细节应当完全处于本领域技术人员的理解范围内)。在阐述了具体细节(例如,电路)以描述本公开的示例性实施例的情况下,对本领域技术人员来说显而易见的是,可以在没有这些具体细节的情况下或者这些具体细节有变化的情况下实施本说明书一个或多个实施例。因此,这些描述应被认为是说明性的而不是限制性的。
尽管已经结合了本公开的具体实施例对本公开进行了描述,但是根据前面的描述,这些实施例的很多替换、修改和变型对本领域普通技术人员来说将是显而易见的。例如,其它存储器架构(例如,动态RAM(DRAM))可以使用所讨论的实施例。
本说明书一个或多个实施例旨在涵盖落入所附权利要求的宽泛范围之内的所有这样的替换、修改和变型。因此,凡在本说明书一个或多个实施例的精神和原则之内,所做的任何省略、修改、等同替换、改进等,均应包含在本公开的保护范围之内。

Claims (9)

1.一种寻北装置,其特征在于,包括:粗寻北单元、光纤陀螺仪、转台机构、驱动单元及数据处理单元:所述数据处理单元包括:
判断模块,用于根据获取的所述粗寻北单元的方位输出信号,判断所述光纤陀螺仪是否位于非误差角度位置;
控制模块,用于当判断所述光纤陀螺仪位于非误差角度位置时,控制所述驱动单元动作,以使所述转台机构带动所述光纤陀螺仪转动至预定位置;
倾角计算模块,用于根据获取的所述光纤陀螺仪位于预定位置时的输出信号,计算得到第一倾角结果;
所述装置包括底板、第一支撑板、转台、第二支撑板、光电编码器、滑环、上盖,所述底板与所述第一支撑板通过支柱相连接,所述驱动单元的输出轴与减速机的输入端相连接,所述减速机固定于所述第一支撑板的一侧,所述光电编码器固定于所述第一支撑板的另一侧,所述光电编码器的光栅盘与所述减速机的输出轴同轴连接,所述转台的一侧与所述减速机的输出轴端面相连接,所述转台的另一侧与所述第二支撑板的一侧通过固定架相连接,所述光纤陀螺仪固定于所述固定架上;所述滑环的一端与所述第二支撑板的另一侧相连接,所述光纤陀螺仪、光电编码器的信号输出端通过所述滑环与数据处理单元的数据输入端相连接,所述数据处理单元的控制信号端通过所述滑环与所述驱动单元的控制端相连接,所述数据处理单元基于电路板实现,所述电路板与所述上盖固定连接。
2.根据权利要求1所述的寻北装置,其特征在于,所述数据处理单元还包括:
所述判断模块,用于根据获取的所述粗寻北单元的方位输出信号,判断所述光纤陀螺仪是否位于误差角度位置范围;
所述控制模块,用于当判断所述光纤陀螺仪位于误差角度位置范围时,控制所述驱动单元动作,以使所述转台机构带动所述光纤陀螺仪转动预定角度而达到非误差角度位置;以及所述光纤陀螺仪位于非误差角度位置后,控制所述驱动单元动作,以使所述转台机构带动所述光纤陀螺仪转动至预定位置;
倾角计算模块,用于根据获取的所述光纤陀螺仪位于预定位置时的输出信号,计算得到倾角结果,根据所述倾角结果和所述预定角度,确定第二倾角结果。
3.根据权利要求1所述的寻北装置,其特征在于,所述倾角计算模块计算所述第一倾角结果的方法为:
Figure FDA0003195997860000021
其中,S为第一倾角结果,P1i为所述光纤陀螺仪转动至第一预定位置时,第i次获取的所述光纤陀螺仪的输出信号,P2i为所述光纤陀螺仪转动至第二预定位置时,第i次获取的所述光纤陀螺仪的输出信号,P3i为所述光纤陀螺仪转动至第三预定位置时,第i次获取的所述光纤陀螺仪的输出信号,P4i为所述光纤陀螺仪转动至第四预定位置时,第i次获取的所述光纤陀螺仪的输出信号,m为所述光纤陀螺仪转动至预定位置时,获取的所述光纤陀螺仪的输出信号的总次数。
4.根据权利要求1所述的寻北装置,其特征在于,装置还包括光电编码器,所述数据处理单元还包括:
位置判断模块,用于根据获取的所述光电编码器的输出信号,判断所述光纤陀螺仪是否达到所述预定位置。
5.根据权利要求4所述的寻北装置,其特征在于,
所述位置判断模块,用于根据获取的所述光电编码器的转动参数,确定所述驱动单元的第一转动角度,根据所述驱动单元的驱动参数以及控制所述驱动单元动作以使所述光纤陀螺仪达到所述预定位置所对应的控制参数,确定所述驱动单元的第二转动角度,判断所述第一转动角度和所述第二转动角度是否相等,若是,所述光纤陀螺仪达到所述预定位置。
6.根据权利要求1所述的寻北装置,其特征在于,装置还包括MEMS倾角传感器,所述数据处理单元还包括:
倾斜角计算模块,用于根据获取的所述光纤陀螺仪位于预定位置时,所述MEMS倾角传感器的输出信号,计算得到倾斜角结果。
7.根据权利要求6所述的寻北装置,其特征在于,所述倾斜角计算模块计算倾斜角结果的方法是:
Figure FDA0003195997860000031
Figure FDA0003195997860000032
Figure FDA0003195997860000033
其中,β为MEMS倾角传感器相对于水平方向的倾斜角,L为光纤陀螺仪位于预定位置时,获取的MEMS倾角传感器的输出信号的总数,Yj为所述光纤陀螺仪位于第j预定位置时,MEMS倾角传感器的Y轴方向的输出信号,Xj为所述光纤陀螺仪位于第j预定位置时,MEMS倾角传感器的X轴方向的输出信号。
8.根据权利要求1所述的寻北装置,其特征在于,还包括外筒体,所述外筒体与所述底板、上盖密封固定连接。
9.根据权利要求2所述的寻北装置,其特征在于,所述数据处理单元还包括:
授时模块,用于提供授时时间;
存储模块,用于按照所述授时时间的时间格式存储所述第一倾角结果或第二倾角结果。
CN202010320338.0A 2020-04-22 2020-04-22 一种寻北装置 Active CN111504288B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010320338.0A CN111504288B (zh) 2020-04-22 2020-04-22 一种寻北装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010320338.0A CN111504288B (zh) 2020-04-22 2020-04-22 一种寻北装置

Publications (2)

Publication Number Publication Date
CN111504288A CN111504288A (zh) 2020-08-07
CN111504288B true CN111504288B (zh) 2021-10-08

Family

ID=71877787

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010320338.0A Active CN111504288B (zh) 2020-04-22 2020-04-22 一种寻北装置

Country Status (1)

Country Link
CN (1) CN111504288B (zh)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113432605B (zh) * 2021-06-30 2023-03-31 河北科技大学 基于光纤陀螺的寻北方法及系统
CN115014342A (zh) * 2022-06-22 2022-09-06 北京航宇测通电子科技有限公司 一种定位定向组合导航系统
CN115493588A (zh) * 2022-09-28 2022-12-20 深圳市天陆海导航设备技术有限责任公司 单轴光纤陀螺仪设置在y轴的组合导航定位系统
CN115683096A (zh) * 2022-10-25 2023-02-03 深圳市天陆海导航设备技术有限责任公司 单轴光纤陀螺仪设置在z轴的组合导航定位系统
CN117629174B (zh) * 2024-01-25 2024-04-05 深圳市瑞芬科技有限公司 一种基于感应地球自转原理的陀螺寻北装置

Family Cites Families (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE29602453U1 (de) * 1996-02-13 1996-04-11 Bodenseewerk Gerätetechnik GmbH, 88662 Überlingen Inertialsensor-Anordnung
US7002484B2 (en) * 2002-10-09 2006-02-21 Pathfinder Energy Services, Inc. Supplemental referencing techniques in borehole surveying
CN100533060C (zh) * 2006-07-11 2009-08-26 天津大学 用电子罗盘实现陀螺仪粗寻北装置
CN101109636B (zh) * 2007-08-08 2010-11-03 浙江大学 一种光纤陀螺寻北的数据处理方法
EP2578993B1 (de) * 2011-10-06 2014-01-15 Vectronix AG Goniometer mit grafischem Informationswiedergabemittel zur Bereitstellung von Information
CN103335643B (zh) * 2013-06-18 2016-02-24 湖北三江航天红峰控制有限公司 一种模块化光纤陀螺罗经
CN203561367U (zh) * 2013-11-27 2014-04-23 陕西航天长城测控有限公司 陀螺寻北仪
CN103743413B (zh) * 2013-12-27 2016-05-04 哈尔滨工程大学 倾斜状态下调制寻北仪安装误差在线估计与寻北误差补偿方法
CN103822624B (zh) * 2014-03-12 2017-02-08 西安北方捷瑞光电科技有限公司 一种单轴激光陀螺寻北仪及其寻北方法
CN103983259B (zh) * 2014-05-29 2016-07-13 中国人民解放军第二炮兵工程大学 基于摆式陀螺最大进动速度粗寻北原理的全方位寻北方法
CN104653963B (zh) * 2014-12-26 2017-01-18 北京兴华机械厂 一种双自由度具有惯性定向功能的跟踪云台
CN105136163B (zh) * 2015-07-31 2017-11-14 长安大学 一种基于双位置特征的磁悬浮陀螺寻北数据粗差剔除方法
CN106705997A (zh) * 2016-12-01 2017-05-24 浙江大学 一种光纤陀螺寻北启动误差抑制方法
CN109724581B (zh) * 2019-01-11 2022-07-19 西安超视距航空航天科技有限公司 基于自动经纬仪辅助旋转调制的捷联寻北方法

Also Published As

Publication number Publication date
CN111504288A (zh) 2020-08-07

Similar Documents

Publication Publication Date Title
CN111504288B (zh) 一种寻北装置
CN204831330U (zh) 一种三轴转台的姿态传感器测试系统
US7877887B2 (en) Method and system for heading indication with drift compensation
EP1836457B1 (en) Compensated measurement of angular displacement
CN101187568A (zh) 多位置捷联寻北系统方位效应的标定方法
CN114111753B (zh) 一种光纤陀螺寻北仪
CA2641684C (en) Angle measurement apparatus
CN202017484U (zh) 一种三轴无磁校验台
CN101082491A (zh) 一种摆式陀螺寻北仪测量方法
CN207528248U (zh) 一种星载二维指向机构测角精度检测装置
CN118857367B (zh) 一种绝对式编码器零位与水平面的标定方法
CN103162712B (zh) 圆光栅测角偏差处理及轴系歪斜补偿方法
US4696112A (en) Bore hole navigator
US20240418509A1 (en) Total station with compensation for misaligned optical aiming point
CN104655123B (zh) 一种利用光纤陀螺测定地球自转角速度的方法
CN103438903A (zh) 定向仪定向误差的校准方法
CN102322845B (zh) 测量方位角的装置及方法
CN107036627A (zh) 环形激光测角装置的地速投影分量误差自校准方法
CN216483089U (zh) 一种光纤陀螺寻北仪
CN107664510B (zh) 一种星载二维指向机构测角精度检测装置及实现方法
CN102648392A (zh) 通过转动惯性设备确定航向的方法
RU2544295C1 (ru) Гирокомпас
KR880000774A (ko) 스트랩다운 자이로스코프(Strap-down Gyroscope)를 사용하여 방위각을 빨리 측정하기 위한 방법과 장치
JPS61112914A (ja) 中でも測地学的器機のための角度測定装置
Kibrick et al. Evaluation of precision tilt sensors for measuring telescope position

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant