CN102536196B - 基于激光测距和加速度测量的井下姿态测量系统及方法 - Google Patents

基于激光测距和加速度测量的井下姿态测量系统及方法 Download PDF

Info

Publication number
CN102536196B
CN102536196B CN201110451812.4A CN201110451812A CN102536196B CN 102536196 B CN102536196 B CN 102536196B CN 201110451812 A CN201110451812 A CN 201110451812A CN 102536196 B CN102536196 B CN 102536196B
Authority
CN
China
Prior art keywords
reflectorized
plate
piece
laser range
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
Application number
CN201110451812.4A
Other languages
English (en)
Other versions
CN102536196A (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.)
Shenyang Institute of Automation of CAS
Original Assignee
Shenyang Institute of Automation of CAS
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 Shenyang Institute of Automation of CAS filed Critical Shenyang Institute of Automation of CAS
Priority to CN201110451812.4A priority Critical patent/CN102536196B/zh
Publication of CN102536196A publication Critical patent/CN102536196A/zh
Application granted granted Critical
Publication of CN102536196B publication Critical patent/CN102536196B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Abstract

本发明公开了一种基于激光测距和加速度测量的井下姿态测量系统及方法,该系统包括:基准参考板、反光材料块组、基准参考板支架、激光测距传感器组、加速度传感器单元和测量控制器;测量安装在待测物体上的激光测距传感器到安装在基准参考板上的反光材料块之间的距离,依据测量距离计算出待测物体相对于基准参考板的偏向角和俯仰角,利用安装在待测物体上的加速度传感器测得待测物体在欧氏空间三个轴向的加速度矢量,并计算出待测物体的滚转角,由此获得待测物体的方位姿态。本发明可以协助使用者在矿井等恶劣环境下快速地获取待测物体的姿态方位信息,为进一步的工程操作提供准确可靠的依据。本发明操作简单,安全可靠,成本低廉。

Description

