CN104457747B - 一种矿用陀螺姿态测量仪 - Google Patents
一种矿用陀螺姿态测量仪 Download PDFInfo
- Publication number
- CN104457747B CN104457747B CN201410766919.1A CN201410766919A CN104457747B CN 104457747 B CN104457747 B CN 104457747B CN 201410766919 A CN201410766919 A CN 201410766919A CN 104457747 B CN104457747 B CN 104457747B
- Authority
- CN
- China
- Prior art keywords
- handset
- control chip
- main frame
- measuring
- inclination angle
- 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
Links
- 238000005065 mining Methods 0.000 title claims abstract description 15
- 238000005259 measurement Methods 0.000 claims description 24
- 238000006243 chemical reaction Methods 0.000 claims description 6
- 239000012528 membrane Substances 0.000 claims description 6
- 230000003993 interaction Effects 0.000 claims description 3
- 238000005553 drilling Methods 0.000 abstract description 27
- 230000005291 magnetic effect Effects 0.000 abstract description 5
- 239000003245 coal Substances 0.000 abstract description 3
- 238000000034 method Methods 0.000 description 8
- 239000011159 matrix material Substances 0.000 description 6
- 230000008569 process Effects 0.000 description 5
- 230000000694 effects Effects 0.000 description 4
- 230000001186 cumulative effect Effects 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 238000000205 computational method Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 230000003068 static effect Effects 0.000 description 2
- 230000008901 benefit Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 239000003302 ferromagnetic material Substances 0.000 description 1
- 238000007429 general method Methods 0.000 description 1
- 238000000691 measurement method Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
- 230000007306 turnover Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C1/00—Measuring angles
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C9/00—Measuring inclination, e.g. by clinometers, by levels
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Gyroscopes (AREA)
- Excavating Of Shafts Or Tunnels (AREA)
Abstract
本发明公开了一种矿用陀螺姿态测量仪,包括主机和子机,主机和子机配合使用,用来测量矿用钻探设备的姿态角,包括方位角、前后倾角和左右倾角。主机的功能是寻北,主要包括长方体外壳、动调陀螺仪,三轴加速度计、控制芯片、显控装置及电源部分,用以测量地球自转角速度分量,从而测量出主机基准与正北的夹角;子机主要包括长方体外壳、微机械陀螺仪、三轴加速度计、控制芯片、显控装置及电源部分,用以测量其自身基准相对于主机基准的方位角旋转变化量、前后倾角及左右倾角。主机和子机两者配合使用即可测量矿用钻探设备的三个姿态角。本发明专利无需GPS信号,且不受磁场干扰,适合于煤矿井下钻探设备姿态角的测量。
Description
技术领域
本发明涉及矿用钻探设备姿态测量技术领域,特别涉及一种矿用陀螺姿态侧量仪。
背景技术
煤矿钻探设备在钻进或探测的过程中,需要调节好其姿态角(方位角及双向倾角),以满足钻探工艺要求,因而需要一种设备对其姿态角进行准确测量;由于矿井下无GPS信号,目前一般用的方法是用磁罗盘测量及以巷道中线为基准的测量方法,由于钻探设备一般由铁磁材料制造,其对地磁场方向有干扰,为磁罗盘测量法带来较大的测量误差(有时超过10°);而通过巷道中线为基准来测量时,由于寻找中线的方法目前多是用人工扯线来实现,再通过量角器来量钻探设备与中线夹角,扯线及量夹角时人为因素引入的误差较大,且两过程的误差是累积误差,因而最终方位角的测量误差较大,特别是巷道有倾角或者巷道弯曲时。由上知,在姿态测量过程中,方位角的精确测量是难点。
发明内容
有鉴于此,本发明的目的是提供一种矿用陀螺姿态测量仪,用于测量钻探设备的姿态角,由主机和子机两部分组成,通过陀螺原理进行方位角测量,精确度高,且所述姿态测量仪为矿用本安便携式仪器,易于携带,测量时劳动强度低。
本发明的目的是通过以下技术方案来实现的,一种矿用陀螺姿态测量仪,包括用于寻北的主机和用于测量姿态角的子机,所述主机为子机提供方位基准;所述主机包括用于测量地球自转角速度的敏感轴分量的动调陀螺仪、用于测出主机前后倾角和左右倾角的第一三轴加速度计、第一控制芯片、用于实现人机交互的第一显示屏和第一电源模块;所述动调陀螺仪和第一三轴加速度计分别与第一控制芯片连接,所述第一显示屏与第一控制芯片连接,所述第一电源模块经DC/DC变换后给用电单元供电。
进一步,所述子机包括用于测量方位角旋转角速度的微机械陀螺仪、用于测量子机前后倾角和左右倾角的第二三轴加速度计、第二控制芯片、第二显示屏、第二电源模块和薄膜键盘及按钮,所述微机陀螺仪和第二三轴加速度计分别与第二控制芯片连接,所述第二显示屏与第二控制芯片连接,所述薄膜键盘及按钮与第二控制芯片连接,所述第二电源模块经DC/DC变换后给用电单元供电。
进一步,所述主机还包括第一长方形外壳,所述动调陀螺仪、第一三轴加速度计、第一控制芯片和第一电源模块设置于第一长方形外壳内。
进一步,所述子机还包括第二长方形外壳,所述微机械陀螺仪、第二三轴加速度计、第二控制芯片和第二电源模块设置于第二长方形包壳内。
进一步,所述主机表面设置向上的凸出部,所述凸出部具有第一基准面;所述子机的边缘设置在向下延伸的凸沿,所述凸沿具有第二基准面,在子机放在主机上使用时,所述第一基准面与第二基准面紧密贴合。
本发明的有益效果:
本发明可直接测量钻探设备的方位角及倾角,所用陀螺均不受磁场干扰,且无需GPS信号,适用于煤矿井下环境,在测量方位角时每次测量前对子机进行方位角初始化,可有效的消除微机械陀螺的累积误差,提高了测量精度,该设备为本安便携式仪器,工人劳动强度低。本发明为矿用钻探设备姿态测量提供了简单实用的设备及测量方法,提高了钻探准确度及效率,从而提高了煤矿安全系数。
附图说明
为了使本发明的目的、技术方案和有益效果更加清楚,本发明提供如下附图进行说明:
图1姿态仪的原理框图,其中a为主机电器原理示意图,b为子机电器原理示意图;
图2为姿态仪结构示意图,子机放在主机上,基准重合;其中a为正视图,b为俯视图;
图3为子机结构示意图,a为正视图,b为侧视图;
图4为主机结构示意图,a为正视图,b为侧剖视图。
具体实施方式
下面将结合附图,对本发明的优选实施例进行详细的描述。
图1姿态仪的原理框图,其中a为主机电器原理示意图,b为子机电器原理示意图;图2为姿态仪结构示意图,子机放在主机上,基准重合;其中a为正视图,b为俯视图;图3为子机结构示意图,a为正视图,b为侧视图;图4为主机结构示意图,a为正视图,b为侧剖视图。
一种矿用陀螺姿态测量仪,包括主机1和子机2,两者配合使用,用来测量钻探设备机构的方位角及倾角。
如图1所示,所述主机包括第一长方形外壳、动调陀螺仪、第一三轴加速度计、第一控制芯片、第一显示屏6和第一电源模块;所述动调陀螺仪、第一三轴加速度计、第一控制芯片和第一电源模块设置于第一长方形外壳内。所述动调陀螺仪和第一三轴加速度计分别与第一控制芯片连接,所述第一显示屏与第一控制芯片连接,所述第一电源模块经DC/DC变换后给用电单元供电;所述第一显示屏用于实现人机交互。
所述主机起寻北作用,子机提供方位基准;使用过程中一直保持静止(包括寻北的过程和配合子机测量的过程)。动调陀螺仪的转子高速自转,同时又随地球的自转进行旋转,从而产生陀螺效应,利用该效应来测量地球自转角速度的敏感轴分量,再通过反正切函数来求主机外壳基准与正北的夹角,从而完成寻北;在寻北过程中,当主机有一定的倾角时,第一三轴加速度计可以测出前后倾角和左右倾角,在计算主机与真北夹角时,将所测的两倾角考虑到算法里即可;为了保证寻北的精度,寻北时主机尽量保持水平,且不在高纬度地区(如南北极圈内)。
主机外壳基准与正北的夹角ψ0的计算方法为:
式(1)中,ωY为地球角速度在敏感轴Y轴上的分量,ωX为地球角速度在敏感轴X轴上的分量,θ为前后倾角,γ为左右倾角,ωe为地球自转角速度,为纬度。
所述子机包括第二长方形外壳、微机械陀螺仪、第二三轴加速度计、第二控制芯片、第二显示屏3、第二电源模块和薄膜键盘及按钮,所述微机械陀螺仪、第二三轴加速度计、第二控制芯片和第二电源模块设置于第二长方形包壳内。所述微机陀螺仪和第二三轴加速度计分别与第二控制芯片连接,所述第二显示屏与第二控制芯片连接,所述薄膜键盘及按钮与第二控制芯片连接,所述第二电源模块经DC/DC变换后给用电源单元供电。
所述子机用于测量钻探设备的姿态角,倾角通过第二三轴加速度计直接测量,在测量方位角时,子机先放在主机基准上,通过初始化而得到方位角测量基准,从主机上拿到钻探设备上的方位角旋转变化量通过微机械陀螺来测量,方位角基准与方位角旋转变化量求和即为所测量方位角值。
所述主机表面设置向上的凸出部(即前述的主机基准),所述凸出部具有第一基准面5;所述子机的边缘设置在向下延伸的凸沿,所述凸沿具有第二基准面4,在子机放在主机上使用时,所述第一基准面与第二基准面紧密贴合。
所述第二三轴加速度计可以方便测量子机的倾角,包括前后倾角和左右倾角。
所述微机械陀螺仪可方便测出方位角旋转角速度,再用四元数姿态矩阵即可求得方位角旋转变化量,此方位角变化量加上主机提供的方位角基准即可得到子机基准的方位角,从而可进行整个钻探设备机构的方位角测量。
在每次方位角测量前都要对子机初始化以得到方位角基准,从而消除微机械陀螺累积误差;当子机有倾角时(即微机械陀螺仪有倾角时),在计算方位角旋转角度时,将倾角考虑进去即可。
方位角变化量的计算方法为:
由参考坐标系R至子机固联坐标系b旋转过程中的转换矩阵为将子机的转动等效为绕瞬轴u(单位向量)转过θ角一次完成,将该点在参考坐标系R中的向量rR和在子机坐标系中的向量rb看作零标量的四元数,则rR和rb间的变换关系可采用四元数乘法表示:
该式为坐标变换的四元数乘表示法,其中Q为R系至b系的旋转四元数。
上式矩阵中右下角的3×3方块即为所以(2)式可写成:
即:
式(3)为坐标变换的矩阵表示法,则坐标变换阵就是姿态矩阵,由姿态矩阵可计算出微机械陀螺所测的方位角变化量Δψ。
此方位角变化量与主机提供的方位角基准求和即可得到子机的方位角,即方位角ψ=ψ0+Δψ。
在测量钻探设备姿态时,先测量方位角,方位角满足要求后再测量倾角;测量过程为:先将主机水平静止放置在需要测量的钻探设备旁,进行寻北;寻北完成后,主机显示屏显示出主机基准与真北夹角;对子机输入主机的寻北方位角,再将子机基准与主机基准重合,按下子机初始化按钮;然后将子机拿到钻探设备上去测量,在此过程中,子机方位角不断变化,即由主机基准的方位角变化到钻探设备基准的方位角,该变化量由微机械陀螺计算出,子机初始化时基准方位角与自身所测方位角变化量求和即可得钻探设备的方位角,若方位角有偏差,先将子机从钻探设备上拿下来放在主机基准上,再调节钻探设备方位角,然后子机按下初始化按钮,通过主机方位基准(该基准不变)对子机方位角再次进行初始化,再拿到钻探设备上去测量;照此步骤进行下去,直到钻探设备调到所需的方位角(在允许误差范围内),即完成方位角测量与调节,然后再调节钻探设备倾角,调倾角时,直接将子机放在钻探设备上,边调节边观察即可,无需要反复放在主机基准上进行初始化。
最后说明的是,以上实施例仅用以说明本发明的技术方案而非限制,尽管参照较佳实施例对本发明进行了详细说明,本领域的普通技术人员应当理解,可以对本发明的技术方案进行修改或者等同替换,而不脱离本发明技术方案的宗旨和范围,其均应涵盖在本发明的权利要求范围当中。
Claims (5)
1.一种矿用陀螺姿态测量仪,其特征在于:包括用于寻北的主机和用于测量姿态角的子机,所述主机为子机提供方位基准;
所述主机包括用于测量地球自转角速度的敏感轴分量的动调陀螺仪、用于测出主机前后倾角和左右倾角的第一三轴加速度计、第一控制芯片、用于实现人机交互的第一显示屏和第一电源模块;所述动调陀螺仪和第一三轴加速度计分别与第一控制芯片连接,所述第一显示屏与第一控制芯片连接,所述第一电源模块经DC/DC变换后给用电单元供电。
2.根据权利要求1所述的陀螺姿态测量仪,其特征在于:所述子机包括用于测量方位角旋转角速度的微机械陀螺仪、用于测量子机前后倾角和左右倾角的第二三轴加速度计、第二控制芯片、第二显示屏、第二电源模块和薄膜键盘及按钮,所述微机陀螺仪和第二三轴加速度计分别与第二控制芯片连接,所述第二显示屏与第二控制芯片连接,所述薄膜键盘及按钮与第二控制芯片连接,所述第二电源模块经DC/DC变换后给用电单元供电。
3.根据权利要求1所述的矿用陀螺姿态测量仪,其特征在于:所述主机还包括第一长方形外壳,所述动调陀螺仪、第一三轴加速度计、第一控制芯片和第一电源模块设置于第一长方形外壳内。
4.根据权利要求2所述的矿用陀螺姿态测量仪,其特征在于:所述子机还包括第二长方形外壳,所述微机械陀螺仪、第二三轴加速度计、第二控制芯片和第二电源模块设置于第二长方形包壳内。
5.根据权利要求1所述的矿用陀螺姿态测量仪,其特征在于:所述主机表面设置向上的凸出部,所述凸出部具有第一基准面;所述子机的边缘设置在向下延伸的凸沿,所述凸沿具有第二基准面,在子机放在主机上使用时,所述第一基准面与第二基准面紧密贴合。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410766919.1A CN104457747B (zh) | 2014-12-12 | 2014-12-12 | 一种矿用陀螺姿态测量仪 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410766919.1A CN104457747B (zh) | 2014-12-12 | 2014-12-12 | 一种矿用陀螺姿态测量仪 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104457747A CN104457747A (zh) | 2015-03-25 |
CN104457747B true CN104457747B (zh) | 2017-04-19 |
Family
ID=52904183
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410766919.1A Active CN104457747B (zh) | 2014-12-12 | 2014-12-12 | 一种矿用陀螺姿态测量仪 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104457747B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108444472A (zh) * | 2018-03-07 | 2018-08-24 | 中煤科工集团西安研究院有限公司 | 一种煤矿井下手持式陀螺罗盘及其测量方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1052371A (zh) * | 1990-05-23 | 1991-06-19 | 航空航天部第一设计研究院十五所 | 陀螺寻北仪 |
CN201865663U (zh) * | 2010-06-03 | 2011-06-15 | 西安思坦仪器股份有限公司 | 一种惯性测量单元以及动力调谐陀螺连续测斜系统 |
CN201934095U (zh) * | 2011-02-16 | 2011-08-17 | 重庆天箭电子有限公司 | 陀螺测斜式井中三分量仪 |
CN103743413A (zh) * | 2013-12-27 | 2014-04-23 | 哈尔滨工程大学 | 倾斜状态下调制寻北仪安装误差在线估计与寻北误差补偿方法 |
CN204255373U (zh) * | 2014-12-12 | 2015-04-08 | 中煤科工集团重庆研究院有限公司 | 一种矿用陀螺姿态测量仪 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7093370B2 (en) * | 2002-08-01 | 2006-08-22 | The Charles Stark Draper Laboratory, Inc. | Multi-gimbaled borehole navigation system |
-
2014
- 2014-12-12 CN CN201410766919.1A patent/CN104457747B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1052371A (zh) * | 1990-05-23 | 1991-06-19 | 航空航天部第一设计研究院十五所 | 陀螺寻北仪 |
CN201865663U (zh) * | 2010-06-03 | 2011-06-15 | 西安思坦仪器股份有限公司 | 一种惯性测量单元以及动力调谐陀螺连续测斜系统 |
CN201934095U (zh) * | 2011-02-16 | 2011-08-17 | 重庆天箭电子有限公司 | 陀螺测斜式井中三分量仪 |
CN103743413A (zh) * | 2013-12-27 | 2014-04-23 | 哈尔滨工程大学 | 倾斜状态下调制寻北仪安装误差在线估计与寻北误差补偿方法 |
CN204255373U (zh) * | 2014-12-12 | 2015-04-08 | 中煤科工集团重庆研究院有限公司 | 一种矿用陀螺姿态测量仪 |
Also Published As
Publication number | Publication date |
---|---|
CN104457747A (zh) | 2015-03-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102536196B (zh) | 基于激光测距和加速度测量的井下姿态测量系统及方法 | |
CN202926316U (zh) | 一种方位角与倾角测量仪 | |
CN108458714B (zh) | 一种姿态检测系统中不含重力加速度的欧拉角求解方法 | |
CN102134989B (zh) | 利用陀螺测斜仪点测井眼的方法 | |
CN106595567A (zh) | 地质结构面产状测量方法 | |
CN102564461A (zh) | 一种基于双轴转台的光学捷联惯导系统的标定方法 | |
CN105066949B (zh) | 巷道空间形变测量装置及基于该装置的测量方法 | |
US10310132B2 (en) | Absolute vector gravimeter and methods of measuring an absolute gravity vector | |
CN103389808B (zh) | 一种空间鼠标及获取空间鼠标位移的方法 | |
CN104266648A (zh) | Android平台MARG传感器的室内定位系统 | |
CN108444472A (zh) | 一种煤矿井下手持式陀螺罗盘及其测量方法 | |
CN103697893B (zh) | 利用大气偏振光的三维定姿方法 | |
CN104653173A (zh) | 一种钻机姿态测量仪及钻孔方位调节方法 | |
CN104216405B (zh) | 田间机器人的导航方法及设备 | |
CN102809367A (zh) | 一种基于双轴倾角传感器的空间旋转角度测量方法 | |
CN106842080A (zh) | 一种磁场测量装置姿态摆动干扰去除方法 | |
CN104406566B (zh) | 一种矿井智能综合地质测量仪及其测量方法 | |
CN106703787B (zh) | 一种径向水平井的井眼轨迹参数计算方法及装置 | |
CN105134171B (zh) | 一种两轴光纤陀螺连续测斜系统的实现方法 | |
CN104457747B (zh) | 一种矿用陀螺姿态测量仪 | |
CN106092098A (zh) | 一种基于陀螺和倾角仪的载体航姿测量方法 | |
CN204255373U (zh) | 一种矿用陀螺姿态测量仪 | |
CN104034333B (zh) | 测井探管三维实时姿态检测系统的检测方法 | |
CN205317213U (zh) | 一种面向房地一体的不动产单元实地调查测量装置 | |
CN104612605A (zh) | 一种煤矿用陀螺仪式钻杆定位方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |