CN207440278U - 一种综采工作面液压支架绝对位置和姿态检测装置 - Google Patents

Abstract

本实用新型公开了一种综采工作面液压支架绝对位置和姿态检测装置，包括传感器组、数据处理器和与数据处理器相接的数据存储器，以及设置在待检测液压支架上的靶标，所述传感器组与数据处理器进行无线数据传输，所述传感器组包括设置在进风巷顶板控制点的第一基准光电跟踪器、设置在回风巷顶板控制点的第二基准光电跟踪器和多个设置在液压支架下方过渡点处的局部光电跟踪器，以及安装在待检测液压支架上的双轴水平仪。本实用新型能实时地检测液压支架的绝对位置和姿态，为构建精确的综采工作面地理信息系统奠定基础，也为综采工作面调直、液压支架纠偏以及综采工作面智能控制做好铺垫。

Description

一种综采工作面液压支架绝对位置和姿态检测装置

技术领域

本实用新型属于综采工作面液压支架绝对位置和姿态检测技术领域，尤其是涉及一种综采工作面液压支架绝对位置和姿态检测装置。

背景技术

综采工作面智能化和无人化是煤矿减少事故率、提高效益和提升竞争力的有效途径。液压支架是综采工作面的重要设备之一，主要有顶梁、立柱底座、推移千斤顶和操纵阀等组成，液压支架的主要作用是为工作面顶板支护，为采煤机工作提供足够的工作空间。然而综采工作面的液压支架数量多，回采过程中工作面连续推进，液压支架位置动态变化，实时、准确地检测出液压支架的绝对位置和姿态，是实现综采设备智能化和工作面无人化的重要基础。

综采工作面中液压支架绝对位置是指各液压支架相对于东北天地理坐标系的位置，液压支架姿态是指液压支架与地理坐标系三个坐标平面的夹角，分别为俯仰角、横滚角、倾角和偏转角。液压支架绝对位置检测是综采工作面调直控制的基础，液压支架姿态能反映液压支架在推溜移架过程中发生偏移、倾斜和横滚情况，是液压支架自动纠偏控制的前提。

现有液压支架位置检测方法主要有红外对射法、激光雷达扫描法、超宽带网络无线定位法等。而这些方法多属于相对定位法，得到的是液压支架相对于采煤机的位置信息，不能获得也要液压支架相对于地理坐标的绝对位置和姿态信息。

实用新型内容

本实用新型所要解决的技术问题在于针对上述现有技术中的不足，提供一种综采工作面液压支架绝对位置和姿态检测装置，其结构简单、设计合理且使用操作简便、使用效果好，能实时检测综采工作面液压支架在地理坐标中的绝对位置和姿态，为构建精确的综采工作面地理信息系统奠定基础，也为综采工作面调直、液压支架纠偏以及综采工作面智能控制做好铺垫，实用性强。

为解决上述技术问题，本实用新型采用的技术方案是：一种综采工作面液压支架绝对位置和姿态检测装置，其特征在于：包括传感器组、数据处理器和与数据处理器相接的数据存储器，以及设置在待检测液压支架上的靶标，所述传感器组与数据处理器进行无线数据传输，所述传感器组包括设置在进风巷顶板控制点的第一基准光电跟踪器、设置在回风巷顶板控制点的第二基准光电跟踪器和多个设置在液压支架下方过渡点处的局部光电跟踪器，以及安装在待检测液压支架上的双轴水平仪，所述第一基准光电跟踪器、第二基准光电跟踪器、局部光电跟踪器和双轴水平仪均与数据处理器进行无线数据传输，所述数据处理器的输入端接有参数输入模块。

上述的一种综采工作面液压支架绝对位置和姿态检测装置，其特征在于：所述靶标包括安装座、设置在安装座上的靶标机构和对所述靶标机构进行控制的靶标控制模块，所述安装座与待检测液压支架固定连接。

上述的一种综采工作面液压支架绝对位置和姿态检测装置，其特征在于：还包括第一无线通信模块和显示模块，所述第一无线通信模块和显示模块均与数据处理器相接，所述第一基准光电跟踪器、第二基准光电跟踪器、局部光电跟踪器和双轴水平仪均通过第一无线通信模块与数据处理器进行无线数据传输。

