CN107270901B - 融合采煤工艺与采煤机运动模型的采煤机惯性定位精度提升方法 - Google Patents
融合采煤工艺与采煤机运动模型的采煤机惯性定位精度提升方法 Download PDFInfo
- Publication number
- CN107270901B CN107270901B CN201710704725.2A CN201710704725A CN107270901B CN 107270901 B CN107270901 B CN 107270901B CN 201710704725 A CN201710704725 A CN 201710704725A CN 107270901 B CN107270901 B CN 107270901B
- Authority
- CN
- China
- Prior art keywords
- coal mining
- mining machine
- coal
- scraper conveyor
- filter
- 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
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Abstract
本发明公开了一种融合采煤工艺与采煤机运动模型的采煤机惯性定位精度提升方法。采煤机以刮板输送机为运行轨道,采煤机只在轨道方向上产生速度,而在其他两个方向的速度为零,以此采煤机牵引方向的约束条件设计了第一滤波器;采煤机截割煤壁后,刮板输送机在液压支架推移油缸的作用下,沿工作面回采方向进行推进,利用液压支架推移油缸的位移与最优估计的刮板输送机轨迹,预测出采煤机下次截割的刮板输送机轨迹,作为采煤机下次运行的约束条件,设计了第二滤波器;对两个滤波器进行融合,最大程度的提高了采煤机惯性定位精度。该方法全面地综合了采煤机在综采工作面独特的运行特点,在一定程度上解决了采煤机惯性导航长时间定位精度差的问题。
Description
技术领域
本发明涉及一种融合采煤工艺与采煤机运动模型的采煤机惯性定位精度提升方法,属于采煤机惯性定位技术领域。
背景技术
基于惯性导航与轴编码器组合的采煤机惯性定位是综采工作面可行的采煤机定位技术。惯性导航是采煤机定位技术的核心设备,其在煤矿井下恶劣环境的长时间定位精度差是阻碍其应用的重要方面。本发明所涉及到的采煤机惯性定位系统已在中国专利《融合地质环境信息的采煤机绝对定位装置与方法》,申请号201310353737.7中公开。
发明内容
为了解决惯性导航在采煤机定位应用中长时间定位精度差的问题,本发明提供了一种融合采煤工艺与采煤机运动模型的采煤机惯性定位精度提升方法,使以惯性导航系统为核心的采煤机定位满足煤矿井下对于采煤机定位精度的要求。
为实现上述目的,本发明采用的技术方案为:
一种融合采煤工艺与采煤机运动模型的采煤机惯性定位精度提升方法,包括以下步骤:
(1)以采煤机几何中心为坐标原点建立采煤机载体坐标系OXbYbZb,采煤机行进方向为Yb轴,垂直于机面高度方向为Zb轴,另一个方向为Xb轴;在采煤机上安装振动速度传感器,用以测量采煤机在Xb轴与Zb轴的振动速度,以采煤机运动模型为约束条件,设计第一滤波器,通过滤波得到平台失准角,利用姿态矩阵之间的关系,得到修正后的姿态,从而得到修正后的采煤机位置;
(2)采煤机完成一次截割后,将刮板输送机的最优估计轨迹传输到液压支架电液控系统,液压支架电液控系统根据采煤工艺确定每个支架推移油缸的推移位移并进行推移,根据刮板输送机最优估计轨迹和推移油缸的位移预测下次截割的刮板输送机轨迹;
(3)以预测的刮板输送机轨迹为约束条件,设计第二滤波器,通过滤波得到下次截割刮板输送机最优估计轨迹,利用采煤机与刮板输送机的约束关系,得到下次截割采煤机的最优估计轨迹;
(4)进行第一滤波器和第二滤波器的融合,以提高采煤机惯性定位精度。
所述步骤(1)中,第一滤波器的量测量为采煤机载体坐标系Xb轴和Zb轴的惯性导航速度输出与振动速度传感器输出的差,状态量为东北天三个方向的平台失准角,状态预测方程由惯性导航姿态误差方程求得。
所述步骤(3)中,第二滤波器的状态量为:从刮板输送机最优估计轨迹中提取出每节刮板输送机几何中心点的位置坐标,以此点位置坐标与所对应推移油缸位移的和作为下次截割此点位置坐标的预测值,经过曲线拟合得到的下次截割刮板输送机预测轨迹作为状态量;量测量为下次截割刮板输送机的检测轨迹。
所述步骤(4)中,先进行第一滤波器处理,后进行第二滤波器处理。
有益效果:本发明提供的采煤机惯性定位精度提升方法,全面地综合了采煤机在综采工作面的独特的运行特点,充分利用了采煤机牵引方向与工作面推进方向的两个约束条件,可在一定程度上解决惯性导航长时间定位精度差的问题,使其满足煤矿井下对于采煤机定位精度的要求,为实现综采工作面智能化奠定了基础。
附图说明
图1为综采工作面示意图;
图2为综采工作面采煤工艺示意图;
图3为振动速度传感器安装示意图;
图4为第一滤波器流程示意图;
图5为惯性导航、轴编码器、振动速度传感器、采煤机惯性定位系统、第一滤波器和第二滤波器安装示意图;
图6为刮板输送机调直示意图;
图7为第二滤波器流程示意图;
图中:1为顶板曲线,2为底板曲线,3为采区,4为采空区,5为采煤机,6为刮板输送机,7为液压支架,8为推溜点,9为振动传感器安装载体,10为垂直型振动速度传感器,11为水平型振动速度传感器,12为惯性导航,13为轴编码器,14为采煤机惯性定位系统,15为第一滤波器,16为第二滤波器,17为液压支架电液控系统。
具体实施方式
下面结合附图对本发明做更进一步的解释。
如图1、图2所示,采煤机5以刮板输送机6为运行轨道,沿煤壁往复运行,切割煤壁落煤,并把落下的煤装入刮板输送机6。刮板输送机6在完成运煤工作的同时,兼作采煤机5的运行轨道,在液压支架7的推动下随工作面的推进整体前移。液压支架7完成采煤机5作业后采空区4顶板支护和控制,维持一定的工作空间,其支护空间由采煤机5截割采空区4空间确定。
如图3、6所示,采煤机5上安装有振动传感器安装载体9、惯性导航12、采煤机惯性定位系统14,振动传感器安装载体9上安装有两个振动速度传感器,分别为垂直型振动速度传感器10、水平型振动速度传感器11。
本发明的一种融合采煤工艺与采煤机运动模型的采煤机惯性定位精度提升方法,包括以下步骤:
(1)以采煤机5几何中心为坐标原点定义采煤机载体坐标系OXbYbZb,采煤机5行进方向为Yb轴,垂直于机面高度方向为Zb轴,另一个方向为Xb轴;根据采煤机运动模型,在采煤机载体坐标系Yb轴存在速度,而Xb轴与Zb轴方向理论速度为零;但采煤机5截割煤壁存在负载波动,造成了采煤机5在Xb轴与Zb轴方向存在一定的振动速度,在采煤机5上安装两个振动速度传感器,分别为垂直型振动速度传感器10、水平型振动速度传感器11,分别测量Xb轴与Zb轴振动速度,如图3。以采煤机运动模型为约束条件,设计第一滤波器15。图4为第一滤波器的流程示意图,量测量为采煤机载体坐标系Xb轴和Zb轴的惯性导航12速度输出与两个振动速度传感器输出的差,状态量为东北天三个方向的平台失准角,状态预测方程由惯性导航姿态误差方程求得。滤波得到平台失准角,利用姿态矩阵之间的关系得到修正后的姿态矩阵,其中为东、北、天向的平台失准角组成的反对称矩阵,E为单位矩阵,为惯性导航输出的姿态角组成的姿态矩阵,为修正后的姿态矩阵。利用姿态角与姿态矩阵之间的关系,如下式,得到修正后的航向角俯仰角θ(t)和横滚角γ(t)。
结合轴编码器输出的速度v(ti),利用航位推算算法,即 其中Pn(ti)=[PN(t)PE(t)PU(t)]T,PN(t)为t时刻北向位置,PE(t)为t时刻东向位置,PU(t)为t时刻天向位置,可得到修正后位置。
(2)采煤机5完成k次截割后,将刮板输送机6的k次截割的最优估计轨迹传输到液压支架电液控系统17,液压支架电液控系统17根据采煤工艺确定每个支架推移油缸的推移位移并进行推移,如图6,根据刮板输送机k次截割最优估计轨迹和推移油缸的位移Ai预测k+1次截割的刮板输送机轨迹。
(3)以预测k+1次截割的刮板输送机轨迹为约束条件,设计第二滤波器16。图7为第二滤波器的流程图,从k次截割刮板输送机最优估计轨迹中提取出每节刮板输送机6几何中心点的位置坐标,以此点位置坐标与所对应推移油缸位移Ai的和作为k+1次截割此点位置坐标的预测值,经过曲线拟合得到的k+1次截割刮板输送机预测轨迹作为状态量。量测量为k+1次截割刮板输送机检测轨迹。滤波得到k+1次截割刮板输送机最优估计轨迹,利用采煤机5与刮板输送机6的约束关系,得到k+1次截割采煤机5的最优估计轨迹。
(4)将第一滤波器和第二滤波器进行融合,优选的方法是先进行第一滤波器15处理,后进行第二滤波器16处理。
以上所述仅是本发明的优选实施方式,应当指出:对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
Claims (4)
1.一种融合采煤工艺与采煤机运动模型的采煤机惯性定位精度提升方法,其特征在于:包括以下步骤:
(1)以采煤机几何中心为坐标原点建立采煤机载体坐标系OXbYbZb,采煤机行进方向为Yb轴,垂直于机面高度方向为Zb轴,另一个方向为Xb轴;在采煤机上安装振动速度传感器,用以测量采煤机在Xb轴与Zb轴的振动速度,以采煤机运动模型为约束条件,设计第一滤波器,通过滤波得到平台失准角,利用姿态矩阵之间的关系 得到修正后的姿态矩阵,其中为东、北、天向的平台失准角组成的反对称矩阵,E为单位矩阵,为惯性导航输出的姿态角组成的姿态矩阵,为修正后的姿态矩阵,从而得到修正后的采煤机位置;
(2)采煤机完成一次截割后,将刮板输送机的最优估计轨迹传输到液压支架电液控系统,液压支架电液控系统根据采煤工艺确定每个支架推移油缸的推移位移并进行推移,根据刮板输送机最优估计轨迹和推移油缸的位移预测下次截割的刮板输送机轨迹;
(3)以预测的刮板输送机轨迹为约束条件,设计第二滤波器,通过滤波得到下次刮板输送机最优估计轨迹,利用采煤机与刮板输送机的约束关系,得到下次采煤机的最优估计轨迹;第二滤波器的状态量为:从刮板输送机最优估计轨迹中提取出每节刮板输送机几何中心点的位置坐标,以此点位置坐标与所对应推移油缸位移的和作为下次截割此点位置坐标的预测值,经过曲线拟合得到的下次刮板输送机预测轨迹作为状态量;量测量为下次刮板输送机的检测轨迹;
(4)进行第一滤波器和第二滤波器的融合,以提高采煤机惯性定位精度。
2.根据权利要求1所述的融合采煤工艺与采煤机运动模型的采煤机惯性定位精度提升方法,其特征在于:所述步骤(1)中,第一滤波器的量测量为采煤机载体坐标系Xb轴和Zb轴的惯性导航速度输出与振动速度传感器输出的差,状态量为东北天三个方向的平台失准角,状态预测方程由惯性导航姿态误差方程求得。
4.根据权利要求1所述的融合采煤工艺与采煤机运动模型的采煤机惯性定位精度提升方法,其特征在于:所述步骤(4)中,先进行第一滤波器处理,后进行第二滤波器处理。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710704725.2A CN107270901B (zh) | 2017-08-17 | 2017-08-17 | 融合采煤工艺与采煤机运动模型的采煤机惯性定位精度提升方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710704725.2A CN107270901B (zh) | 2017-08-17 | 2017-08-17 | 融合采煤工艺与采煤机运动模型的采煤机惯性定位精度提升方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107270901A CN107270901A (zh) | 2017-10-20 |
CN107270901B true CN107270901B (zh) | 2020-02-14 |
Family
ID=60080381
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710704725.2A Active CN107270901B (zh) | 2017-08-17 | 2017-08-17 | 融合采煤工艺与采煤机运动模型的采煤机惯性定位精度提升方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107270901B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108548534A (zh) * | 2018-03-01 | 2018-09-18 | 王宇腾 | 井下采煤机定位方法 |
CN108868772B (zh) * | 2018-04-17 | 2021-11-05 | 伊金霍洛旗德隆矿业有限公司 | 一种连采机快速准直控制方法 |
CN109018851B (zh) * | 2018-08-13 | 2020-06-02 | 太原理工大学 | 刮板输送机三维空间运行姿态位置的实时监测方法 |
CN110319831B (zh) * | 2019-05-23 | 2021-01-01 | 北斗天地股份有限公司山东分公司 | 一种工作面取直方法 |
CN112033401B (zh) * | 2020-09-10 | 2023-06-20 | 西安科技大学 | 基于捷联惯导和油缸的智能掘进机器人定位定向方法 |
CN115540912A (zh) * | 2022-10-28 | 2022-12-30 | 中煤科工集团上海有限公司 | 采煤机惯性导航精度测评系统及其精度测评方法 |
CN116398209B (zh) * | 2023-03-30 | 2023-11-21 | 凡尔智能科技集团有限公司 | 一种基于激光雷达与imu的煤机支架找直方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105371871A (zh) * | 2015-12-02 | 2016-03-02 | 中国矿业大学 | 井下采煤机捷联惯导系统的组合初始对准系统及对准方法 |
CA2973038A1 (en) * | 2015-12-01 | 2017-06-08 | China University Of Mining And Technology | Combined inertial navigation and laser scanning coal shearer positioning device and method |
-
2017
- 2017-08-17 CN CN201710704725.2A patent/CN107270901B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CA2973038A1 (en) * | 2015-12-01 | 2017-06-08 | China University Of Mining And Technology | Combined inertial navigation and laser scanning coal shearer positioning device and method |
CN105371871A (zh) * | 2015-12-02 | 2016-03-02 | 中国矿业大学 | 井下采煤机捷联惯导系统的组合初始对准系统及对准方法 |
Non-Patent Citations (2)
Title |
---|
基于卡尔曼滤波算法的采煤机惯导定位方法;赵靖;《工矿自动化》;20141031;第40卷(第10期);第30-31页 * |
采煤机惯性导航安装偏差对定位误差的影响;郝尚清 等;《煤炭学报》;20150831;第40卷(第8期);第1964-1965页 * |
Also Published As
Publication number | Publication date |
---|---|
CN107270901A (zh) | 2017-10-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107270901B (zh) | 融合采煤工艺与采煤机运动模型的采煤机惯性定位精度提升方法 | |
CN109018851B (zh) | 刮板输送机三维空间运行姿态位置的实时监测方法 | |
EP2446207B1 (en) | Method for determining the position of installation components in mining installations | |
CN111927518B (zh) | 一种基于惯导与里程计组合的综采工作面液压支架自动调直方法 | |
CN101266134B (zh) | 悬臂掘进机头位姿的测量系统及其方法 | |
Hao et al. | A geometry surveying model and instrument of a scraper conveyor in unmanned longwall mining faces | |
AU2018296041A1 (en) | Automatic shearer height adjustment apparatus based on advanced detection of shearer seismic source and method therefor | |
CN101970796B (zh) | 在煤矿开采的刨煤机作业中自动建立确定的工作面开口的方法 | |
CN114120785B (zh) | 一种煤矿掘进设备与地质模型、巷道设计模型的耦合系统 | |
CN109931958B (zh) | 一种基于uwb采煤机工作面端头校准装置及方法 | |
CN202834381U (zh) | 三维双曲线钢顶管纠偏装置 | |
CN104058215A (zh) | 基于采煤机绝对运动轨迹的刮板输送机动态校直方法 | |
CN103335647A (zh) | 一种盾构机姿态测量系统及其测量方法 | |
CN113379909A (zh) | 一种透明工作面智能开采大数据分析决策方法和系统 | |
CN106194181A (zh) | 基于地质数据的智能化工作面煤岩界面识别方法 | |
CN103776463A (zh) | 无人工作面采煤机自动记忆割煤自主定位装置测试方法 | |
CN107701216A (zh) | 一种采煤工作面直线度的控制装置及控制方法 | |
CN106595557A (zh) | 一种刮板输送机直线度的检测装置及检测方法 | |
CN111268393A (zh) | 一种煤流检测用皮带调速控制系统 | |
CN112814676A (zh) | 基于综采工作面煤层三维模型构建的割煤轨迹动态修正方法 | |
WO2018039658A1 (en) | Inertial track measurement system and methods | |
CN113075650A (zh) | 一种基于uwb与惯性单元的地下巷道掘进装备实时定位方法 | |
CN108827220B (zh) | 一种基于捷联惯导的煤矿综采工作面直线度检测方法 | |
CN110424964B (zh) | 一种煤岩界面识别方法 | |
CN106256991A (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 |