CN108827220B - 一种基于捷联惯导的煤矿综采工作面直线度检测方法 - Google Patents
一种基于捷联惯导的煤矿综采工作面直线度检测方法 Download PDFInfo
- Publication number
- CN108827220B CN108827220B CN201810389803.9A CN201810389803A CN108827220B CN 108827220 B CN108827220 B CN 108827220B CN 201810389803 A CN201810389803 A CN 201810389803A CN 108827220 B CN108827220 B CN 108827220B
- Authority
- CN
- China
- Prior art keywords
- coal mining
- scraper conveyor
- mining machine
- coal
- central line
- 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
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B21/00—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
- G01B21/22—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring angles or tapers; for testing the alignment of axes
- G01B21/24—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring angles or tapers; for testing the alignment of axes for testing alignment of axes
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Excavating Of Shafts Or Tunnels (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种基于捷联惯导的煤矿综采工作面直线度检测方法,该方法包括以下步骤:步骤一、建立坐标系及定义煤矿综采工作面直线度;步骤二、安装捷联惯导测量模块;步骤三、计算综采工作面直线度的最大偏差值;步骤四、获取刮板输送机中心线实际位置;步骤五、获取煤矿综采工作面直线度及报警提醒。本发明方法步骤简单、设计合理且准确度高,实现对煤矿综采工作面直线度准确测量,适应采煤环境恶劣、空间有限、工作面粉尘大的煤矿综采工作面。
Description
技术领域
本发明属于煤矿开采技术领域,尤其是涉及一种基于捷联惯导的煤矿综采工作面直线度检测方法。
背景技术
随着我国煤炭科技的不断发展,对综采工作面智能化的要求也在不断提高。煤矿综采工作面是由采煤机、液压支架与刮板输送机共同组成。研究采煤机的位置与姿态信息可提高综采工作面的智能化水平,同时可对整条综采工作面中的“三机”设备进行直线度的测量,而综采工作面直线度测量的准确性又直接影响到煤矿井下的设备安全及工程质量。但由于煤炭行业的特殊性,综采工作面一般均为狭长形的测量对象,而综采工作面内又分布着大量的采煤设备,由于煤层的起伏以及采煤机截割时工作面煤尘对测量的影响,因此不能采用地面常规的激光定位技术和经纬度测量技术对综采工作面直线度进行测量。目前对综采工作面直线度的测量主要有以下几种方法:
(1)借助拉绳或红外射线由人工调整液压支架与刮板输送机的直线度,即由井下工作人员借助拉绳和红外射线等传统工具目测直线度的偏差,不过由于综采工作面设备较多、煤尘大,且综采工作面存在弯曲、起伏的情况,人的视线会受到很大影响,导致直线度测量的精度很低。
(2)运用半导体激光器、单模光纤准直激光束作为测量基准轴线,并以光电器件作为位置传感器,经单片机处理数据后可较为准确的显示所测直线度,其测量范围只能达到10m,但是工作面长度一般长达200m-300m,并且由于煤层的起伏以及采煤机截割时工作面煤尘对测量的影响,不能采用地面常规的激光定位技术对综采工作面直线度的测量;
(3)基于视觉测量的综采工作面直线度测量技术,主要是通过在工作面刮板输送机轨道布置LED灯,并使用图像传感器对LED灯进行采样,描绘出整个综采工作面直线度。但是当综采工作面煤尘大、光线低时,直接运用图像处理技术手段对工作面直线度进行计算有较大难度,测量精度低。
综上所述,目前综采工作面直线度测量主要受采煤环境恶劣、空间有限、工作面粉尘大等因素影响,现有的综采工作面直线度检测方法均未能满足智能化工作面的要求,无法准确获取综采工作面直线度。因此,需设计一种方法步骤简单、设计合理的基于捷联惯导的煤矿综采工作面直线度的测量方法,根据采煤机机身的实时姿态信息,建立采煤机航向角变化模型并获取采煤机航向角变化量,并结合刮板输送机中心线,实现对煤矿综采工作面直线度准确测量。
发明内容
本发明所要解决的技术问题在于针对上述现有技术中的不足,提供一种基于捷联惯导的煤矿综采工作面直线度检测方法,其方法步骤简单、设计合理且准确度高,根据采煤机机身的实时姿态信息,建立采煤机航向角变化模型并获取采煤机航向角变化量,并结合刮板输送机中心线实际位置和刮板输送机中心线初始位置,实现对煤矿综采工作面直线度准确测量,测量准确且方便,适应采煤环境恶劣、空间有限、工作面粉尘大的煤矿综采工作面。
为解决上述技术问题,本发明采用的技术方案是:一种基于捷联惯导的煤矿综采工作面直线度检测方法,其特征在于:
步骤一、建立坐标系及定义煤矿综采工作面直线度:
步骤101:导航坐标系的建立:建立导航坐标系OnXnYnZn,所述导航坐标系OnXnYnZn的原点On为采煤机机身的重心,所述导航坐标系OnXnYnZn的Xn轴正方向为过原点On且指向东,所述导航坐标系OnXnYnZn的Yn轴正方向为过原点On且指向北,所述导航坐标系OnXnYnZn的Zn轴为过原点On且垂直于由Xn轴和Yn轴形成的平面OnXnYn指向天;
步骤102、综采工作面直线度定义:定义煤矿综采工作面直线度为在两个采煤机行走轮之间的刮板输送机中心线实际位置与刮板输送机中心线初始位置之间的偏差;其中,所述刮板输送机中心线初始位置为沿煤矿综采工作面煤层倾斜线指向回风巷;
步骤二、安装捷联惯导测量模块:在采煤机机身中部位置O点处安装捷联惯导测量模块,且捷联惯导测量模块安装平面与采煤机机身两端相交的交线为AB和CD,所述捷联惯导测量模块安装平面内的采煤机机身长度方向的中线MN分别垂直于交线AB和交线CD,所述采煤机机身长度方向的中线MN与交线AB的交点为M,所述采煤机机身长度方向的中线MN和交线CD的交点为N,所述交点M和所述交点N的投影位于刮板输送机的中心线上;
步骤三、计算综采工作面直线度的最大偏差值:
步骤301、采用所述数据处理器根据公式得到两个采煤机行走轮之间的各节刮板输送机槽相对所述刮板输送机中心线初始位置的偏差值;其中,两个采煤机行走轮之间的刮板输送机由多节刮板输送机槽组成,LG表示每节刮板输送机槽的长度,且每节刮板输送机槽的长度均相同,f表示两个采煤机行走轮之间的刮板输送机槽的节数;所述刮板输送机槽的序号是按照采煤机的行走先后顺序进行编号,α0表示两个采煤机行走轮之间的第一节刮板输送机槽相对所述刮板输送机中心线初始位置的设定偏转角,当两个采煤机行走轮之间的第一节刮板输送机槽向煤矿综采工作面的煤壁侧弯曲时,α0的取值为小于0;当两个采煤机行走轮之间的第一节刮板输送机槽向采空区弯曲时,α0的取值为大于0,当两个采煤机行走轮之间的第一节刮板输送机槽与所述刮板输送机中心线初始位置平行时,则α0等于0;αi表示两个采煤机行走轮之间的第i+1节刮板输送机槽相对于第i节刮板输送机槽的设定偏转角,当两个采煤机行走轮之间的第i+1节刮板输送机槽相对第i节刮板输送机槽向采空区弯曲时,αi的取值为大于0;当两个采煤机行走轮之间的第i+1节刮板输送机槽相对第i节刮板输送机槽向煤矿综采工作面的煤壁侧弯曲时,αi的取值为小于0;当两个采煤机行走轮之间的第i+1节刮板输送机槽与第i节刮板输送机槽均与所述刮板输送机中心线初始位置平行时,则αi等于0,i=1、2、3、...、f-1,α1表示两个采煤机行走轮之间的第二节刮板输送机槽相对与第一节刮板输送机槽的设定偏转角,α2表示两个采煤机行走轮之间的第三节刮板输送机槽相对与第二节刮板输送机槽的设定偏转角,P1表示两个采煤机行走轮之间的第一节刮板输送机槽相对所述刮板输送机中心线初始位置的偏差值,P2表示两个采煤机行走轮之间的第二节刮板输送机槽相对所述刮板输送机中心线初始位置的偏差值,P3表示两个采煤机行走轮之间的第三节刮板输送机槽相对所述刮板输送机中心线初始位置的偏差值,Pf表示两个采煤机行走轮之间的第f节刮板输送机槽相对所述刮板输送机中心线初始位置的偏差值;
步骤302、采用所述数据处理器将两个采煤机行走轮之间的各节刮板输送机槽相对所述刮板输送机中心线初始位置的偏差值按照从小到大的顺序排序,获取两个采煤机行走轮之间的刮板输送机槽相对所述刮板输送机中心线初始位置的最大偏差值Pm,并将两个采煤机行走轮之间的刮板输送机槽相对所述刮板输送机中心线初始位置的最大偏差值Pm称作综采工作面直线度的最大偏差值Pm;
步骤四:获取刮板输送机中心线实际位置:
步骤401、采煤机姿态的获取:所述捷联惯导测量模块对采煤机的姿态进行实时检测,并将检测到采煤机的姿态发送至所述数据处理器中,所述采煤机的姿态包括采煤机的航向角、采煤机的俯仰角和采煤机的横滚角;
在导航坐标系下采用所述数据处理器将所述捷联惯导测量模块安装点O在t时刻的位置坐标记作POn(t)(XOnt,YOnt,ZOnt),且在t时刻采煤机的航向角为在t时刻采煤机的俯仰角为θt,在t时刻采煤机的横滚角为γt;
步骤402、获取刮板输送机中心线实际位置:
步骤4021、采用所述数据处理器根据公式得到在导航坐标系下所述交点M在t时刻的位置坐标PMn(t),同时,采用所述数据处理器根据公式得到在导航坐标系下所述交点N在t时刻的位置坐标PNn(t);其中,LQ为两个采煤机行走轮的中心距,LM为所述捷联惯导测量模块到所述交点M的水平距离;
步骤4022、采用所述数据处理器根据公式得到在导航坐标系下所述交点M在刮板输送机的中心线上的投影点M′在t时刻的位置坐标PM′n(t);采用所述数据处理器根据公式得到在导航坐标系下所述交点N在刮板输送机的中心线上的投影点N′在t时刻的位置坐标PN′n(t);其中,Lh为所述捷联惯导测量模块安装点O与所述安装点O在刮板输送机的水平面上投影点的垂线长度;
步骤4023、采用所述数据处理器将在导航坐标系下所述交点M在刮板输送机的中心线上的投影点M′在t时刻的位置坐标称为投影点M′在t时刻的位置坐标,则所述投影点M′在t时刻的位置坐标记作PM′n(t)(XM′nt,YM′nt,ZM′nt);采用所述数据处理器将在导航坐标系下所述交点N在刮板输送机的中心线上的投影点N′在t时刻的位置坐标称为投影点N′在t时刻的位置坐标,则所述投影点N′在t时刻的位置坐标记作PN′n(t)(XN′nt,YN′nt,ZN′nt);
步骤4024、采用所述数据处理器将所述投影点M′在所述平面OnXnYn上的投影点称为投影点M″,则所述投影点M″在t时刻的位置坐标为(XM′nt,YM′nt),采用所述数据处理器将所述投影点N′在所述平面OnXnYn上的投影点称为投影点N″,所述投影点N″在t时刻的位置坐标为(XN′nt,YN′nt);
步骤403、建立采煤机航向角变化模型及采煤机航向角变化量的获取:
步骤4031、在采煤机的行走过程中,采用所述数据处理器建立采煤机航向角变化模型其中,ΔS表示采煤机从t-1时刻到t时刻采煤机的行走距离,采煤机行走ΔS之后,任一个采煤机行走轮位于刮板输送机的同一节刮板输送机槽上,表示在t时刻采煤机的航向角,δi表示两个采煤机行走轮之间的第i+1节刮板输送机槽相对第i节刮板输送机槽的偏转角测量值,且两个采煤机行走轮之间的第一个节刮板输送机槽相对所述刮板输送机中心线初始位置的角度测量值为δ0;
步骤4032、采用所述数据处理器对步骤4031中建立的采煤机航向角变化模型进行计算,得到采煤机航向角变化量其中,λh表示两个采煤机行走轮之间的第f节刮板输送机槽相对于与第一节刮板输送机槽的偏转角测量值的余弦值,且
步骤4033、采用所述数据处理器对两个采煤机行走轮之间的第i+1节刮板输送机槽相对第i节刮板输送机槽的偏转角测量值δi进行判断,当δi>0成立,执行步骤4034,当δi<0成立,执行步骤4035,当δi=0成立,执行步骤4036;
步骤4036、当δi=0时,即两个采煤机行走轮之间的第i+1节刮板输送机槽相对第i个刮板输送机位于同一水平线上,重复步骤4034至步骤4036,采用所述数据处理器对两个采煤机行走轮之间的第i节刮板输送机槽与第i-1节刮板输送机槽之间的偏转角测量值δi-1进行判断;
步骤五、获取煤矿综采工作面直线度及报警提醒:
步骤501、采用所述数据处理器调取绘图模块在所述平面OnXnYn上绘制所述刮板输送机中心线初始位置曲线;
采用所述数据处理器调取所述绘图模块将所述投影点M″和所述投影点N′连接成直线,则连接出的直线为在t时刻时两个采煤机行走轮之间的刮板输送机中心线实际位置曲线,且在t时刻时两个采煤机行走轮之间的刮板输送机中心线实际位置相对在t-1时刻时两个采煤机行走轮之间的刮板输送机中心线实际位置的偏转角为所述采煤机航向角变化量,从而得到两个采煤机行走轮之间的刮板输送机中心线实际位置随时间t变化的曲线,并根据两个采煤机行走轮之间的刮板输送机中心线实际位置随时间t变化的曲线和所述刮板输送机中心线初始位置曲线得到煤矿综采工作面直线度;
步骤502、采用所述数据处理器调取曲线测量模块,对两个采煤机行走轮之间的刮板输送机中心线实际位置随时间t变化的曲线距所述刮板输送机中心线初始位置曲线之间的最大距离进行测量,从而获得煤矿综采工作面直线度最大值;
步骤503、采用所述数据处理器将煤矿综采工作面直线度最大值与所述综采工作面直线度的最大偏差值Pm进行比较,当煤矿综采工作面直线度最大值大于所述综采工作面直线度的最大偏差值Pm,则所述数据处理器控制与所述数据处理器连接的报警模块报警提醒。
上述的一种基于捷联惯导的煤矿综采工作面直线度检测方法,其特征在于:所述捷联惯导测量模块包括三轴陀螺仪和三轴加速度计,所述三轴陀螺仪和三轴加速度计均与所述数据处理器连接。
上述的一种基于捷联惯导的煤矿综采工作面直线度检测方法,其特征在于:步骤二中所述两个采煤机行走轮之间的第i+1节刮板输送机槽相对于第i节刮板输送机槽的设定偏转角αi的取值范围为-1°~+1°;
本发明与现有技术相比具有以下优点:
1、方法步骤简单、设计合理且实现方便,投入成本较低。
2、所采用的捷联惯导测量模块对采煤机的姿态进行实时检测,从而获得采煤机的姿态包括采煤机的航向角、采煤机的俯仰角和采煤机的横滚角,捷联惯导测量模块安装方便,煤层的起伏以及采煤机截割时工作面煤尘对捷联惯导测量模块的影响较小,从而能适应采煤环境恶劣、空间有限、工作面粉尘大的煤矿综采工作面。
3、所采用的捷联惯导测量模块安装平面与采煤机机身两端相交的交线为AB和CD,所述捷联惯导测量模块安装平面内的采煤机中线MN分别垂直于交线AB和交线CD,所述采煤机中线MN与交线AB的交点为M,所述采煤机中线MN和交线CD的交点为N,所述交点M和所述交点N的投影位于刮板输送机的中心线上,通过获取所述交点M在刮板输送机的中心线上的投影点M′和所述交点N在刮板输送机的中心线上的投影点N′的坐标位置,从而得到在采煤机不同位置时,采煤机行走轮之间的刮板输送机中心线实际位置。
4、采煤机以刮板输送机为运行轨道,采煤机行走轮以销排啮合的方式沿刮板输送机运动,刮板输送机的位置形状决定着采煤机在不同位置姿态角的变化量,结合刮板输送机和采煤机的位置关系能够获得采煤机姿态角变化与采煤机行走距离的数学模型,从而获得采煤机航向角变化模型,进而获得采煤机航向角变化量,从而获取刮板输送机中心线实际位置相对于刮板输送机中心线初始位置的偏转角。
5、根据获取的采煤机行走轮之间的刮板输送机中心线实际位置和采煤机航向角变化量,得到两个采煤机行走轮之间的刮板输送机中心线实际位置随时间变化的曲线,根据两个采煤机行走轮之间的刮板输送机中心线实际位置随时间变化的曲线距所述刮板输送机中心线初始位置曲线的距离,获取了煤矿综采工作面直线度最大值,实现对综采工作面直线度较为准确的测量。
综上所述,本发明方法步骤简单、设计合理且准确度高,根据采煤机机身的实时姿态信息,建立采煤机航向角变化模型并获取采煤机航向角变化量,并结合刮板输送机中心线实际位置和刮板输送机中心线初始位置,实现对煤矿综采工作面直线度准确测量,测量准确且方便,适应采煤环境恶劣、空间有限、工作面粉尘大的煤矿综采工作面。
下面通过附图和实施例,对本发明的技术方案做进一步的详细描述。
附图说明
图1为本发明的方法流程框图。
图2为本发明采煤机、刮板输送机和捷联惯导测量模块的结构示意图。
图3为图2的左视图。
图4为图2除去捷联惯导测量模块后的俯视图。
图5为本发明采煤机航向角变化模型的结构示意图。
图6为本发明步骤三中两个采煤机行走轮之间的第一节刮板输送机槽至第四节刮板输送机槽向采空区弯曲的结构示意图。
1—刮板输送机; 2—采煤机行走轮; 3—采煤机机身;
4—捷联惯导测量模块; 5—捷联惯导测量模块安装平面。
具体实施方式
如图1-图6所示的一种基于捷联惯导的煤矿综采工作面直线度检测方法,包括:
步骤一、建立坐标系及定义煤矿综采工作面直线度:
步骤101:导航坐标系的建立:建立导航坐标系OnXnYnZn,所述导航坐标系OnXnYnZn的原点On为采煤机机身3的重心,所述导航坐标系OnXnYnZn的Xn轴正方向为过原点On且指向东,所述导航坐标系OnXnYnZn的Yn轴正方向为过原点On且指向北,所述导航坐标系OnXnYnZn的Zn轴为过原点On且垂直于由Xn轴和Yn轴形成的平面OnXnYn指向天;
步骤102、综采工作面直线度定义:定义煤矿综采工作面直线度为在两个采煤机行走轮2之间的刮板输送机中心线实际位置与刮板输送机中心线初始位置之间的偏差;其中,所述刮板输送机中心线初始位置为沿煤矿综采工作面煤层倾斜线指向回风巷;
步骤二、安装捷联惯导测量模块:在采煤机机身3中部位置O点处安装捷联惯导测量模块4,且捷联惯导测量模块安装平面5与采煤机机身3两端相交的交线为AB和CD,所述捷联惯导测量模块安装平面5内的采煤机机身3长度方向的中线MN分别垂直于交线AB和交线CD,所述采煤机机身3长度方向的中线MN与交线AB的交点为M,所述采煤机机身3长度方向的中线MN和交线CD的交点为N,所述交点M和所述交点N的投影位于刮板输送机1的中心线上;
本实施例中,所述交线为AB和所述CD在刮板输送机1上的投影分别与两个采煤机行走轮2的轮轴中心线在刮板输送机1上的投影重合。
步骤三、计算综采工作面直线度的最大偏差值:
步骤301、采用所述数据处理器根据公式得到两个采煤机行走轮2之间的各节刮板输送机槽相对所述刮板输送机中心线初始位置的偏差值;其中,两个采煤机行走轮2之间的刮板输送机由多节刮板输送机槽组成,LG表示每节刮板输送机槽的长度,且每节刮板输送机槽的长度均相同,f表示两个采煤机行走轮2之间的刮板输送机槽的节数;所述刮板输送机槽的序号是按照采煤机的行走先后顺序进行编号,α0表示两个采煤机行走轮2之间的第一节刮板输送机槽相对所述刮板输送机中心线初始位置的设定偏转角,当两个采煤机行走轮2之间的第一节刮板输送机槽向煤矿综采工作面的煤壁侧弯曲时,α0的取值为小于0;当两个采煤机行走轮2之间的第一节刮板输送机槽向采空区弯曲时,α0的取值为大于0,当两个采煤机行走轮2之间的第一节刮板输送机槽与所述刮板输送机中心线初始位置平行时,则α0等于0;αi表示两个采煤机行走轮2之间的第i+1节刮板输送机槽相对于第i节刮板输送机槽的设定偏转角,当两个采煤机行走轮2之间的第i+1节刮板输送机槽相对第i节刮板输送机槽向采空区弯曲时,αi的取值为大于0;当两个采煤机行走轮2之间的第i+1节刮板输送机槽相对第i节刮板输送机槽向煤矿综采工作面的煤壁侧弯曲时,αi的取值为小于0;当两个采煤机行走轮2之间的第i+1节刮板输送机槽与第i节刮板输送机槽均与所述刮板输送机中心线初始位置平行时,则αi等于0,i=1、2、3、...、f-1,α1表示两个采煤机行走轮2之间的第二节刮板输送机槽相对与第一节刮板输送机槽的设定偏转角,α2表示两个采煤机行走轮2之间的第三节刮板输送机槽相对与第二节刮板输送机槽的设定偏转角,P1表示两个采煤机行走轮2之间的第一节刮板输送机槽相对所述刮板输送机中心线初始位置的偏差值,P2表示两个采煤机行走轮2之间的第二节刮板输送机槽相对所述刮板输送机中心线初始位置的偏差值,P3表示两个采煤机行走轮2之间的第三节刮板输送机槽相对所述刮板输送机中心线初始位置的偏差值,Pf表示两个采煤机行走轮2之间的第f节刮板输送机槽相对所述刮板输送机中心线初始位置的偏差值;
本实施例中,两个采煤机行走轮2之间的各节刮板输送机槽相对所述刮板输送机中心线初始位置的偏差值即两个采煤机行走轮2之间的各节刮板输送机槽的右端相对于所述刮板输送机中心线初始位置的偏差值。
步骤302、采用所述数据处理器将两个采煤机行走轮2之间的各节刮板输送机槽相对所述刮板输送机中心线初始位置的偏差值按照从小到大的顺序排序,获取两个采煤机行走轮2之间的刮板输送机槽相对所述刮板输送机中心线初始位置的最大偏差值Pm,并将两个采煤机行走轮2之间的刮板输送机槽相对所述刮板输送机中心线初始位置的最大偏差值Pm称作综采工作面直线度的最大偏差值Pm;
步骤四:获取刮板输送机中心线实际位置:
步骤401、采煤机姿态的获取:所述捷联惯导测量模块4对采煤机的姿态进行实时检测,并将检测到采煤机的姿态发送至所述数据处理器中,所述采煤机的姿态包括采煤机的航向角、采煤机的俯仰角和采煤机的横滚角;
在导航坐标系下采用所述数据处理器将所述捷联惯导测量模块4安装点O在t时刻的位置坐标记作POn(t)(XOnt,YOnt,ZOnt),且在t时刻采煤机的航向角为在t时刻采煤机的俯仰角为θt,在t时刻采煤机的横滚角为γt;
步骤402、获取刮板输送机中心线实际位置:
步骤4021、采用所述数据处理器根据公式得到在导航坐标系下所述交点M在t时刻的位置坐标PMn(t),同时,采用所述数据处理器根据公式得到在导航坐标系下所述交点N在t时刻的位置坐标PNn(t);其中,LQ为两个采煤机行走轮2的中心距,LM为所述捷联惯导测量模块4到所述交点M的水平距离;
步骤4022、采用所述数据处理器根据公式得到在导航坐标系下所述交点M在刮板输送机1的中心线上的投影点M′在t时刻的位置坐标PM′n(t);采用所述数据处理器根据公式得到在导航坐标系下所述交点N在刮板输送机1的中心线上的投影点N′在t时刻的位置坐标PN′n(t);其中,Lh为所述捷联惯导测量模块4安装点O与所述安装点O在刮板输送机1的水平面上投影点的垂线长度;
步骤4023、采用所述数据处理器将在导航坐标系下所述交点M在刮板输送机1的中心线上的投影点M′在t时刻的位置坐标称为投影点M′在t时刻的位置坐标,则所述投影点M′在t时刻的位置坐标记作PM′n(t)(XM′nt,YM′nt,ZM′nt);采用所述数据处理器将在导航坐标系下所述交点N在刮板输送机1的中心线上的投影点N′在t时刻的位置坐标称为投影点N′在t时刻的位置坐标,则所述投影点N′在t时刻的位置坐标记作PN′n(t)(XN′nt,YN′nt,ZN′nt);
步骤4024、采用所述数据处理器将所述投影点M′在所述平面OnXnYn上的投影点称为投影点M″,则所述投影点M″在t时刻的位置坐标为(XM′nt,YM′nt),采用所述数据处理器将所述投影点N′在所述平面OnXnYn上的投影点称为投影点N″,所述投影点N″在t时刻的位置坐标为(XN′nt,YN′nt);
步骤403、建立采煤机航向角变化模型及采煤机航向角变化量的获取:
步骤4031、在采煤机3的行走过程中,采用所述数据处理器建立采煤机3航向角变化模型其中,ΔS表示采煤机从t-1时刻到t时刻采煤机的行走距离,采煤机行走ΔS之后,任一个采煤机行走轮2位于在刮板输送机1的同一节刮板输送机槽上,表示在t时刻采煤机的航向角,δi表示两个采煤机行走轮2之间的第i+1节刮板输送机槽相对第i节刮板输送机槽的偏转角测量值,且两个采煤机行走轮2之间的第一个节刮板输送机槽相对所述刮板输送机中心线初始位置的角度测量值为δ0;
如图5所示,本实施例中,t-1时刻采煤机的位置用直线RR′表示,t时刻采煤机的位置用直线WW′表示。RR′表示t-1时刻两个采煤机行走轮2的中心距所在的位置,WW′表示t时刻两个采煤机行走轮2的中心距所在的位置,且R和W位于刮板输送机1的同一节刮板输送机槽上,同时,R′和W′位于刮板输送机1的同一节刮板输送机槽上。
需要说明的是,两个采煤机行走轮2之间的第i+1节刮板输送机槽相对第i节刮板输送机槽的偏转角测量值δi的取值方法与两个采煤机行走轮(2)之间的第i+1节刮板输送机槽相对于第i节刮板输送机槽的设定偏转角αi的取值方法相同。
步骤4032、采用所述数据处理器对步骤4031中建立的采煤机3航向角变化模型进行计算,得到采煤机航向角变化量其中,λh表示两个采煤机行走轮2之间的第f节刮板输送机槽相对于与第一节刮板输送机槽的偏转角测量值的余弦值,且
步骤4033、采用所述数据处理器对两个采煤机行走轮2之间的第i+1节刮板输送机槽相对第i节刮板输送机槽的偏转角测量值δi进行判断,当δi>0成立,执行步骤4034,当δi<0成立,执行步骤4035,当δi=0成立,执行步骤4036;
步骤4036、当δi=0时,即两个采煤机行走轮2之间的第i+1节刮板输送机槽相对第i个刮板输送机位于同一水平线上,重复步骤4034至步骤4036,采用所述数据处理器对两个采煤机行走轮2之间的第i节刮板输送机槽与第i-1节刮板输送机槽之间的偏转角测量值δi-1进行判断;
步骤五、获取煤矿综采工作面直线度及报警提醒:
步骤501、采用所述数据处理器调取绘图模块在所述平面OnXnYn上绘制所述刮板输送机中心线初始位置曲线;
采用所述数据处理器调取所述绘图模块将所述投影点M″和所述投影点N′连接成直线,则连接出的直线为在t时刻时两个采煤机行走轮2之间的刮板输送机中心线实际位置曲线,且在t时刻时两个采煤机行走轮2之间的刮板输送机中心线实际位置相对在t-1时刻时两个采煤机行走轮2之间的刮板输送机中心线实际位置的偏转角为所述采煤机航向角变化量,从而得到两个采煤机行走轮2之间的刮板输送机中心线实际位置随时间t变化的曲线,并根据两个采煤机行走轮2之间的刮板输送机中心线实际位置随时间t变化的曲线和所述刮板输送机中心线初始位置曲线得到煤矿综采工作面直线度;
步骤502、采用所述数据处理器调取曲线测量模块,对两个采煤机行走轮之间2的刮板输送机中心线实际位置随时间t变化的曲线距所述刮板输送机中心线初始位置曲线之间的最大距离进行测量,从而获得煤矿综采工作面直线度最大值;
步骤503、采用所述数据处理器将煤矿综采工作面直线度最大值与所述综采工作面直线度的最大偏差值Pm进行比较,当煤矿综采工作面直线度最大值大于所述综采工作面直线度的最大偏差值Pm,则所述数据处理器控制与所述数据处理器连接的报警模块报警提醒。
本实施例中,其特征在于:所述捷联惯导测量模块4包括三轴陀螺仪和三轴加速度计,所述三轴陀螺仪和三轴加速度计均与所述数据处理器连接。
本实施例中,其特征在于:步骤二中所述两个采煤机行走轮2之间的第i+1节刮板输送机槽相对于第i节刮板输送机槽的设定偏转角αi的取值范围为-1°~+1°;
以上所述,仅是本发明的较佳实施例,并非对本发明作任何限制,凡是根据本发明技术实质对以上实施例所作的任何简单修改、变更以及等效结构变化,均仍属于本发明技术方案的保护范围内。
Claims (3)
1.一种基于捷联惯导的煤矿综采工作面直线度检测方法,其特征在于:
步骤一、建立坐标系及定义煤矿综采工作面直线度:
步骤101:导航坐标系的建立:建立导航坐标系OnXnYnZn,所述导航坐标系OnXnYnZn的原点On为采煤机机身(3)的重心,所述导航坐标系OnXnYnZn的Xn轴正方向为过原点On且指向东,所述导航坐标系OnXnYnZn的Yn轴正方向为过原点On且指向北,所述导航坐标系OnXnYnZn的Zn轴为过原点On且垂直于由Xn轴和Yn轴形成的平面OnXnYn指向天;
步骤102、综采工作面直线度定义:定义煤矿综采工作面直线度为在两个采煤机行走轮(2)之间的刮板输送机中心线实际位置与刮板输送机中心线初始位置之间的偏差;其中,所述刮板输送机中心线初始位置为沿煤矿综采工作面煤层倾斜线指向回风巷;
步骤二、安装捷联惯导测量模块:在采煤机机身(3)中部位置O点处安装捷联惯导测量模块(4),且捷联惯导测量模块安装平面(5)与采煤机机身(3)两端相交的交线为AB和CD,所述捷联惯导测量模块安装平面(5)内的采煤机机身(3)长度方向的中线MN分别垂直于交线AB和交线CD,所述采煤机机身(3)长度方向的中线MN与交线AB的交点为M,所述采煤机机身(3)长度方向的中线MN和交线CD的交点为N,所述交点M和所述交点N的投影位于刮板输送机(1)的中心线上;
步骤三、计算综采工作面直线度的最大偏差值:
步骤301、采用数据处理器根据公式得到两个采煤机行走轮(2)之间的各节刮板输送机槽相对所述刮板输送机中心线初始位置的偏差值;其中,两个采煤机行走轮(2)之间的刮板输送机由多节刮板输送机槽组成,LG表示每节刮板输送机槽的长度,且每节刮板输送机槽的长度均相同,f表示两个采煤机行走轮(2)之间的刮板输送机槽的节数;所述刮板输送机槽的序号是按照采煤机的行走先后顺序进行编号,α0表示两个采煤机行走轮(2)之间的第一节刮板输送机槽相对所述刮板输送机中心线初始位置的设定偏转角,当两个采煤机行走轮(2)之间的第一节刮板输送机槽向煤矿综采工作面的煤壁侧弯曲时,α0的取值为小于0;当两个采煤机行走轮(2)之间的第一节刮板输送机槽向采空区弯曲时,α0的取值为大于0,当两个采煤机行走轮(2)之间的第一节刮板输送机槽与所述刮板输送机中心线初始位置平行时,则α0等于0;αi表示两个采煤机行走轮(2)之间的第i+1节刮板输送机槽相对于第i节刮板输送机槽的设定偏转角,当两个采煤机行走轮(2)之间的第i+1节刮板输送机槽相对第i节刮板输送机槽向采空区弯曲时,αi的取值为大于0;当两个采煤机行走轮(2)之间的第i+1节刮板输送机槽相对第i节刮板输送机槽向煤矿综采工作面的煤壁侧弯曲时,αi的取值为小于0;当两个采煤机行走轮(2)之间的第i+1节刮板输送机槽与第i节刮板输送机槽均与所述刮板输送机中心线初始位置平行时,则αi等于0,i=1、2、3、...、f-1,α1表示两个采煤机行走轮(2)之间的第二节刮板输送机槽相对与第一节刮板输送机槽的设定偏转角,α2表示两个采煤机行走轮(2)之间的第三节刮板输送机槽相对与第二节刮板输送机槽的设定偏转角,P1表示两个采煤机行走轮(2)之间的第一节刮板输送机槽相对所述刮板输送机中心线初始位置的偏差值,P2表示两个采煤机行走轮(2)之间的第二节刮板输送机槽相对所述刮板输送机中心线初始位置的偏差值,P3表示两个采煤机行走轮(2)之间的第三节刮板输送机槽相对所述刮板输送机中心线初始位置的偏差值,Pf表示两个采煤机行走轮(2)之间的第f节刮板输送机槽相对所述刮板输送机中心线初始位置的偏差值;
步骤302、采用所述数据处理器将两个采煤机行走轮(2)之间的各节刮板输送机槽相对所述刮板输送机中心线初始位置的偏差值按照从小到大的顺序排序,获取两个采煤机行走轮(2)之间的刮板输送机槽相对所述刮板输送机中心线初始位置的最大偏差值Pm,并将两个采煤机行走轮(2)之间的刮板输送机槽相对所述刮板输送机中心线初始位置的最大偏差值Pm称作综采工作面直线度的最大偏差值Pm;
步骤四:获取刮板输送机中心线实际位置:
步骤401、采煤机姿态的获取:所述捷联惯导测量模块(4)对采煤机的姿态进行实时检测,并将检测到采煤机的姿态发送至所述数据处理器中,所述采煤机的姿态包括采煤机的航向角、采煤机的俯仰角和采煤机的横滚角;
在导航坐标系下采用所述数据处理器将所述捷联惯导测量模块(4)安装点O在t时刻的位置坐标记作POn(t)(XOnt,YOnt,ZOnt),且在t时刻采煤机的航向角为在t时刻采煤机的俯仰角为θt,在t时刻采煤机的横滚角为γt;
步骤402、获取刮板输送机中心线实际位置:
步骤4021、采用所述数据处理器根据公式得到在导航坐标系下所述交点M在t时刻的位置坐标PMn(t),同时,采用所述数据处理器根据公式得到在导航坐标系下所述交点N在t时刻的位置坐标PNn(t);其中,LQ为两个采煤机行走轮(2)的中心距,LM为所述捷联惯导测量模块(4)到所述交点M的水平距离;
步骤4022、采用所述数据处理器根据公式得到在导航坐标系下所述交点M在刮板输送机(1)的中心线上的投影点M′在t时刻的位置坐标PM′n(t);采用所述数据处理器根据公式得到在导航坐标系下所述交点N在刮板输送机(1)的中心线上的投影点N′在t时刻的位置坐标PN′n(t);其中,Lh为所述捷联惯导测量模块(4)安装点O与所述安装点O在刮板输送机(1)的水平面上投影点的垂线长度;
步骤4023、采用所述数据处理器将在导航坐标系下所述交点M在刮板输送机(1)的中心线上的投影点M′在t时刻的位置坐标称为投影点M′在t时刻的位置坐标,则所述投影点M′在t时刻的位置坐标记作PM′n(t)(XM′nt,YM′nt,ZM′nt);采用所述数据处理器将在导航坐标系下所述交点N在刮板输送机(1)的中心线上的投影点N′在t时刻的位置坐标称为投影点N′在t时刻的位置坐标,则所述投影点N′在t时刻的位置坐标记作PN′n(t)(XN′nt,YN′nt,ZN′nt);
步骤4024、采用所述数据处理器将所述投影点M′在所述平面OnXnYn上的投影点称为投影点M″,则所述投影点M″在t时刻的位置坐标为(XM′nt,YM′nt),采用所述数据处理器将所述投影点N′在所述平面OnXnYn上的投影点称为投影点N″,所述投影点N″在t时刻的位置坐标为(XN′nt,YN′nt);
步骤403、建立采煤机航向角变化模型及采煤机航向角变化量的获取:
步骤4031、在采煤机(3)的行走过程中,采用所述数据处理器建立采煤机(3)航向角变化模型其中,ΔS表示采煤机从t-1时刻到t时刻采煤机的行走距离,采煤机行走ΔS之后,任一个采煤机行走轮(2)位于刮板输送机(1)的同一节刮板输送机槽上,表示在t时刻采煤机的航向角,δi表示两个采煤机行走轮(2)之间的第i+1节刮板输送机槽相对第i节刮板输送机槽的偏转角测量值,且两个采煤机行走轮(2)之间的第一个节刮板输送机槽相对所述刮板输送机中心线初始位置的角度测量值为δ0;
步骤4032、采用所述数据处理器对步骤4031中建立的采煤机(3)航向角变化模型进行计算,得到采煤机航向角变化量其中,λh表示两个采煤机行走轮(2)之间的第f节刮板输送机槽相对于与第一节刮板输送机槽的偏转角测量值的余弦值,且
步骤4033、采用所述数据处理器对两个采煤机行走轮(2)之间的第i+1节刮板输送机槽相对第i节刮板输送机槽的偏转角测量值δi进行判断,当δi>0成立,执行步骤4034,当δi<0成立,执行步骤4035,当δi=0成立,执行步骤4036;
步骤4036、当δi=0时,即两个采煤机行走轮(2)之间的第i+1节刮板输送机槽相对第i个刮板输送机位于同一水平线上,重复步骤4034至步骤4036,采用所述数据处理器对两个采煤机行走轮(2)之间的第i节刮板输送机槽与第i-1节刮板输送机槽之间的偏转角测量值δi-1进行判断;
步骤五、获取煤矿综采工作面直线度及报警提醒:
步骤501、采用所述数据处理器调取绘图模块在所述平面OnXnYn上绘制所述刮板输送机中心线初始位置曲线;
采用所述数据处理器调取所述绘图模块将所述投影点M″和所述投影点N′连接成直线,则连接出的直线为在t时刻时两个采煤机行走轮(2)之间的刮板输送机中心线实际位置曲线,且在t时刻时两个采煤机行走轮(2)之间的刮板输送机中心线实际位置相对在t-1时刻时两个采煤机行走轮(2)之间的刮板输送机中心线实际位置的偏转角为所述采煤机航向角变化量,从而得到两个采煤机行走轮(2)之间的刮板输送机中心线实际位置随时间t变化的曲线,并根据两个采煤机行走轮(2)之间的刮板输送机中心线实际位置随时间t变化的曲线和所述刮板输送机中心线初始位置曲线得到煤矿综采工作面直线度;
步骤502、采用所述数据处理器调取曲线测量模块,对两个采煤机行走轮之间(2)的刮板输送机中心线实际位置随时间t变化的曲线距所述刮板输送机中心线初始位置曲线之间的最大距离进行测量,从而获得煤矿综采工作面直线度最大值;
步骤503、采用所述数据处理器将煤矿综采工作面直线度最大值与所述综采工作面直线度的最大偏差值Pm进行比较,当煤矿综采工作面直线度最大值大于所述综采工作面直线度的最大偏差值Pm,则所述数据处理器控制与所述数据处理器连接的报警模块报警提醒。
2.按照权利要求1所述的一种基于捷联惯导的煤矿综采工作面直线度检测方法,其特征在于:所述捷联惯导测量模块(4)包括三轴陀螺仪和三轴加速度计,所述三轴陀螺仪和三轴加速度计均与所述数据处理器连接。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810389803.9A CN108827220B (zh) | 2018-04-27 | 2018-04-27 | 一种基于捷联惯导的煤矿综采工作面直线度检测方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810389803.9A CN108827220B (zh) | 2018-04-27 | 2018-04-27 | 一种基于捷联惯导的煤矿综采工作面直线度检测方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108827220A CN108827220A (zh) | 2018-11-16 |
CN108827220B true CN108827220B (zh) | 2020-04-21 |
Family
ID=64155733
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810389803.9A Active CN108827220B (zh) | 2018-04-27 | 2018-04-27 | 一种基于捷联惯导的煤矿综采工作面直线度检测方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108827220B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110319831B (zh) * | 2019-05-23 | 2021-01-01 | 北斗天地股份有限公司山东分公司 | 一种工作面取直方法 |
CN111441812B (zh) * | 2020-03-20 | 2021-09-07 | 郑州煤机液压电控有限公司 | 基于惯导系统的煤矿综采工作面自动调直系统及方法 |
CN115204325B (zh) * | 2022-09-16 | 2022-11-25 | 太原向明智控科技有限公司 | 基于惯导系统的综采工作面连续调直方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103775080B (zh) * | 2013-12-31 | 2015-09-23 | 中国矿业大学 | 一种薄煤层无人工作面采煤机姿态角调整模型的构建方法 |
CN105371871B (zh) * | 2015-12-02 | 2018-01-02 | 中国矿业大学 | 井下采煤机捷联惯导系统的组合初始对准系统及对准方法 |
CN106052595B (zh) * | 2016-05-25 | 2017-04-05 | 中国人民解放军国防科学技术大学 | 基于激光陀螺捷联惯导的三轴转台轴线垂直度检测方法 |
CN106570877B (zh) * | 2016-10-27 | 2017-12-05 | 西安科技大学 | 基于采煤机虚拟样机与真实图像配准的采煤机位姿定位系统及方法 |
CN107228662B (zh) * | 2017-06-05 | 2020-06-23 | 哈尔滨工程大学 | 一种基于管道连接器的小径管道定位装置及定位方法 |
CN207050702U (zh) * | 2017-08-02 | 2018-02-27 | 西安科技大学 | 一种综采工作面液压支架直线度测量装置 |
-
2018
- 2018-04-27 CN CN201810389803.9A patent/CN108827220B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN108827220A (zh) | 2018-11-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109018851B (zh) | 刮板输送机三维空间运行姿态位置的实时监测方法 | |
CN108827220B (zh) | 一种基于捷联惯导的煤矿综采工作面直线度检测方法 | |
CN111927518B (zh) | 一种基于惯导与里程计组合的综采工作面液压支架自动调直方法 | |
US4513504A (en) | Method for determining the position of a pressed-ahead hollow-section line, and apparatus for implementing the method | |
CN105737825B (zh) | 一种掘进机截割头位置测量系统 | |
CN111442759A (zh) | 一种综采工作面设备位姿统一监测系统 | |
CN106595557A (zh) | 一种刮板输送机直线度的检测装置及检测方法 | |
CN102322857A (zh) | 机动设备位姿测量系统及测量方法 | |
CN202066500U (zh) | 一种悬臂式掘进机的位姿测量系统 | |
CN110847905A (zh) | 采煤机自主导航系统及方法 | |
CN108868772A (zh) | 一种连采机快速准直控制方法 | |
CN113075650A (zh) | 一种基于uwb与惯性单元的地下巷道掘进装备实时定位方法 | |
CN111473780A (zh) | 一种悬臂掘进机测量系统 | |
CN110864692A (zh) | 掘进机的位姿确定方法 | |
CN106500649A (zh) | 一种基于惯性测量与轨道信标组合技术的矿井下车辆轨道变形监测方法 | |
CN111877108A (zh) | 一种基于线激光的路面平整度测量方法 | |
CN109115172B (zh) | 基于机器视觉的采煤机机身位姿检测方法 | |
CN106225779A (zh) | 基于三激光标记点图像的掘进机定位系统及定位方法 | |
CN103869282B (zh) | 井下巷道环境中无轨车辆的航向角快速获取方法及装置 | |
CN111396047B (zh) | 一种用于采煤工作面设备群的测量、定位系统及方法 | |
CN113252063A (zh) | 一种基于全站仪的采掘装备进深测量方法 | |
CN113236363A (zh) | 开采设备导航定位方法、系统、设备及可读存储介质 | |
CN105652866A (zh) | 一种掘进机自动测量及纠偏系统 | |
US20240043247A1 (en) | High-precision positioning system for underground monorail hoist in coal mine and positioning method thereof | |
CN116380055A (zh) | 一种综采工作面有轨式巡检机器人的自主定位方法 |
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 |