上述的一种综采工作面液压支架绝对位置和姿态检测装置，其特征在于：所述靶标机构包括防爆壳体、设置在防爆壳体前端的光圈和设置在防爆壳体前端且位于光圈内的玻璃盖，所述光圈的中心线和玻璃盖的中心线重合，所述防爆壳体内由前至后设置有漫反射透射膜和光敏元件阵列；

所述靶标控制模块包括靶标控制器和靶标控制器相接第二无线通信模块，所述光敏元件阵列与靶标控制器相接，所述数据处理器通过第一无线通信模块和第二无线通信模块与靶标控制器进行无线数据传输，所述靶标控制器通过第二无线通信模块与局部光电跟踪器进行无线数据传输。

上述的一种综采工作面液压支架绝对位置和姿态检测装置，其特征在于：所述靶标的数量为三个，三个所述靶标分别为设置在待检测液压支架顶梁下方的第一靶标、设置在待检测液压支架顶梁上且与所述第一靶标位于同一高度的第二靶标和设置在待检测液压支架的底座上端的第三靶标。

本实用新型与现有技术相比具有以下优点：

1、本实用新型所采用的综采工作面液压支架绝对位置和姿态检测装置结构简单、设计合理且实现方便。

2、本实用新型所采用的综采工作面液压支架绝对位置和姿态检测装置使用效果好，采用光电跟踪器非接触测量，且实时性好，准确地检测出液压支架在东北天地理坐标系下的绝对位置和姿态，为构建精确的综采工作面地理信息系统奠定基础，也为综采工作面调直、液压支架纠偏以及综采工作面智能控制做好铺垫，实用性强。

3、本实用新型所采用的综采工作面液压支架绝对位置和姿态检测装置，通过设置第一基准光电跟踪器和多个局部光电跟踪器，则根据第一基准光电跟踪器和多个局部光电跟踪器的传递测量，依次获取各个过渡点的坐标，光电跟踪器的使用数量减少，可有效降低成本。

4、本实用新型所采用的综采工作面液压支架绝对位置和姿态检测装置，通过设置第二基准光电跟踪器，则通过第二基准光电跟踪器和多个局部光电跟踪器的反向传递测量，对获取的各个过渡点的坐标进行校正，提高获取的各个过渡点的坐标的准确性，从而提高液压支架绝对位置和姿态测量的准确性。

5、本实用新型所采用的综采工作面液压支架绝对位置和姿态检测装置，通过在液压支架上设置局部光电跟踪器和靶标，使得液压支架移动的过程中，局部光电跟踪器和靶标跟随液压支架移动，实现了对液压支架位置和姿态的实时检测。

综上所述，本实用新型设计合理且成本低，使用操作简便，能实时且准确地对综采工作面液压支架在地理坐标中的绝对位置和姿态进行检测，为构建精确的综采工作面地理信息系统奠定基础，也为综采工作面调直、液压支架纠偏以及综采工作面智能控制做好铺垫，实用性强。

下面通过附图和实施例，对本实用新型的技术方案做进一步的详细描述。

附图说明

图1为本实用新型的电路原理框图。

图2为本实用新型中靶标的电路原理框图。

图3为本实用新型中靶标的结构示意图。

图4为综采工作面液压支架绝对位置和姿态检测检测的方法流程框图。

图5为本实用新型中基准点和过渡点的布置示意图。

图6为本实用新型中过渡点和参考点的布置示意图。

附图标记说明:

1—回风巷； 2—进风巷； 3—第一基准光电跟踪器；

4—第二基准光电跟踪器； 5—局部光电跟踪器；

6—双轴水平仪； 7—安装座； 8—防爆壳体；

9—光圈； 10—玻璃盖； 11—漫反射透射膜；

12—光敏元件阵列； 13—靶标控制器； 14—数据存储器；

15—第二无线通信模块； 16—第一无线通信模块；

17—参数输入模块； 18—显示模块； 19—数据处理器。

具体实施方式

如图1所示，一种综采工作面液压支架绝对位置和姿态检测装置包括传感器组、数据处理器19和与数据处理器19相接的数据存储器14，以及设置在待检测液压支架上的靶标，所述传感器组与数据处理器19进行无线数据传输，所述传感器组包括设置在进风巷2顶板控制点的第一基准光电跟踪器3、设置在回风巷1顶板控制点的第二基准光电跟踪器4和多个设置在液压支架下方过渡点处的局部光电跟踪器5，以及安装在待检测液压支架上的双轴水平仪6，所述第一基准光电跟踪器3、第二基准光电跟踪器4、局部光电跟踪器5和双轴水平仪6均与数据处理器19进行无线数据传输，所述数据处理器19的输入端接有参数输入模块17。