基于激光测距和加速度测量的井下姿态测量系统及方法
技术领域
[0001] 本发明涉及测量技术领域,尤其涉及一种基于激光测距和加速度测量对井下姿态进行测量的系统及方法。
背景技术
[0002] 井下测量是矿井生产建设过程中的重要工作,它是矿山安全生产的眼睛,在整个矿业生产建设过程中,做好测量基础工作具有重要的意义,它是矿上安全建设的重要保证。因而发展先进的井下测量方法,开发实用有效的测量工具与系统对于国民经济建设具有重要的价值,同时也有利于社会稳定,促进和谐社会建设。
[0003] 姿态测量作为井下测量的一个重要环节,对于保证矿山安全生产的进行尤其具有重要意义,因为在开采掘进之前,必须利用钻机进行钻探操作,以便将瓦斯和水排出。而钻机的姿态方位和工作状态对于生产效率和安全监控具有直接的影响。对井下的钻探工具进行有效、方便的姿态方位测量系统已成为矿山生产企业的迫切需求。
[0004] 由于井下环境的特殊性,传统的姿态方位测量方法都存在一些问题。如电磁测量方法,由于井下地磁干扰极为突出,使得偏向角的测量几乎无法进行。基于信标的方法,则由于井下巷道的尺寸局限,使得信标的安装受到限制。基于惯性导航的测量方法,则同样受到成本和尺寸局限的约束。
[0005] 考虑到在地质勘探过程中,地质参考基准方向往往已预先给出,因而采用人工设定基准参考平面,将测量角度的问题转化为测量相对于基准参考平面上特殊点的距离问题,利用激光测距传感器结合加速度传感器实现对偏向角、俯仰角、滚装角的测量是一种简单可行的井下姿态姿态测量方法。
发明内容
[0006] 为了解决上述问题,协助使用者在矿井等恶劣环境下快速地获取待测物体的姿态方位信息,从而为进一步的工程操作提供准确可靠的依据,本发明提出一种基于激光测距和加速度测量的井下姿态测量系统及方法。
[0007] 本发明所述的一种基于激光测距和加速度测量的井下姿态测量系统及方法,实现在井下等恶劣环境下,对待测物体的偏向角、俯仰角和滚转角进行量测,其原理是通过布置基准参考板实现对地质基准参考面的人工确定,在基准参考板上布置三个反光材料块,三个反光材料块构成直角坐标系的坐标轴,通过测量安装在待测物体两端的激光测距传感器到反光材料块之间的距离,可以解算出待测物体相对于基准参考面坐标系的偏向角和俯仰角,同时由安装在待测物体上的加速度传感器可获取待测物体在欧氏空间三个轴向的加速度矢量,利用三个轴向的加速度矢量可计算出待测物体的滚转角。
[0008] 本发明所述的一种基于激光测距和加速度测量的井下姿态测量系统,其特征在于,该系统包括:基准参考板1、反光材料块组2、基准参考板支架3、激光测距传感器组4、加速度传感器单元5、测量控制器6,其中,[0009] 基准参考板I固定于基准参考板支架3上并与基准参考板支架3通过多轴方式连接,依据地质基准参考平面与测试环境平面的关系调整基准参考板支架3与基准参考板I之间的逆时针转角和后向仰角;
[0010] 基准参考板I上固定有两条相互垂直且带有刻度的滑动导轨;
[0011] 反光材料块组2由三个反光材料块组成,三个反光材料块按照几何垂直关系对齐安装在基准参考板I上的两条滑动导轨上,由滑动导轨上的刻度获得位于垂直点处的反光材料块分别与其他两个反光材料块之间的距离,作为初始参考距离输出给测量控制器6 ;
[0012] 激光测距传感器组4由两个激光测距传感器701和702组成,用于参照两个激光测距传感器之间的距离调节基准参考板I上的滑动导轨,使安装在基准参考板I上的反光材料块组2位于激光测距传感器组4的测量范围内,获取两个激光测距传感器到基准参考板I上三个反光材料块之间的六个测量距离,并将六个测量距离输出给测量控制器6 ;
[0013] 加速度传感器单元5安装在待测物体表面几何位置中心处,用于获取待测物体关于欧氏空间三个轴向的加速度矢量测量值;
[0014] 测量控制器6通过防爆电缆与激光测距传感器组4和加速度传感器单元5相连,用于根据初始参考距离、激光测距传感器组4的测量值计算待测物体的偏向角、俯仰角,根据加速度传感器单元5的测量值计算待测物体的滚转角,并显示待测物体的方位角度。
[0015] 另一方面,本发明还提出一种基于激光测距和加速度传感器的井下姿态测量方法,其特征在于,该方法包括以下步骤:
[0016] 步骤1:在待测物体上安装激光测距传感器组4和加速度传感器单元5,启动测量控制器6,其中,激光测距传感器组4由两个激光测距传感器701和702组成;
[0017] 步骤2:依据地质基准参考平面与测试环境平面的关系调整基准参考板支架3与基准参考板I之间的逆时针转角和后向仰角;
[0018] 步骤3:参照两个激光测距传感器之间的距离调节基准参考板I上的滑动导轨,使安装在基准参考板I上的反光材料块组2位于激光测距传感器组4的测量范围内,测量控制器6进入输入状态,其中,反光材料块组2由三个反光材料块组成;
[0019] 步骤4:由滑动导轨上的刻度获得位于垂直点处的反光材料块分别与其他两个反光材料块之间的距离Cl1和d2,作为初始参考距离;
[0020] 步骤5:在测量控制器6输入初始参考距离Cl1和d2,测量控制器6进入测量状态;
[0021] 步骤6:测量控制器6驱动激光测距传感器组4,获取两个激光测距传感器到三个反光材料块之间的六个距离;
[0022] 步骤7:测量控制器6由测量所得的距离和初始参考距离解算出待测物体相对于基准参考板I的偏向角和俯仰角,若可求解出角度,转向步骤8,若角度无法求解,则返回步骤3,重新调节基准参考板I上的滑动导轨;
[0023] 步骤8:测量控制器6驱动加速度传感器单元5,获取待测物体关于欧氏空间三个轴向的加速度矢量测量值;
[0024] 步骤9:测量控制器6由三轴加速度矢量测量值计算出待测物体的滚转角,将俯仰角、偏向角、滚转角的计算结果显示到LED屏上;
[0025] 步骤10:测量完毕,关闭所有设备。
[0026] 本发明的有益效果是:[0027] I)使用本发明所述的基于激光测距和加速度传感器的井下姿态测量方法,可以将井下巷道等恶劣环境下的姿态方位测量问题转化为测距和加速度测量问题,测量方法实用有效。
[0028] 2)本发明所使用基准参考板上部署三个具有几何垂直关系的反光材料块来模拟基准参考平面的特殊点,这种部署方式使得计算角度的过程无需采用迭代方法,不会带来累积误差,提高了计算精度和测量系统的适应性。
[0029] 3)本发明具有操作简单,安全可靠,成本低廉等特点。
附图说明
[0030] 图1是本发明提供的基于激光测距和加速度传感器的井下姿态测量系统示意图。
[0031] 图2为本发明提供的基于激光测距和加速度传感器的井下姿态测量系统中基准参考板正视图。
[0032] 图3为本发明提供的基于激光测距和加速度传感器的井下姿态测量系统中基准参考板支架转轴示意图。
[0033] 图4为本发明提供的基于激光测距和加速度传感器的井下姿态测量方法流程图。具体实施方式
[0034] 为使本发明的目的、技术方案和优点更加清楚明白,以下结合具体实施例,并参照附图,对本发明进一步详细说明。
[0035] 图1为本发明提供的基于激光测距和加速度传感器的井下姿态测量系统示意图,如图1所示,本发明提供的基于激光测距和加速度传感器的井下姿态测量系统包括:基准参考板1、反光材料块组2、基准参考板支架3、激光测距传感器组4、加速度传感器单元5、测量控制器6,其中:
[0036] 基准参考板I固定于基准参考板支架3上并与基准参考板支架3通过多轴方式连接,按照测量环境调整基准参考板I与基准参考板支架3之间的角度,具体地,依据地质基准参考平面与测试环境平面的关系调整基准参考板支架3与基准参考板I之间的逆时针转角和后向仰角;基准参考板I两侧边线中心开孔以便与基准参考板支架3固定;通过多轴方式连接是指,基准参考板支架3具有多条转轴与基准参考板I连接,以部署反光材料块的一侧作为基准参考板I的正面,基准参考板支架3通过转轴可将基准参考板I逆时针最大旋转90度,以基准参考板I向激光测距传感器方向为前向,基准参考板支架3通过转轴可将基准参考板I向后最大旋转90度;
[0037] 基准参考板I上固定有两条相互垂直且带有刻度的滑动导轨;
[0038] 反光材料块组2由三个同种材质、同样厚度、同样尺寸的反光材料块组成,三个反光材料块按照几何垂直关系安装在基准参考板I上的两条滑动导轨上,三个反光材料块对齐,如图2所示,三个反光材料块在基准参考板I上呈直角坐标系布置,三个反光材料块构成直角三角形,反光材料块201位于直角处,两条带有刻度的滑动导轨分别由反光材料块201位置处沿直角边布置,反光材料块202和反光材料块203分别安装在两条滑动导轨的滑块上;在实际测量中,由于待测物体的几何尺寸未知,为保证测量精度,需将三个反光材料块所构成的反光材料块组的几何位置部署于激光测距传感器组的测量覆盖范围内,采用滑动导轨调节非直角顶点处的反光材料块的位置,由滑动导轨上的刻度获得位于垂直点处的反光材料块分别与其他两个反光材料块之间的距离,即反光材料块201与203之间的距离Cl1,以及反光材料块201与202之间的距离d2,作为初始参考距离输出给测量控制器6 ;
[0039] 激光测距传感器组4由两个激光测距传感器组成,两个激光测距传感器分别安装在待测物体的两端,用于参照两个激光测距传感器之间的距离调节基准参考板I上的滑动导轨,使安装在基准参考板I上的反光材料块组2位于激光测距传感器组4的测量范围内,获取两个激光测距传感器到基准参考板I上三个反光材料块之间的六个测量距离,并将六个测量距离输出给测量控制器6,同时激光测距传感器激光发射方向朝向基准参考板I安装有反光材料块组2的一侧,为保证测量精度,两个激光测距传感器对齐,即两个激光测距传感器几何位置中心点所构成的直线与待测物体的边缘线平行;
[0040] 加速度传感器单元5安装在待测物体表面几何位置中心处,用于获取待测物体关于欧氏空间三个轴向的加速度矢量测量值;
[0041] 测量控制器6通过防爆电缆与激光测距传感器组4和加速度传感器单元5相连,用于根据初始参考距离、激光测距传感器组4的测量值计算待测物体的偏向角、俯仰角,根据加速度传感器单元5的测量值计算待测物体的滚转角,并显示待测物体的方位角度;所述测量控制器,是指具备控制和浮点运算能力的计算设备,且具有键盘可以输入初始参考距离,并具有LED显示屏输出待测物体的方位角度。
[0042] 方位测量时,首先按照测量环境调整基准参考板I与基准参考板支架3之间的角度,利用基准参考板I上的滑动导轨调整反光材料块之间的距离,获取初始参考距离,激光测距传感器组4获取两个激光测距传感器到基准参考板I上三个反光材料块之间的测量距离,测量控制器6利用上述初始参考距离和测量距离计算出待测物体相对于基准参考板I的偏向角和俯仰角,同时利用加速度传感器单元获取待测物体关于欧氏空间三个轴向的加速度矢量测量值,测量控制器6利用上述三轴加速度矢量测量值计算出待测物体的滚转角。
[0043] 在本发明的一个实施例中,基准参考板支架3选用可调整高度的合金材料的三脚架结构。基准参考板I采用聚氯乙烯塑料材质,基准参考板I的正视图如图2所示,其尺寸为60X60cm,两侧边线中心开孔以便与基准参考板支架3固定,基准参考板上部署有三个反光材料块,每个反光材料块的尺寸为2cmX2cm,实际材料为红色,图2中用黑色表示,其中反光材料块201的中心位于基准参考板左10cm,下IOcm处,由反光材料块201的中心处垂直向上布置有滑动导轨204,由反光材料块201的中心处垂直向右布置有滑动导轨205,反光材料块202安装在滑动导轨204的滑块上,反光材料块203安装在滑动导轨205的滑块上,反光材料块201的中心与反光材料块202的中心成垂直关系,反光材料块201的中心与反光材料块203的中心成水平关系,同时为保证反光材料块201、202、203的中心所构成的平面与基准参考板I平面平行,需在反光材料块与基准参考板I之间加入填充材料。
[0044] 基准参考板支架3的转轴结构如图3所示,通过连接部位的301轴轴向旋转可将基准参考板I逆时针旋转90°,或通过连接部位的302轴和303轴轴向旋转可将基准参考板后倾90°。
[0045] 图4为本发明提供的使用上述井下姿态测量系统的基于激光测距和加速度传感器的井下姿态测量方法流程图。如图4所示,作为本发明的一个实施例,该方法包括以下步骤:
[0046] 步骤401:在待测物体上安装激光测距传感器组4和加速度传感器单元5,启动测量控制器6,其中,激光测距传感器组4由两个激光测距传感器701和702组成;
[0047] 步骤402:依据地质基准参考平面与测试环境平面的关系调整基准参考板支架3与基准参考板I之间的逆时针转角和后向仰角;
[0048] 步骤403:参照两个激光测距传感器之间的距离调苄基准参考板I上的滑动导轨,使安装在基准参考板I上的反光材料块组2位于激光测距传感器组4的测量范围内,测量控制器6进入输入状态,其中,反光材料块组2由三个反光材料块组成;
[0049] 步骤404:由滑动导轨上的刻度获得位于垂直点处的反光材料块分别与其他两个反光材料块之间的距离Cl1和d2,即反光材料块201与203之间的距离屯,以及反光材料块201与202之间的距离d2,作为初始参考距离; [0050] 步骤405:在测量控制器6输入初始参考距离Cl1和d2,测量控制器6进入测量状态;
[0051] 步骤406:测量控制器6驱动激光测距传感器组4,获取两个激光测距传感器到三个反光材料块之间的六个距离;
[0052] 步骤407:测量控制器6由测量所得的距离和初始参考距离解算出待测物体相对于基准参考板I的偏向角和俯仰角;
[0053] 具体的计算过程如下:
[0054] 首先,求得激光测距传感器701和702相对于基准参考板I的坐标:取反光材料块201的坐标为(0,0,0),反光材料块202的坐标为(O, d2,0),反光材料块203的坐标为W1,0,0),根据步骤406测量得到的激光测距传感器701分别到反光材料块201,202,203的距离R1, R2和R3,求解如下非线性方程组,得到激光测距传感器701的坐标(Xl,y1; Z1):
Figure CN102536196BD00091
[0059] 然后,利用同样方法,根据激光测距传感器702分别到反光材料块201,202,203的距离R4, R5和R6,求得激光测距传感器702相对于基准参考板I的坐标(x2,y2, ζ2);
[0060] 那么,待测物体相对于基准参考板I的偏向角α为:
[0061] 待测物体相对于基准参考板I的偏向角β为:
Figure CN102536196BD00092
[0063] 若可求解出角度,转向步骤408,若由于误差,反光材料块组2并未位于激光测距传感器组4的测量范围内,从而导致角度无法求解,则返回步骤403,重新调苄基准参考板I上的滑动导轨;
[0064] 步骤408:测量控制器6驱动加速度传感器单元5,获取待测物体关于欧氏空间三个轴向的加速度矢量测量值;[0065] 步骤409:测量控制器6由三轴加速度矢量测量值计算出待测物体的滚转角,将俯仰角、偏向角、滚转角的计算结果显示到测量控制器6的LED屏上;其中,所述滚转角Y的计算公式如下:
_6] ,—2(命),
[0067] 其中,ax,ay和az分别为待测物体关于欧氏空间三个轴向的加速度矢量测量值。
[0068] 步骤410:测量完毕,关闭所有设备。
[0069] 以上所述的具体实施例,对本发明的目的、技术方案和有益效果进行了进一步详细说明,所应理解的是,以上所述仅为本发明的具体实施例而已,并不用于限制本发明,凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。