本实施例中，第一基准光电跟踪器3、第二基准光电跟踪器4和局部光电跟踪器5均为光电跟踪器，采用光电跟踪器非接触测量，且实时性好，准确地检测出液压支架在东北天地理坐标系下的绝对位置和姿态，为构建精确的综采工作面地理信息系统奠定基础，也为综采工作面调直、液压支架纠偏以及综采工作面智能控制做好铺垫，实用性强。

本实施例中，需要说明的是，第一基准光电跟踪器3、第二基准光电跟踪器4，局部光电跟踪器5和双轴水平仪6内部均集成有无线通信模块，用于无线数据的传输。

本实施例中，通过在液压支架上设置局部光电跟踪器5，使得液压支架移动的过程中，局部光电跟踪器5跟随液压支架移动，实现了对液压支架的实时检测。

如图2所示，本实施例中，靶标包括安装座7、设置在安装座7上的靶标机构和对所述靶标机构进行控制的靶标控制模块，所述安装座7与待检测液压支架固定连接。

如图1所示，本实施例中，还包括第一无线通信模块16和显示模块 18，所述第一无线通信模块16和显示模块18均与数据处理器19相接，所述第一基准光电跟踪器3、第二基准光电跟踪器4、局部光电跟踪器5 和双轴水平仪6均通过第一无线通信模块16与数据处理器19进行无线数据传输。

本实施例中，通过设置第一无线通信模块16，使得所述第一基准光电跟踪器3、第二基准光电跟踪器4、局部光电跟踪器5和双轴水平仪6均与数据处理器19无线数据传输，方便第一基准光电跟踪器3、第二基准光电跟踪器4、局部光电跟踪器5和双轴水平仪6的安装，避免安装有线连接的繁杂，且能保证数据传输的准确。

本实施例中，设置靶标，是因为靶标工作时，所述架靶的光圈9亮起，便于光电跟踪器中视觉系统识别，引导光电跟踪器进行位置跟踪，将测距激光束投射在支架靶标表面，保证激光跟踪器检测数据的准确性。

如图2和图3所示，本实施例中，所述靶标机构包括防爆壳体8、设置在防爆壳体8前端的光圈9和设置在防爆壳体8前端且位于光圈9内的玻璃盖10，所述光圈9的中心线和玻璃盖10的中心线重合，所述防爆壳体8内由前至后设置有漫反射透射膜11和光敏元件阵列12；

所述靶标控制模块包括靶标控制器13和与靶标控制器13相接的第二无线通信模块15，所述光敏元件阵列12与靶标控制器13相接，所述数据处理器19通过第一无线通信模块16和第二无线通信模块15与靶标控制器13进行无线数据传输，所述靶标控制器13通过第二无线通信模块15 与局部光电跟踪器5进行无线数据传输。

本实施例中，通过设置局部光电跟踪器5和所述靶标，是为了局部光电跟踪器5中所发出激光光束透过玻璃盖10投射在漫反射透射膜11表面上，漫反射透射膜11表面镀有漫反射物质，能将一部分激光进行漫反射供光电跟踪器测距，另一部分激光光束穿透该漫反射透射膜11投射在漫反射透射膜11后面的光敏元件阵列12表面，受激光照射的光敏元件阵列 12检测到光束信号，并发送至靶标控制器13，经过靶标控制器13处理得到投射在漫反射透射膜11上的光斑区域和光斑区域的光斑中心与标靶中心的偏距值，靶标控制器13并将偏距值通过第二无线通信模块15将该值发送到局部光电跟踪器5，局部光电跟踪器5依据此偏距值调整光电跟踪器5的光电轴位置，直到漫反射透射膜11上的光斑区域的光斑中心与与标靶中心重合，则局部光电跟踪器5测量此刻局部光电跟踪器5与靶标中心点的距离、俯仰角和水平角，即获得参考点的坐标，保证参考点坐标获取的准确性，进一步作为待检测液压支架局对位置和姿态计算依据，提高检测数据的准确性。

本实施例中，所述靶标的数量为三个，三个所述靶标分别为设置在待检测液压支架顶梁下方的第一靶标、设置在待检测液压支架顶梁上且与所述第一靶标位于同一高度的第二靶标和设置在待检测液压支架的底座上端的第三靶标。

本实施例中，通过设置所述第一靶标、所述第二靶标和所述第三靶标，并将局部光电跟踪器5所发出激光光束投射在第一靶标、所述第二靶标和所述第三靶标的中心位置，保证获取参考点坐标的准确性，通过获取与待检测液压支架上参考点的坐标而获取待检测液压支架的位置和姿态，这样一台局部光电跟踪器可采集多台待检测液压支架上靶标处参考点的坐标位置，得到多台液压支架的位置和姿态信息，降低检测成本。

需要说明的是，设置在综采工作面的液压支架为多个，则待检测液压支架为多个液压支架中的任一个液压支架。

如图4、图5和图6所示，利用本实用新型对综采工作面液压支架绝对位置和姿态检的进行检测的方法为：

步骤一、基准点的布置及基准光电跟踪器的安装：首先在进风巷2的顶板控制点设置第一基准点，并在所述第一基准点处安装第一基准光电跟踪器3；然后，在回风巷1的顶板控制点设置第二基准点，并在所述第二基准点处安装第二基准光电跟踪器4；其中，所述第一基准点记作基准点 A，所述第二基准点记作基准点B；

步骤二、过渡点的布置及局部光电跟踪器的安装：首先，分别在多个所述液压支架顶梁下方设置多个过渡点；然后，分别在多个所述过渡点处安装局部光电跟踪器5；其中，多个所述过渡点分别为过渡点O₁、过渡点 O₂、…、过渡点O_N，多个所述过渡点中第i个过渡点记作O_i，i为正整数且 i＝1、2、…、N，N为所述过渡点的数量，所述过渡点O₁靠近进风巷2，所述过渡点O_N靠近回风巷1，多个所述局部光电跟踪器5分别为安装在过渡点O₁上的第一局部光电跟踪器、安装在过渡点O₂上的第二局部光电跟踪器、…、安装在过渡点O_N-1上的第N-1局部光电跟踪器和安装在过渡点O_N上的第N局部光电跟踪器，多个所述局部光电跟踪器5中第i局部光电跟踪器为安装在过渡点O_i上；

步骤三、建立东北天地理坐标系并获取基准点的坐标：分别在基准点 A、基准点B和过渡点O_i处建立东北天地理坐标系AXYZ、东北天地理坐标系BXYZ和东北天地理坐标系O_iXYZ，获得基准点A的坐标A(x_A,y_A,z_A)和基准点B的坐标B(x_B,y_B,z_B)，通过所述参数输入模块17输入，并存储至数据存储器14中；

步骤四、根据基准点A获取各个过渡点的坐标，具体过程如下：

步骤401、调整所述第一基准光电跟踪器3，且使所述第一基准光电跟踪器3所发出激光光束投射在过渡点O₁上，所述第一基准光电跟踪器3 对过渡点O₁的姿态进行实时检测，并将检测到的过渡点O₁姿态数据O′₁无线传送至数据处理器19，数据处理器19接收到过渡点O₁姿态数据O′₁，且所述过渡点O₁姿态数据O′₁包括第一基准光电跟踪器3所发出激光光束投射至过渡点O₁上时的投射距离AO₁、基准点A与过渡点O₁连线与水平面XAY间的俯仰角θ′₁以及基准点A与过渡点O₁连线与水平面XAY中X轴间的水平角并采用数据处理器19根据公式获得过渡点O₁的坐标o′₁(x′₁,y′₁,z′₁)；

步骤402、调整所述第一局部光电跟踪器，且使所述第一局部光电跟踪器所发出激光光束投射在过渡点O₂上，所述第二局部光电跟踪器对过渡点O₂的姿态进行实时检测，并将检测到的过渡点O₂姿态数据O′₂无线传送至数据处理器19，数据处理器19接收到过渡点O₂姿态数据O′₂，且所述过渡点O₂姿态数据O′₂包括所述第一局部光电跟踪器所发出激光光束投射至过渡点O₂上时的投射距离O₁O₂′、过渡点O₁与过渡点O₂连线与水平面XO₁Y的俯仰角θ′₂以及过渡点O₁与过渡点O₂连线与水平面XO₁Y中X轴间的水平角并采用数据处理器19根据公式获得过渡点O₂的坐标 o′₂(x′₂,y′₂,z′₂)；

步骤403、按照步骤402的方法，获取下一个过渡点的坐标；

步骤404、多次重复步骤403，直至获取各个过渡点O_i的坐标o′_i(x′_i,y′_i,z′_i)，并存储至数据存储器14中；

本实施例中，通过设置第一基准光电跟踪器3和多个局部光电跟踪器 5，则根据第一基准光电跟踪器1和多个局部光电跟踪器5的传递测量，依次获取各个过渡点的坐标，光电跟踪器的使用数量减少，可有效降低成本。

步骤五、各个过渡点的坐标的校正：采用数据处理器19对步骤五中获取的过渡点O_i的坐标o′_i(x′_i,y′_i,z′_i)进行校正，则获取校正后的过渡点O_i的坐标o_i(x_i,y_i,z_i)；

本实施例中，通过设置第二基准光电跟踪器4，则通过第二基准光电跟踪器4和多个局部光电跟踪器5的反向传递测量，对获取的各个过渡点的坐标进行校正，提高获取的各个过渡点的坐标的准确性，从而提高液压支架绝对位置和姿态测量的准确性。

步骤六、液压支架绝对位置和姿态的获取：采用所述数据处理器19 获取液压支架绝对位置和姿态，具体过程为：

步骤601、首先，在待检测液压支架顶梁的下方设置参考点P₁，且参考点P₁距待检测液压支架顶梁顶部的竖直间距为h₀，并在待检测液压支架顶梁上设置参考点P₂，在待检测液压支架的底座上端设置参考点P₃，其中，所述参考点P₁和所述参考点P₂位于同一高度，所述参考点P₁、所述参考点P₂和所述参考点P₃形成的平面P₁P₂P₃与待检测液压支架垂直方向的中心平面重合，所述参考点P₁和所述参考点P₂之间的水平间距为P₁P₂，所述过渡点O_i靠近待检测液压支架；

然后，分别在所述参考点P₁、所述参考点P₂和所述参考点P₃安装第一靶标、第二靶标和第三靶标；

最后，在待检测液压支架的底座前端设置目标点Q，并在目标点Q建立空间直角坐标系QXYZ，获取参考点P₃在空间直角坐标系QXYZ的坐标 P₃′(x_qp3,y_qp3,z_qp3)，并存储至数据存储器14中；其中，所述空间直角坐标系 QXYZ是以目标点Q为坐标原点和以待检测液压支架前进方向为Y轴正方向的前提下，以符合右手坐标的方向为X轴正方向，且以待检测液压支架高度方向为Z轴正方向建立的；

步骤602、调整所述第i局部光电跟踪器，使所述第i局部光电跟踪器所发出激光光束分别投射在所述参考点P₁、所述参考点P₂和所述参考点 P₃上，采用数据处理器19获取所述参考点P₁的坐标、所述参考点P₂的坐标和所述参考点P₃的坐标，具体为：

采用数据处理器19根据公式获得参考点P₁的坐标P₁(x_ip1,y_ip1,z_ip1)，并存储至数据存储器14中；其中，O_iP₁为第i局部光电跟踪器所发出激光光束投射至参考点P₁上时的投射距离,θ_p1为过渡点O_i与参考点P₁连线与水平面XO_iY间的俯仰角，为过渡点O_i与参考点P₁连线与水平面XO_iY中X轴间的水平角；采用数据处理器19根据公式获得参考点P₂的坐标P₂(x_ip2,y_ip2,z_ip2)，并存储至数据存储器14中；其中，O_iP₂为第i局部光电跟踪器所发出激光光束投射至参考点P₂上时的投射距离,θ_p2为过渡点O_i与参考点P₂连线与水平面XO_iY间的俯仰角，为过渡点O_i与参考点P₂连线与水平面XO_iY中X轴间的水平角；并采用数据处理器19根据公式获得参考点P₃的坐标P₃(x_ip3,y_ip3,z_ip3)，并存储至数据存储器14中；其中，O_iP₃为第i局部光电跟踪器所发出激光光束投射至参考点P₃上时的投射距离,θ_p3为过渡点O_i与参考点P₃与水平面XO_iY间的俯仰角，为过渡点O_i与参考点P₃连线与水平面XO_iY中X轴间的水平角；

步骤603、采用数据处理器19获得待检测液压支架的姿态，具体过程为：

步骤6031、在所述参考点P₃安装双轴水平仪6，获得待检测液压支架的俯仰角α和横滚角β；

需要说明的是，实际安装过程中，双轴水平仪6的X敏感轴和Y敏感轴分别与目标点Q处空间直角坐标系QXYZ中的X轴和Y轴平行，保证待检测液压支架的俯仰角α和横滚角β检测准确。

步骤6032、采用数据处理器19根据参考点P₁的坐标P₁(x_ip1,y_ip1,z_ip1)和参考点P₂的坐标P₂(x_ip2,y_ip2,z_ip2)，得到直线向量并采用数据处理器19根据公式获得待检测液压支架顶梁的倾角λ；其中，为X_iO_iY_i坐标平面的单位法向量，且

步骤6033、采用数据处理器19建立所述平面P₁P₂P₃在O_iXYZ东北天地理坐标系下的平面方程，如下：

化简后为A₁x_i+B₁y_i+C₁z_i+D₁＝0，则获得所述平面P₁P₂P₃的法向量其中，

A₁＝z_ip2y_ip1+z_ip1y_ip3+z_ip3y_ip2-y_ip2z_ip1-y_ip3z_ip2-y_ip1z_ip3，

B₁＝z_ip2x_ip1+z_ip1x_ip3+z_ip3x_ip2-x_ip2z_ip1-x_ip3z_ip2-x_ip1z_ip3，

C₁＝y_ip2x_ip1+y_ip1x_ip3+y_ip3x_ip2-x_ip2y_ip1-x_ip3y_ip2-x_ip1y_ip3，

D₁＝z_ip3y_ip2x_ip1+x_ip3z_ip2y_ip1+y_ip3x_ip2z_ip1-z_ip3x_ip2y_ip1-x_ip3y_ip2z_ip1-y_ip3z_ip2x_ip1；

步骤6034、采用数据处理器19根据公式获得待检测液压支架的偏转角γ；其中为X_iO_iZ_i坐标平面的单位法向量，且

步骤604、采用数据处理器19根据公式获得旋转变换矩阵R，并采用数据处理器19根据公式 (x_iq,y_iq,z_iq)＝(x_ip3,y_ip3,z_ip3)-(x_qp3,y_qp3,z_qp3)·R，获得目标点Q的坐标Q(x_iq,y_iq,z_iq)；

步骤605、采用数据处理器19根据公式获得东北天地理坐标系下目标点Q的坐标Q′(x_q,y_q,z_q)，并采用数据处理器19根据公式 h＝z_ip1-z_iq+h₀，获得待检测液压支架顶梁的高度h，则获得待检测液压支架的绝对位置。

本实施例中，待检测液压支架的绝对位置和待检测液压支架的姿态通过显示模块18进行显示，便于工作人员实时查看，方便工作人员对综采工作面调直、纠偏液压支架以及控制综采工作面。

本实施例中，步骤二中相邻两个所述过渡点的间距为20m～50m。

本实施例中，第一基准光电跟踪器3、第二基准光电跟踪器4和局部光电跟踪器5均为光电跟踪器，采用光电跟踪器对液压支架位置和姿态的实时检测，是因为光电跟踪器里的激光测距模块、视觉系统的镜头部分体积就比较小，价格比较低，装配起来后整机体积小，功耗较低，安置在支架下方不会影响支架的工作。另外相邻两个局部光电跟踪器的间距为 20m～50m，如果间距设置较大，则需要光电跟踪器中的激光测距模块和视觉系统的要求提高，一方面价格高，另一方面体积变大，再加上防爆壳，体积会更大，造成安装不便捷，且影响检测的准确性。

本实施例中，步骤三中建立东北天地理坐标系并获取基准点的坐标，具体过程为：

首先，在步骤一中基准点A处，以基准点A为原点，以过基准点A且指向东的方向为X轴正方向，以过基准点A且指向北的方向为Y轴正方向，以过基准点A且垂直于由X轴和Y轴形成的水平面XAY的方向为Z轴，建立东北天地理坐标系AXYZ，获得已知基准点A的坐标A(x_A,y_A,z_A)，并通过所述参数输入模块17输入存储至数据存储器14中；

然后，在步骤一中基准点B处，以基准点B为原点，以过基准点B且指向东的方向为X轴正方向，以过基准点B且指向北的方向为Y轴正方向，以过基准点A且垂直于由X轴和Y轴形成的水平面XBY的方向为Z轴正方向，建立东北天地理坐标系BXYZ，获得已知基准点B的坐标B(x_B,y_B,z_B)，并通过所述参数输入模块17输入存储至数据存储器14中；

最后，分别在过渡点O_i处，以过渡点O_i为原点，以过渡点O_i且指向东的方向为X轴正方向，以过过渡点O_i且指向北的方向为Y轴正方向，以过过渡点O_i且垂直于由X轴和Y轴形成的水平面XO_iY的方向为Z轴正方向，建立东北天地理坐标系O_iXYZ。

本实施例中，步骤五中采用数据处理器19对步骤五中获取的过渡点O_i的坐标o′_i(x′_i,y′_i,z′_i)进行校正，具体过程如下：

步骤501、过渡点O_N的坐标的校正，具体过程为：

步骤5011、调整所述第二基准光电跟踪器4，且使所述第二基准光电跟踪器4所发出激光光束投射在过渡点O_N上，所述第二基准光电跟踪器4 对过渡点O_N的姿态进行实时检测，并将检测到的过渡点O_N姿态数据O″_N无线传送至数据处理器19，数据处理器19接收到过渡点O_N姿态数据O″_N，且所述过渡点O_N姿态数据O″_N包括第二基准光电跟踪器4所发出激光光束投射至过渡点O_N上时的投射距离BO_N、基准点B与过渡点O_N连线与水平面 XBY间的俯仰角θ″_N以及基准点B与过渡点O_N连线与水平面XBY中X轴间的水平角并采用数据处理器19根据公式获得过渡点O_N的坐标o″_N(x″_N,y″_N,z″_N)；

步骤5012、采用数据处理器19根据公式获得过渡点O_N的测量误差Δδ_N, 并采用数据处理器19根据判定条件Δδ_N≤ε进行判定，当判定条件Δδ_N≤ε成立时，执行步骤5013；当判定条件Δδ_N≤ε不成立时，执行步骤5014；

步骤5013、当判定条件Δδ_N≤ε成立时，则校正后的过渡点O_N的坐标 o_N(x_N,y_N,z_N)取o′_N(x′_N,y′_N,z′_N)；

步骤5014、当判定条件Δδ_N≤ε不成立时，则校正后的过渡点O_N的坐标o_N(x_N,y_N,z_N)取o″_N(x″_N,y″_N,z″_N)；

步骤502、过渡点O_N-1的坐标的校正，具体过程为：

步骤5021、调整所述第N局部光电跟踪器，且使所述第N局部光电跟踪器所发出激光光束投射在过渡点O_N-1上，所述第N局部光电跟踪器对过渡点O_N-1的姿态进行实时检测，并将检测到的过渡点O_N-1姿态数据O″_N-1无线传送至数据处理器19，数据处理器19接收到过渡点O_N-1姿态数据O″_N-1，且所述过渡点O_N-1姿态数据O″_N-1包括所述第N局部光电跟踪器所发出激光光束投射在过渡点O_N-1上时的投射距离O_NO_N-1″、过渡点O_N与过渡点O_N-1连线与水平面XO_NY间的俯仰角θ″_N-1以及过渡点O_N与过渡点O_N-1连线与水平面 XO_NY中X轴间的水平角并采用数据处理器19根据公式获得上一过渡点O_N-1的坐标o″_N-1(x″_N-1,y″_N-1,z″_N-1)；

步骤5022、采用数据处理器19根据公式获得过渡点O_N-1的测量误差Δδ_N-1,并采用数据处理器19根据判定条件Δδ_N-1≤ε进行判定，当判定条件Δδ_N-1≤ε成立时，执行步骤5023；当判定条件Δδ_N-1≤ε不成立时，执行步骤5024；

步骤5023、当判定条件Δδ_N-1≤ε成立时，则校正后的过渡点O_N-1的坐标o_N-1(x_N-1,y_N-1,z_N-1)取o′_N(x′_N,y′_N,z′_N)；

步骤5024、当判定条件Δδ_N-1≤ε不成立时，则校正后的过渡点O_N的坐标o_N(x_N,y_N,z_N)取o″_N-1(x″_N-1,y″_N-1,z″_N-1)；

步骤503、按照步骤502的方法，完成上一个过渡点的坐标的校正；

步骤504、多次重复步骤503，直至完成各个过渡点O_i的坐标的校正，则获取校正后的过渡点O_i的坐标o_i(x_i,y_i,z_i)。

本实施例中，所述ε的取值范围为50mm～300mm，是为了保证各个过渡点O_i的坐标的误差满足煤矿开采需求。

由上述内容可知，本实用新型设计合理且成本低，使用操作简便，能实时且准确地对综采工作面液压支架在地理坐标中的绝对位置和姿态进行检测，为构建精确的综采工作面地理信息系统奠定基础，也为综采工作面调直、液压支架纠偏以及综采工作面智能控制做好铺垫，实用性强。

以上所述，仅是本实用新型的较佳实施例，并非对本实用新型作任何限制，凡是根据本实用新型技术实质对以上实施例所作的任何简单修改、变更以及等效结构变化，均仍属于本实用新型技术方案的保护范围内。

Claims (5)

1.一种综采工作面液压支架绝对位置和姿态检测装置，其特征在于：包括传感器组、数据处理器(19)和与数据处理器(19)相接的数据存储器(14)，以及设置在待检测液压支架上的靶标，所述传感器组与数据处理器(19)进行无线数据传输，所述传感器组包括设置在进风巷(2)顶板控制点的第一基准光电跟踪器(3)、设置在回风巷(1)顶板控制点的第二基准光电跟踪器(4)和多个设置在液压支架下方过渡点处的局部光电跟踪器(5)，以及安装在待检测液压支架上的双轴水平仪(6)，所述第一基准光电跟踪器(3)、第二基准光电跟踪器(4)、局部光电跟踪器(5)和双轴水平仪(6)均与数据处理器(19)进行无线数据传输，所述数据处理器(19)的输入端接有参数输入模块(17)。

2.按照权利要求1所述的一种综采工作面液压支架绝对位置和姿态检测装置，其特征在于：所述靶标包括安装座(7)、设置在安装座(7)上的靶标机构和对所述靶标机构进行控制的靶标控制模块，所述安装座(7)与待检测液压支架固定连接。

3.按照权利要求2所述的一种综采工作面液压支架绝对位置和姿态检测装置，其特征在于：还包括第一无线通信模块(16)和显示模块(18)，所述第一无线通信模块(16)和显示模块(18)均与数据处理器(19)相接，所述第一基准光电跟踪器(3)、第二基准光电跟踪器(4)、局部光电跟踪器(5)和双轴水平仪(6)均通过第一无线通信模块(16)与数据处理器(19)进行无线数据传输。

4.按照权利要求3所述的一种综采工作面液压支架绝对位置和姿态检测装置，其特征在于：所述靶标机构包括防爆壳体(8)、设置在防爆壳体(8)前端的光圈(9)和设置在防爆壳体(8)前端且位于光圈(9)内的玻璃盖(10)，所述光圈(9)的中心线和玻璃盖(10)的中心线重合，所述防爆壳体(8)内由前至后设置有漫反射透射膜(11)和光敏元件阵列(12)；

所述靶标控制模块包括靶标控制器(13)和与靶标控制器(13)相接第二无线通信模块(15)，所述光敏元件阵列(12)与靶标控制器(13)相接，所述数据处理器(19)通过第一无线通信模块(16)和第二无线通信模块(15)与靶标控制器(13)进行无线数据传输，所述靶标控制器(13)通过第二无线通信模块(15)与局部光电跟踪器(5)进行无线数据传输。

5.按照权利要求1所述的一种综采工作面液压支架绝对位置和姿态检测装置，其特征在于：所述靶标的数量为三个，三个所述靶标分别为设置在待检测液压支架顶梁下方的第一靶标、设置在待检测液压支架顶梁上且与所述第一靶标位于同一高度的第二靶标和设置在待检测液压支架的底座上端的第三靶标。