Claims (12)

1.一种基于激光测距和加速度测量的井下姿态测量系统,其特征在于,该系统包括:基准参考板(I)、反光材料块组(2)、基准参考板支架(3)、激光测距传感器组(4)、加速度传感器单元(5)、测量控制器(6),其中, 基准参考板(I)固定于基准参考板支架(3 )上并与基准参考板支架(3 )通过多轴方式连接,依据地质基准参考平面与测试环境平面的关系调整基准参考板支架(3)与基准参考板(I)之间的逆时针转角和后向仰角; 基准参考板(I)上固定有两条相互垂直且带有刻度的滑动导轨; 反光材料块组(2)由三个反光材料块组成,三个反光材料块按照几何垂直关系对齐安装在基准参考板(I)上的两条滑动导轨上,由滑动导轨上的刻度获得位于垂直点处的反光材料块分别与其他两个反光材料块之间的距离,作为初始参考距离输出给测量控制器(6); 激光测距传感器组(4)由两个激光测距传感器:第一激光测距传感器(701)和第二激光测距传感器(702)组成,用于参照两个激光测距传感器之间的距离调苄基准参考板(I)上的滑动导轨,使安装在基准参考板(I)上的反光材料块组(2)位于激光测距传感器组(4)的测量范围内,获取两个激光测距传感器到基准参考板(I)上三个反光材料块之间的六个测量距离,并将六个测量距离输出给测量控制器(6); 加速度传感器单元(5)安装在待测物体表面几何位置中心处,用于获取待测物体关于欧氏空间三个轴向的加速度矢量测量值; 测量控制器(6)通过防爆电缆与激光测距传感器组(4)和加速度传感器单元(5)相连,用于根据初始参考距离、激光测距传感器组(4)的测量值计算待测物体的偏向角、俯仰角,根据加速度传感器单元(5)的测量值计算待测物体的滚转角,并显示待测物体的方位角度。
2.根据权利要 求1所述的系统,其特征在于,基准参考板(I)两侧边线中心开孔以便与基准参考板支架(3)固定。
3.根据权利要求1所述的系统,其特征在于,所述通过多轴方式连接是指,基准参考板支架(3)具有多条转轴与基准参考板(I)连接,以部署反光材料块的一侧作为基准参考板(I)的正面,基准参考板支架(3)通过转轴可将基准参考板(I)逆时针最大旋转90度,以基准参考板(I)向激光测距传感器方向为前向,基准参考板支架(3)通过转轴可将基准参考板(I)向后最大旋转90度。
4.根据权利要求1所述的系统,其特征在于,所述三个反光材料块为同种材质、同样厚度、同样尺寸。
5.根据权利要求1所述的系统,其特征在于,所述三个反光材料块在基准参考板(I)上呈直角坐标系布置,三个反光材料块构成直角三角形,第一反光材料块(201)位于直角处,两条带有刻度的滑动导轨分别由第一反光材料块(201)位置处沿直角边布置,第二反光材料块(202)和第三反光材料块(203)分别安装在两条滑动导轨的滑块上。
6.根据权利要求1所述的系统,其特征在于,所述两个激光测距传感器分别安装在待测物体的两端。
7.根据权利要求1所述的系统,其特征在于,所述激光测距传感器激光发射方向朝向基准参考板(I)安装有反光材料块组(2)的一侧。
8.根据权利要求1所述的系统,其特征在于,为保证测量精度,所述两个激光测距传感器对齐,即两个激光测距传感器几何位置中心点所构成的直线与待测物体的边缘线平行。
9.根据权利要求1所述的系统,其特征在于,所述测量控制器为具备控制和浮点运算能力的计算设备,且具有键盘可以输入初始参考距离,并具有LED显示屏输出待测物体的方位角度。
10.一种基于激光测距和加速度测量的井下姿态测量方法,其特征在于,该方法包括以下步骤: 步骤1:在待测物体上安装激光测距传感器组(4)和加速度传感器单元(5),启动测量控制器(6),其中,激光测距传感器组(4)由两个激光测距传感器:第一激光测距传感器(701)和第二激光测距传感器(702)组成; 步骤2:依据地质基准参考平面与测试环境平面的关系调整基准参考板支架(3)与基准参考板(I)之间的逆时针转角和后向仰角; 步骤3:参照两个激光测距传感器之间的距离调苄基准参考板(I)上的滑动导轨,使安装在基准参考板(I)上的反光材料块组(2)位于激光测距传感器组(4)的测量范围内,反光材料块组(2)在基准参考板(I)上呈直角坐标系布置,三个反光材料块构成直角三角形,第一反光材料块(201)位于直角处,两条带有刻度的滑动导轨分别由第一反光材料块(201)位置处沿直角边布置,第二反光材料块(202)和第三反光材料块(203)分别安装在两条滑动导轨的滑块上,测量控制器(6)进入输入状态,其中,反光材料块组(2)由三个反光材料块组成; 步骤4:由滑动导轨上的刻度获得位于垂直点处的反光材料块分别与其他两个反光材料块之间的距离Cl1和d2,作为初始参考距离; 步骤5:在测量控制器(6)输入初始参考距离Cl1和d2,测量控制器(6)进入测量状态;步骤6:测量控制器(6)驱动`激光测距传感器组(4),获取两个激光测距传感器到三个反光材料块之间的六个距离; 步骤7:测量控制器(6)由测量所得的距离和初始参考距离解算出待测物体相对于基准参考板(I)的偏向角和俯仰角,若可求解出角度,转向步骤8,若角度无法求解,则返回步骤3,重新调苄基准参考板(I)上的滑动导轨; 步骤8:测量控制器(6)驱动加速度传感器单元(5),获取待测物体关于欧氏空间三个轴向的加速度矢量测量值; 步骤9:测量控制器(6)由三轴加速度矢量测量值计算出待测物体的滚转角,并将俯仰角、偏向角、滚转角的计算结果显示到测量控制器(6)的LED屏上; 步骤10:测量完毕,关闭所有设备。
11.根据权利要求10所述的方法,其特征在于,所述偏向角和俯仰角的计算进一步包括以下步骤: 首先,求得第一激光测距传感器(701)和第二激光测距传感器(702)相对于基准参考板(I)的坐标: 取第一反光材料块(201)的坐标为(0,0,0),第二反光材料块(202)的坐标为(0,d2,O),第三反光材料块(203)的坐标为((^0,0),根据步骤6测量得到的第一激光测距传感器(701)分别到第一反光材料块(201 ),第二反光材料块(202),第三反光材料块(203)的距离R1, R2和R3,求解如下非线性方程组,得到第一激光测距传感器(701)相对于基准参考板(I)的坐标(X1, Y1, Z1):
Figure CN102536196BC00041
然后,利用同样方法,根据第二激光测距传感器(702)分别到第一反光材料块(201),第二反光材料块(202),第三反光材料块(203)的距离R4,&和R6,求得第二激光测距传感器(702)相对于基准参考板(I)的坐标(¾,y2, z2); 那么,待测物体相对于基准参考板(I)的俯仰角α为:
Figure CN102536196BC00042
待测物体相对于基准参考板(i)的偏向角β为:
Figure CN102536196BC00043
12.根据权利要求10所 述的方法,其特征在于,所述滚转角按照下式来计算:
Figure CN102536196BC00044
其中,ax,ay和az分别为待测物体关于欧氏空间三个轴向的加速度矢量测量值。
CN201110451812.4A 2011-12-29 2011-12-29 基于激光测距和加速度测量的井下姿态测量系统及方法 Active CN102536196B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201110451812.4A CN102536196B (zh) 2011-12-29 2011-12-29 基于激光测距和加速度测量的井下姿态测量系统及方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201110451812.4A CN102536196B (zh) 2011-12-29 2011-12-29 基于激光测距和加速度测量的井下姿态测量系统及方法

Publications (2)

Publication Number Publication Date
CN102536196A CN102536196A (zh) 2012-07-04
CN102536196B true CN102536196B (zh) 2014-06-18

Family

ID=46344070

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201110451812.4A Active CN102536196B (zh) 2011-12-29 2011-12-29 基于激光测距和加速度测量的井下姿态测量系统及方法

Country Status (1)

Country Link
CN (1) CN102536196B (zh)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2015106254A (ja) * 2013-11-29 2015-06-08 トヨタ自動車株式会社 自律移動体、その制御方法及び制御プログラム
JP5962689B2 (ja) * 2014-02-14 2016-08-03 トヨタ自動車株式会社 自律移動体、及びその故障判定方法
CN104391507B (zh) * 2014-10-09 2017-04-19 深圳清华大学研究院 无人机的控制方法及系统、无人机
CN104407633B (zh) * 2014-11-24 2017-01-11 国家电网公司 一种水位测控系统及其测试方法
CN105241371B (zh) * 2015-10-28 2018-03-13 上海应用技术学院 电阻应变片
CN109110644B (zh) * 2018-07-21 2020-02-11 中铁十八局集团有限公司 一种基于bim的钢桁架杆件的精准定位系统
CN109738213B (zh) * 2019-02-03 2020-10-02 北京新联铁集团股份有限公司 轨道交通机车车辆巡检位姿检测系统及其方法
CN110919606A (zh) * 2019-11-29 2020-03-27 歌尔股份有限公司 自动调平调正装置
CN111123287A (zh) * 2019-12-31 2020-05-08 深圳前海达闼云端智能科技有限公司 机器人定位方法、机器人及计算机可读存储介质

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH11324560A (ja) * 1998-05-11 1999-11-26 Shimizu Corp トンネル内空断面測定システムおよび該測定システムを用いたトンネル掘削方法
GB2341025A (en) * 1998-04-23 2000-03-01 Barry James Gorham Positioning measuring apparatus having a non-linear target array
JP2000283760A (ja) * 1999-03-31 2000-10-13 Sentan Kensetsu Gijutsu Center 自動追尾計測システムの追尾復帰方法
JP2003262090A (ja) * 2002-03-12 2003-09-19 Nippon Koki Kk トンネル掘削機の位置計測装置
CN101266134A (zh) * 2008-04-30 2008-09-17 山西焦煤集团有限责任公司 悬臂掘进机头位姿的测量系统及其方法
CN100538275C (zh) * 2007-06-28 2009-09-09 北京航空航天大学 一种基于陀螺全站仪-激光标靶的盾构机自动导向系统的在线标定方法
CN101629807B (zh) * 2009-08-20 2011-02-02 中国矿业大学(北京) 掘进机机身位姿参数测量系统及其方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
GB2341025A (en) * 1998-04-23 2000-03-01 Barry James Gorham Positioning measuring apparatus having a non-linear target array
JPH11324560A (ja) * 1998-05-11 1999-11-26 Shimizu Corp トンネル内空断面測定システムおよび該測定システムを用いたトンネル掘削方法
JP2000283760A (ja) * 1999-03-31 2000-10-13 Sentan Kensetsu Gijutsu Center 自動追尾計測システムの追尾復帰方法
JP2003262090A (ja) * 2002-03-12 2003-09-19 Nippon Koki Kk トンネル掘削機の位置計測装置
CN100538275C (zh) * 2007-06-28 2009-09-09 北京航空航天大学 一种基于陀螺全站仪-激光标靶的盾构机自动导向系统的在线标定方法
CN101266134A (zh) * 2008-04-30 2008-09-17 山西焦煤集团有限责任公司 悬臂掘进机头位姿的测量系统及其方法
CN101629807B (zh) * 2009-08-20 2011-02-02 中国矿业大学(北京) 掘进机机身位姿参数测量系统及其方法

Also Published As

Publication number Publication date
CN102536196A (zh) 2012-07-04

Similar Documents

Publication Publication Date Title
CN102536196B (zh) 基于激光测距和加速度测量的井下姿态测量系统及方法
CN103134473B (zh) 无线气压测高装置及测高方法
CN103697854A (zh) 一种非接触式结构面产状测量方法
CN107272069A (zh) 基于磁异常梯度的磁性目标追踪方法
CN109974715B (zh) 捷联惯导和光斑识别组合的掘进机自主导航系统及方法
CN108166971B (zh) 一种多功能测斜仪及基于该测斜仪进行邻井套管相对位置判断的方法
CN104060982B (zh) 测距式井下钻孔开孔方位角测量方法
CN106595567A (zh) 地质结构面产状测量方法
Fan et al. Integrated positioning for coal mining machinery in enclosed underground mine based on SINS/WSN
CN102108856B (zh) 小角度井斜姿态测量方法及装置
Adushkin et al. From the alternating-sign explosion response of rocks to the pendulum waves in stressed geomedia. Part II
CN102538726A (zh) 一种电子经纬仪确定目标物位置与姿态的测试系统及其使用方法
CN102748010B (zh) 姿态测量系统和方法以及油井井眼轨迹测量系统和方法
CA3144609A1 (en) Measuring-robot device for fully mechanized coal mining face and automatic measuring system
CN106703787A (zh) 一种径向水平井的井眼轨迹参数计算方法及装置
WO2022053073A1 (zh) 一种基于双互感等值电压的地下三维位移测量系统与方法
CN104406566B (zh) 一种矿井智能综合地质测量仪及其测量方法
CN103411625A (zh) 动力调谐陀螺测斜仪的标定补偿方法及标定补偿模型
CN105841626A (zh) 一种井下巷道变形监测装置及方法
CN202483559U (zh) 多传感器测斜方位模块
CN105353348A (zh) 一种用于定位煤矿井下移动目标的系统及方法
CN203375934U (zh) 基坑围护结构分层水平位移的测量装置
CN105066949B (zh) 巷道空间形变测量装置及基于该装置的测量方法
CN103292778A (zh) 一种地下方位测量装置及其方法
Kocharyan et al. Movement of rock blocks during large-scale underground explosions. Part I: Experimental data

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant