Research on shearer positioning experiment based on IMU and UWB at the end of underground coal mining working face
-
摘要:
采煤机自主定位装置的长期精度是采煤工作面智能开采的重要研究内容。针对当前采煤机定位精度难以满足自动开采的需求,建立了基于惯性测量单元(Inertial Measurement Unit, IMU)/超宽带(Ultra-Wideband, UWB)融合定位的模型,提出了采煤工作面端头自主修正补偿惯性导航定位装置的漂移误差,利用IMU/UWB的融合结果对惯性导航定位装置的位置和姿态进行自主纠偏,能实时补偿IMU的偏差,实现采煤机长期高精度自主循环截割。为减小不确定的测量噪声对定位结果的影响,提出了利用变分无迹卡尔曼滤波(Variational Bayesian unscented Kalman filter, VB-UKF)技术对定位结果进行平滑处理,进一步提升融合定位精度,在太原重型机械有限公司开展了地面采煤机融合定位试验和山东能源集团济三工作面端头开展井下采煤机机载试验,验证采煤工作面端头的定位精度。试验结果表明,IMU/UWB融合定位精度高于单纯的UWB解算的精度;经过VB-UKF算法平滑后,井下试验的IMU/UWB融合定位的x轴和z轴方向的平均误差分别从0.102 m和0.194 m降低为0.082 m和0.158 m,平均精度对应的提升了19.6%和18.6%;3个姿态角的误差小于2°,在融合定位模型中利用误差扩展卡尔曼滤波实时补偿修正IMU的偏差,能有效的抑制IMU姿态角的漂移,井下现场试验证明了采煤工作面端头定位方法的有效性,为井下IMU/UWB融合定位的应用提供较好的参考和经验。
Abstract:The long-term precision of shearer independent positioning device is an important research content of intelligent mining. The current shearer positioning accuracy is hard to meet the demands of automatic mining, and we established a fusion positioning model based on IMU/UWB, and proposed autonomous correction to compensate the drift error of inertial navigation device for the coal mine working face by using the fusion results of IMU/UWB to correct the position and posture of inertial positioning system. It can compensate the deviation of IMU in real time, and realize long-term high-precision autonomous cycle cutting of the shearer. To reduce the influence of uncertain measurement noise on the positioning results, we use variational Bayesian unscented Kalman filter (VB-UKF) technique to smooth the positioning results in order to further improve the fusion positioning accuracy. To verify the positioning accuracy of the mining face end, fusion positioning experiments are conducted in Taiyuan Heavy Machinery Co., Ltd on the ground and Shandong Energy Group coal mine working face in the underground, respectively. The experimental results demonstrate that, the accuracy of IMU/UWB fusion positioning is higher than that of the single UWB solution. After smoothing via the VB-UKF algorithm, the error in the x-axis and z-axis orientation of the IMU/UWB fusion localization for underground experiments decreased from 0.0102 m and 0.194 m to 0.082 m and 0.158 m, respectively, and the corresponding average accuracy improved by 19.6% and 18.6%. The error of the three pose angles is less than 2°, because the error extended Kalman filter compensates and modifies the IMU bias in the fusion localization model, which can effectively suppress the drift of the IMU posture angle. The underground field experiment proves the effectiveness of the positioning method of coal mining face end, which provides better reference and experience for the further application in underground coalmine by using IMU/UWB fusion positioning.
-
Keywords:
- shearer /
- coal mining working face /
- end positioning /
- Ultra-Wideband /
- IMU
-
0. 引 言
锚杆支护因具有高效安全且经济效益良好的特点被广泛应用于诸多工程,但同时由于锚杆施工的复杂性与隐蔽性通常会造成锚杆有效长度不够和锚固质量差等问题。传统的检测方法因具有破坏性及偶然性而逐渐被淘汰,新兴的锚杆无损检测法以其无损、高效、快速的特点越来越成为锚杆锚固质量检测的主要方法[1–3]。
在激发波为低频导波条件下,多位学者对锚杆锚固质量的评价进行了研究。汪明武等[4]、ZOU等[5]通过室内与现场试验证明应力波可对锚杆锚固长度进行检测,李义等[3,6]、CUI等[7]、YU等[8]分别提出可粗评锚固质量与锚固力的参数以及可评价锚杆注浆率的指标。吴斌[9–10]、何存富等[11–12]用人工设置缺陷的方法对自由钢杆及弯管进行室内试验,结果表明所选频率可以对缺陷进行较为准确的定位。同时,相关数值模拟结果与试验结果均较为贴合,能够对锚杆所设置缺陷[9,12–13]进行定位。
上述试验及模拟选取的激发波均为低频导波,然而现有研究表明,在现场试验中低频导波由于衰减严重导致底端反射不易识别甚至接收不到底端回波[14–15],因此基于低频导波进行的室内试验及数值模拟就失去了一定的指导意义。基于此也有许多学者将研究方向转向高频导波传播特性的研究。
何存富等[16]、吴斌等[17]对1 MHz以上高频导波的研究表明确实存在衰减小传播距离远的高频纵向导波可以用来进行锚杆锚固长度与缺陷位置的检测。余海军等[18–19]将高频导波应用于现场管道质量检测,证明高频导波在现场检测中的可靠性。本课题组学者[20–23]也利用不同范围内高频导波对锚杆有效长度和锚固质量与波形关系进行了探究。但高频导波的相关数值模拟仍鲜有报道,曾杰等[24]采用波结构加载的方法尝试激发单一模态的高频导波,但模拟结果并不理想。张玥等[25]实现了高频导波在自由钢杆中的数值模拟,为高频导波在锚固锚杆中传播特性的研究提供了思路。
高频导波数值模拟难以实现主要有以下几点原因:首先,随着导波频率升高,其模态更加复杂,难以激发单一模态导波,同时由于其频散性,对于接收到的波形图很难确定目标模态。其次,现场检测模型为无限大锚固体,在数值模拟有限锚固厚度的条件下如何得到能够应用于现场检测的规律也十分重要;此外,高频导波波长更短,为满足计算精度要求需设置更加细密的单元网格,因此需要解决庞大计算量的问题。
笔者采用ANSYS/LS–DYNA有限元软件进行数值模拟。以全长黏结型锚固锚杆为研究对象,选取高频纵向模态导波为激发波,通过对不同锚固厚度及单元网格密度的研究实现了高频导波在锚固锚杆中传播的准确模拟。并对不同首波宽度下波形进行分析,得到较为合适的激发波宽度。基于此建立带缺陷锚固锚杆数值模型,分别对不同缺陷位置及缺陷深度下高频导波传播特性进行了研究,找到一种采用高频导波检测锚杆锚固质量的方法。
1. 高频导波数值模型的建立
1.1 激发波频率的确定
锚固锚杆在理论计算中可视为锚杆、锚固介质与无限大真空组成的3层介质模型[26],如图1所示。依据其材料参数、几何参数以及边界上力与位移条件可对频散方程进行求解。试验所选模型的材料参数见表1。不同的激发波频率在波导结构中传播速度及衰减特性均不同,因此需要依托求解所得频散曲线指导试验选取低衰减传播远的高频导波。
表 1 材料参数Table 1. Parameters of materials材料 泊松比μ 密度ρ
/(kg·m−3)弹性模量E/GPa 纵波衰减$ {\eta }_{{\rm{L}}} $/(Np·wl−1) 横波衰减$ {\eta }_{{\rm{T}}} $/(Np·wl−1) 钢杆 0.30 7 930 210 0.003 0.008 水泥 0.20 1 600 20 0.043 0.100 图2为长度1 m,直径22 mm的锚固锚杆结构求解所得衰减频散曲线与能量速度频散曲线[17]。由图2a可得在锚固体无限大的条件下,低频范围内导波衰减严重,这也是现场试验用低频导波进行检测时很难接收到底端回波的原因。而在高频范围内(大于1 MHz)确实存在衰减值在20 dB/m以下(图中虚线所示)能够传播较远距离的导波。同时图2a衰减频散曲线上的衰减极小值点所对应的模态(如图中A点所示)也是图2b速度频散曲线上传播速度最快的模态(图中B点所示)。因此目标模态导波能够最先到达锚杆顶端,这就有利于目标波包的识别,进行信号的有效提取。同时在进行数值模拟时为模型设置材料阻尼,能够削弱非目标模态波包传播能力,使得所接收到目标模态波包更为清晰。结合这两种方法,就能够解决高频导波难以确定目标模态的难点。
试验激发波依据图2a衰减频散曲线选取频率为1.541 MHz的高频导波,其衰减值为15.23 dB/m,能够在锚固锚杆中传播较远距离。
1.2 锚固厚度的确定
数值模型的建立需要与现场试验模型尽可能一致。锚杆与锚固体在分界面处应力与位移均连续,故数值模型采用共节点的连接方式进行建模。现场试验锚固锚杆通常为无限锚固厚度,而室内试验与数值模拟受条件限制并不能建立无限锚固厚度模型,那么在有限锚固厚度条件下所得到的相关结论是否同样适用于无限锚固厚度模型就有待商榷,因此,需要进行锚固厚度对高频导波在锚固锚杆中传播波形影响的研究。
建立锚杆长度为1 m,直径22 mm,锚固体外径分别为0.1、0.2和0.4 m的数值模型。选取首波宽度为0.04 ms的1.541 MHz导波作为激发波,图3为锚固体不同外径波形图,波包1为侧面回波,波包2为底端回波。
观察图3a,当锚固体外径为0.1 m时,侧面回波明显,且接收到底端回波频散严重,波包宽度从0.04 ms增加到了0.1 ms,波包幅值为0.204,计算所得导波传播速度为5 376 m/s。底端回波频散严重的原因为锚固体外径尺寸较小,使得侧面回波与沿锚杆轴向传播波包相叠加,造成波包的拉长现象。锚固体外径为0.2 m和0.4 m时接收到底端回波的波包宽度均为0.05 ms,排除导波传播的正常频散,可以认为所接收到底端回波是完整的。两者计算所得导波传播速度均为5 333 m/s,波包幅值分别为0.219与0.223,相差很小。由图2b可得1.541 MHz导波传播速度为5 316 m/s,无论从波包完整性还是传播速度吻合程度来看0.2 m与0.4 m的锚固体外径都与实际更为契合。在能得到同样精度结果的条件下,外径厚度为0.2 m与0.4 m的模型单元数目分别为210 万与340 万,计算时长分别为14 h与40 h,因此在模拟过程中选择0.2 m的外径尺寸,能够满足模拟精度要求,与导波在现场传播速度贴合,同时大大节约计算资源。
1.3 网格密度的确定
文中主要对导波的纵向模态高频范围进行研究,模拟中采用的都是大于1 MHz的高频导波,其波长较短,前人研究所得一个波长内8~20个单元数目的网格密度不能满足模拟要求[27–28],为保证可以接收到清晰的缺陷回波与底端回波,就需要采取更加细密的网格划分,如同样尺寸的锚固锚杆模型,在激发波为低频导波条件下只需要几千个单元就可满足计算精度,但激发波为高频导波时,则需要百万甚至千万个单元数目,这就使得计算量十分庞大,求解耗时良久。
为实现高频导波的数值计算,采用以下几种方法对其进行简化。首先,由于模型与加载均有对称性,故采用二维轴对称建模代替三维建模,保证数值计算结果可靠性的同时显著减少了计算量;其次,选择较小的首波宽度,在保证波包能量足够的条件下尽量减少其激发时间,节约计算成本;此外,对锚杆径向、锚固体径向和杆体轴向设置不同的网格密度。在1.541 MHz的激发波频率下不同单元网格密度的波形图如图4所示,其中如120–15–20–15含义为在锚杆径向网格密度设置为一个波长内120个单元,锚固体径向一个波长内20个单元,锚固锚杆轴向一个波长内15个单元。
首先,对锚杆径向、锚固体径向及杆体轴向均设置一个波长内15个单元的网格密度,其波形图如图4a所示,由图中难以观察到明显的底端回波,因此将网格进一步加密,各方向网格密度均设置为一个波长内30个单元,此时的网格数目已达到600多万,但观察图4b依然不能接收到清晰有效的底端回波,只有0.1 ms处的侧面回波波形明显。若再继续加大网格密度,会使得计算量成倍增加难以运行。在此前研究中,有学者提出对于自由钢杆,在以高频导波为激发波时,锚杆需设置一个波长内60个单元的网格密度才能接收到清晰的底端回波[25]。因此将钢杆径向网格密度适当增加,图4c为网格设置为60–20–20–20时顶端波形图。尽管此时锚杆端头不能接收到有效底端回波,但在锚杆底端已能接收到较为完整波形,如图4d所示,说明所选网格变化的趋势是正确的。考虑到导波在锚固锚杆中传播时主要沿着钢杆内部向前传播,有少量能量经透射进入锚固体内部继续传播,因此锚固体径向单元网格密度设置不需太过细密。同时数值模型采用的是沿轴向加载所激发的纵向模态导波进行研究,因此锚杆径向尺寸相较于轴向尺寸对模拟结果影响更大。故而在数值模型进行网格划分时可以将锚杆径向单元网格设置较密,而锚固体径向与杆体轴向设置相对疏松。经多次模拟调试,单元网格密度设置为120–15–20–15时可以满足高频导波在锚固锚杆中传播的模拟精度,其波形图如图4e所示。
单元网格密度为120–15–20–15时其单元数目与60–20–20–20设置相当,同时是网格密度为30–30–30–30时的一半,但相较于后两者,其较少的单元网格数目反而能够接收到清晰有效的底端回波。说明所采取的对锚杆径向、锚固体径向及杆体轴向设置不同网格密度的简化方法是有效且正确的,解决了高频导波数值模拟计算量庞大难以实现的难点,真正实现了在有限计算资源下高频导波在锚固锚杆中传播的数值模拟。
1.4 模型正确性验证
建立数值模型,与文献[17]中的实验室模型进行比对。模型为1 m长的完整锚固锚杆,锚杆直径为0.02 m,锚固体外径为0.2 m,其数值模型图如图5所示。试验所选激发波频率为1.541 MHz,以力的方式加载于锚杆端头全部节点;模型网格密度设置为120–15–20–15。激励信号具体加载位置及网格密度设置情况也在图中标示出。
激发波频率为1.541 MHz时数值模拟计算结果与实验室结果分别如图6a,b所示。因群速度匹配是模型正确的基础,故将数值计算结果与实验室结果由群速度计算所得杆长进行比对,以此来验证模型正确性。
两图比对可得,数值模拟结果与实验室结果基本吻合,均在0.4 ms左右接收到清晰的端头回波。由图2b能量速度频散曲线得到激发波为1.541 MHz时,所对应高阶模态的能量速度为5 316 m/s,由图6a读取接收到底端回波的准确时间为0.395 ms,激发波峰值为0.02 ms,将底端回波与激发波峰值之差作为传播时间,由数值模拟结果计算可得杆长为0.997 m,与实际杆长误差仅为0.3%。因此可验证所建立的数值模型能够实现高频导波在锚固锚杆中传播的准确模拟。
2. 首波宽度对高频导波传播影响
2.1 首波宽度及其频率带宽
无论是室内试验或是现场探测中,都不可能激发理想的单一频率的导波,导波都是以一定的频率带宽向前传播[20]。然而不同频率导波在波导结构中对应不同传播速度,这就导致所接收到波包由于导波的频散特性会出现形状拉长,能量不够集中的现象。因此激发波的首波带宽对波形起着决定性的作用。图7为1.541 MHz的激发波在0.2 ms,0.04 ms和0.02 ms首波宽度下的时谱图及经过FFT变换后的归一化频谱图。
由图中可以看到首波宽度为0.2 ms时频率带宽为0.035 MHz,首波宽度为0.04 ms与0.02 ms时频率带宽分别为0.07 MHz和0.2 MHz,可见不同的首波宽度确实对频率带宽有显著影响,导波频散特性随频率带宽的增加而表现明显,为获得清晰有效的回波,有必要探究其在锚固锚杆中不同的传播特性。
2.2 不同首波宽度在完整锚固锚杆中传播情况
建立长度为0.5 m的锚固锚杆的数值模型,材料参数同表1。不同首波宽度对应的波形图分别如图8所示。由图中可明显看到,各首波宽度下波形图均可接收到两个明显的底端回波,其中波包1为第1次底端回波,波包2为第2次底端回波。当激发波宽度为0.2 ms时,波包拉长现象较严重,两波包未分离;激发波宽度为0.02 ms时,波包频散较为严重,所接收到底端回波不够完整;激发波宽度为0.04 ms时,所接收到底端回波相对独立且清晰完整,中间的小波包为侧面回波,对底端回波不造成影响,满足模拟所需精度要求,且相较于0.2 ms的激发波宽度可大大节约计算时间。
2.3 不同首波宽度在带缺陷锚固锚杆中传播情况
对于完整锚固锚杆,较宽或较窄的首波宽度均能接收到清晰的底端回波。但对于带缺陷的锚固锚杆,首波宽度的选择对波形影响更为关键。建立长度为0.5 m的锚固锚杆,在距离端头0.35 m处设置一深度为2 mm,宽度为4 mm的缺陷,激发波频率选为1.541 MHz,不同首波宽度下波形图如图9所示。
观察图9可知首波宽度为0.2 ms时带缺陷的锚固锚杆波形图可观察到2个波包,分别为1次与2次底端回波。由于缺陷回波与底端回波的叠加使得波包1幅值有相应增加,但两波包融合在一起使得缺陷位置不能识别。首波宽度为0.02 ms时也可观察到2个明显波包,波包1为缺陷回波,波包2为底端回波,但较大的频率带宽使得小波包有分离现象,在选点时易引起误差。但0.04 ms的首波宽度则可接收到清晰完整的缺陷回波与底端回波。
综上,首波宽度过大容易造成波形叠加难以区分且计算时间长的问题,但首波宽度过小也会使得频散严重,波形难以识别。因此,选取一个合适的激发波宽度十分重要。在经过多次数值模拟调试后,发现0.04 ms的首波宽度可以基本满足模拟要求,波形清晰且波包有足够的能量向前传播。本文后续模拟均采用0.04 ms的首波宽度。
3. 高频导波在带钢筋腐蚀缺陷锚固锚杆中传播的数值模拟
3.1 数值模型建立及正确性验证
采用文献[17]中的实验室模型与数值模拟结果比对验证带缺陷锚固锚杆模型的正确性。实验室模型是钢杆直径为22 mm,长度为1 m的锚固锚杆,在距离钢杆端头0.75 m处设置一个缺陷,材料参数同表1。激发波频率为2.43 MHz的高频导波,所得波形图如图10a所示。
建立带缺陷锚固锚杆数值模型,模型加载方式、网格划分、首波宽度等设置与前文保持一致。带缺陷锚固锚杆数值模型及缺陷处网格划分如图11所示。
因在数值模型正确的条件下,不同频率下高频导波均可进行数值计算,只存在波形接收效果优劣的区别。为与实验室结果进行比对,数值模拟激发波频率与实验室频率保持一致为2.43 MHz。同时数值模型的尺寸及材料参数设置也均与实验室模型保持一致,模拟结果如图10b所示。
由图2b能量速度频散曲线得到激发波为2.43 MHz时,所对应高阶模态的能量速度为5 503 m/s。实验室激发波采用0.02 ms的激发波宽度,接收到缺陷回波的时间约为0.275 ms,数值模拟激发波采用0.04 ms的激发波宽度,接收到缺陷回波时间为0.284 ms,按激发波峰值与缺陷回波峰值的时间差作为传播时间,计算所得各自的缺陷位置及相应误差见表2。同时数值模拟与实验室底端回波时间及计算所得杆长和误差也在表中列出。
表 2 激发波为2.43 MHz时带缺陷锚固锚杆数值模拟结果与实验室结果Table 2. Numerical simulation results and laboratory results of anchor bolts with defects when the excitation wave is 2.43 MHz类别 缺陷回波时间/ms 计算得缺陷位置/m 缺陷位置误差/% 端头回波时间/ms 计算得杆长/m 杆长误差/% 数值模拟结果 0.284 0.726 3.2 0.373 0.971 2.9 实验室结果 0.275 0.729 2.8 0.381 1.021 2.1 由表2可得,数值模拟所得缺陷位置和杆长的误差分别为3.2%和2.9%。模拟结果与实验室结果相差很小,说明所建立的数值模型可以较好贴合实验,为进一步研究导波在含锚固体缺陷、杆体脱锚等情况的锚固锚杆中的传播特性奠定基础。
3.2 不同缺陷位置对波形的影响
基于上文数值模型的正确性,进一步研究不同缺陷位置对波形的影响。材料参数与表1保持一致,缺陷位置分别设置在距离锚杆端头0.1、0.3、0.5、0.7 和0.9 m的位置,不同缺陷位置的波形图如图12所示。
缺陷回波与底端回波的波包位置已在图中标示出,在0.12 ms处的小波包为侧面反射回波,为验证该猜想,其他条件保持不变,只增加锚固体厚度重新进行建模计算,模拟结果只有该处小波包后移,由此可证明该波包确为侧面回波。尽管不同位置的缺陷回波幅值差异较大,底端回波的幅值及接收时间却几乎一样。这是因为缺陷的大小设置均相同,因此底端接收到的能量差异不大,幅值大小就几乎没有差别。由数值模拟计算所得缺陷位置与相应误差见表3。
表 3 激发波为1.541 MHz时不同缺陷位置数值模拟结果Table 3. Numerical simulation results of different defect positions when the excitation wave is 1.541 MHz缺陷距端头位置/m 缺陷回波时间/ms 计算得缺陷位置/m 缺陷位置误差/% 端头回波时间/ms 计算得杆长/m 杆长误差/% 0.1 0.059 0.104 3.66 0.400 1.010 1.00 0.3 0.136 0.308 2.78 0.400 1.010 1.00 0.5 0.212 0.510 2.07 0.400 1.010 1.00 0.7 0.287 0.710 1.38 0.400 1.010 1.00 0.9 0.362 0.906 1.00 0.400 1.010 1.00 由表3可得,缺陷位置的误差都在4%之内,由图11可知当缺陷位置过于接近端头时,边界回波和底端回波会与缺陷回波叠加使得波形难以识别。但在首波宽度为0.04 ms的条件下,分别距离锚杆首尾0.1 m的缺陷也可检测出来,说明所建立的数值模型可以对锚杆大部分长度范围内缺陷进行较为准确的定位。
3.3 不同缺陷深度对波形的影响
通过在锚固锚杆的内嵌钢筋上设置不同深度的环状缺陷,来研究缺陷深度对于波形的影响。在钢筋距离锚杆端头0.75 m处分别设置深度为1、2、3、4和5 mm,轴向长度为4 mm的缺陷。材料参数与表1保持一致,激发波频率仍选为1.541 MHz,得到波形图如图13所示。由图中可以看到清晰的4个波包,其中波包1为激发波经两次侧面反射接收到的回波,波包2为缺陷回波,波包3为底端回波,波包4为激发波经底端反射先到达缺陷位置再反射回底端再传播到端头的波包。
由图可知,随着缺陷深度的增加,即缺陷面积占锚杆横截面积比例的增加,缺陷回波的幅值随之显著增加,而底端回波的幅值随之显著减小。当缺陷深度为3 mm,即缺陷面积约占锚杆横截面积一半时,如图13c所示,缺陷回波幅值与底端回波幅值相当。同时可以看到无论缺陷深度如何变化,排除人工取点的误差,在锚杆端头接收到缺陷回波和底端回波的时间并没有变化,分别为0.305 ms和0.400 ms,计算可得对应缺陷位置在0.757 m处,杆长为1.01 m。也就是说,缺陷的尺寸不会影响高频导波对缺陷的定位,缺陷深度只会对波包幅值产生影响。
4. 结 论
1)数值模拟结果表明锚杆径向、轴向及锚固体径向、轴向单元网格密度对高频导波波包影响程度不同,其中锚杆径向单元网格密度对波形影响最大,设置需最密。通过对锚固锚杆设置不同单元网格密度能够实现高频导波在锚固锚杆中传播的准确数值模拟。
2)激发波为高频导波时首波宽度的选择对数值计算十分重要,设置合适的首波宽度能够在实现锚固锚杆缺陷定位的同时显著节约计算成本。经多次模拟调试后发现0.04 ms的首波宽度能够满足高频导波的数值计算精度。
3)所建立的带缺陷锚固锚杆的数值模型模拟结果与实验室结果高度吻合,说明特定高频导波的低衰减性确实可以用来进行锚固锚杆缺陷位置的检测。
4)随着锚杆缺陷面积增加,缺陷回波幅值相应增加,同时底端回波幅值相应减小,但缺陷面积的大小不会影响高频导波对缺陷的定位以及杆长的计算。
5)高频导波可对缺陷位置进行较准确定位,对缺陷面积进行估算,解决了低频导波不能接收到有效底端回波的问题,弥补了试验与数值模拟结合的空缺,为之后高频导波在含锚固体缺陷、杆体脱锚等情况的锚固锚杆中传播特性的研究奠定基础。
-
表 1 IMU传感器的主要参数指标
Table 1 Main parameters of IMU sensor
部件 最大量程 最大输出频率/Hz 陀螺仪 ±2000(°)/s 200 加速度计 ±16 g 200 地磁计 800 mG 200 角度 ±180°/ ±90° 200 表 2 UWB模块的主要参数指标
Table 2 Main parameters of UWB module
功率/μW 电压/V 频率/GHz 中心频率/GHz 刷新率/Hz 50 5 3.1~ 4.8 4.3 125 表 3 4个UWB基站的位置坐标
Table 3 Position coordinates of four UWB base stations
基站编号 x/m y/m z/m 基站1 1.112 0.471 1.375 基站2 0.442 1.483 1.556 基站3 1.925 1.551 1.913 基站4 1.073 0.542 2.532 表 4 地面采煤机定位的x轴和z轴方向定位误差统计
Table 4 Localization error statistics on x- and z-axis direction for results of ground shearer positioning
解算方法 误差/m 最大 平均 标准差 UWB单独解算 x: 0.215
z: 0.311x: 0.062
z: 0.089x: 0.045
z: 0.066VB-UKF平滑UWB结果 x: 0.162
z: 0.236x: 0.049
z: 0.067x: 0.036
z: 0.046IMU/UWB融合解算 x: 0.143
z: 0.269x: 0.036
z: 0.057x: 0.025
z: 0.041VB-UKF平滑IMU/UWB融合结果 x: 0.076
z: 0.114x: 0.022
z: 0.038x: 0.016
z: 0.024表 5 井下现场试验4个UWB基站的坐标
Table 5 Position coordinates of four UWB base stations in the underground field experiment
基站编号 x/m y/m z/m 1 1.251 3.352 −0.251 2 0 0 0 3 −0.110 2.375 0.311 4 −1.223 2.758 0.349 -
[1] 葛世荣,郝雪弟,田 凯,等. 采煤机自主导航截割原理及关键技术[J]. 煤炭学报,2021,46(3):774−788. doi: 10.13225/j.cnki.jccs.yt21.0114 GE Shirong,HAO Xuedi,TIAN Kai,et al. Principle and key technology of autonomous navigation cutting for deep coal seam[J]. Journal of China Coal Society,2021,46(3):774−788. doi: 10.13225/j.cnki.jccs.yt21.0114
[2] 王世博,葛世荣,王世佳,等. 长壁综采工作面无人自主开采发展路径与挑战[J]. 煤炭科学技术,2022,50(2):231−243. doi: 10.13199/j.cnki.cst.2020-1150 WANG Shibo,GE Shirong,WANG Shijia,et al. Development and challenge of unmanned autonomous longwall fully-mechanized coal mining face[J]. Coal Science and Technology,2022,50(2):231−243. doi: 10.13199/j.cnki.cst.2020-1150
[3] 鲁 程,王世博,葛世荣,等. 多惯导冗余的采煤机定位原理及其合理性分析[J]. 煤炭学报,2019,44(S2):746−753. doi: 10.13225/j.cnki.jccs.2019.0491 LU Cheng,WANG Shibo,GE Shirong,et al. Redundant multi-INS positioning algorithm of shearer and analysis of its rationality[J]. Journal of China Coal Society,2019,44(S2):746−753. doi: 10.13225/j.cnki.jccs.2019.0491
[4] SCHIFFBAUERW H. Navigation and control of continuous mining systems for coal mining[C]. IEEE Industry Applications Conference Thirty-First IAS Annual Meeting. 1996, 4: 2473-2479.
[5] SCHIFFBAUER W H. Accurate navigation and control of continuous mining machines for coal mining [J]. U. S. Dept of health and human services, 1997.
[6] REID P B, DUNN M T, REID D C, et al. Real-world automation: New capabilities for underground longwall mining[A]. Proceedings of the 2010 Australasian Conference on Robotics and Automation 2010 [C]. Brisbane: Queensland University Fechnology, 2010.
[7] RALSTON J C,REID D C,DUNN M T,et al. Longwall automation: Delivering enabling technology to achieve safer and more productive underground mining[J]. International Journal of Mining Science and Technology,2015,25(6):865−876. doi: 10.1016/j.ijmst.2015.09.001
[8] 方新秋,何 杰,张 斌,等. 无人工作面采煤机自主定位系统[J]. 西安科技大学学报,2008,28(2):349−353. doi: 10.3969/j.issn.1672-9315.2008.02.033 FANG Xinqiu,HE Jie,ZHANG Bin,et al. Self-positioning system of the shearer in unmanned workface[J]. Journal of Xi’an University of Science and Technology,2008,28(2):349−353. doi: 10.3969/j.issn.1672-9315.2008.02.033
[9] FAN Qigao,LI Wei,LUO Chengming. Error analysis and reduction for shearer positioning using the strapdown inertial navigation system[J]. International Journal of Computer Science Issues,2012,9(1):49−54.
[10] 张博渊,王世博,葛世荣. 惯性导航初始对准偏差与安装偏差对采煤机定位精度影响及其校准方法[J]. 煤炭学报,2017,42(3):789−795. ZHANG Boyuan,WANG Shibo,GE Shirong. Effects of initial alignment error and installation noncoincidence on the shearer positioning accuracy and calibration method[J]. Journal of China Coal Society,2017,42(3):789−795.
[11] 郝尚清,李 昂,王世博,等. 采煤机惯性导航安装偏差对定位误差的影响[J]. 煤炭学报,2015,40(8):1963−1968. doi: 10.13225/j.cnki.jccs.2014.1561 HAO Shangqing,LI Ang,WANG Shibo,et al. Effects of shearer inertial navigation installation noncoincidence on shearer positioning error[J]. Journal of China Coal Society,2015,40(8):1963−1968. doi: 10.13225/j.cnki.jccs.2014.1561
[12] HOL J D, DIJKSTRA F, LUINGE H, et al. Tightly coupled UWB/IMU pose estimation[C]. IEEE International Conference on Ultra-wideband, 2009: 688−692.
[13] WEN Kai,YU Kegen,LI Yingbing,et al. A new quaternion Kalman filter based foot-mounted IMU and UWB tightly-coupled method for indoor pedestrian navigation[J]. IEEE Transactions on Vehicular Technology,2020,69(4):4340−4352. doi: 10.1109/TVT.2020.2974667
[14] MIRAGLIA G, MALEKI K N, HOOK L R. Comparison of two sensor data fusion methods in a tightly coupled UWB/IMU 3-D localization system[C]//International Conference on Engineering, Technology and Innovation, 2017: 611-618.
[15] WANG Yan,LI Xin. An improved robust EKF algorithm based on sigma points for UWB and foot-mounted IMU fusion positioning[J]. Journal of Spatial Science,2021,66(2):329−350. doi: 10.1080/14498596.2019.1632754
[16] 张斌飞,靳伍银. 基于UWB和IMU紧组合的室内定位导航算法[J]. 电子测量技术,2022,45(10):67−73. ZHANG Bingfei,JIN Wuyin. Indoor positioning and navigation algorithm based on UWB and IMU tightly coupled[J]. Electronic measurement technology,2022,45(10):67−73.
[17] 朱建斌,赵健康,崔 超,等. 基于EKF的UWB/IMU组合导航系统鲁棒性设计[J]. 计算机仿真,2020,37(12):47−52. doi: 10.3969/j.issn.1006-9348.2020.12.011 ZHU Jianbing,ZHAO Jiankang,CUI Chao,et al. Robustness Design of UWB/IMU Tightly Integrated Navigation and Positioning System Based on EKF[J]. Computer simulation,2020,37(12):47−52. doi: 10.3969/j.issn.1006-9348.2020.12.011
[18] 匡 兵,陈凤冉,田春月,等. 基于改进粒子滤波的超宽带与惯性测量单元融合定位算法[J]. 科学技术与工程,2020,20(30):12460−12466. doi: 10.3969/j.issn.1671-1815.2020.30.029 KUANG Bing,CHEN Fengran,TIAN Chunyue,et al. Unit fusion positioning algorithm of ultra-wideband and inertial measurement based on improved particle filtering[J]. Science Technology and Engineering,2020,20(30):12460−12466. doi: 10.3969/j.issn.1671-1815.2020.30.029
[19] 王春琦,孔祥琦,丁晓欢,等. 基于无迹卡尔曼滤波的IMU和UWB融合定位算法研究[J]. 南昌航空大学学报,2020,34(3):8−17. WANG Chunqi,KONG Xiangqi,DING Xiaohuan,et al. Unscented kalman filter based IMU and UWB fusion position algorithm[J]. Journal of Nanchang Hang Kong University,2020,34(3):8−17.
[20] YANG Hai, LUO Tao, LI Wei, et al. A stable SINS/UWB integrated positioning method of shearer based on the multimodel intelligent switching algorithm [J]. IEEE Access, 2019, 7: 2912829138.
[21] CUI Yuming,LIU Songyong,YAO Jian,et al. Integrated positioning system of unmanned automatic vehicle in coal mines[J]. IEEE Transactions on Instrumentation and Measurement,2021,70:1−13.
[22] LI Menggang,ZHU Hua,YOU Shaoze,et al. UWB-based localization system aided with inertial sensor for underground coal mine applications[J]. IEEE Sensors Journal,2020,20(12):6652−6669. doi: 10.1109/JSEN.2020.2976097
[23] FAN Qigao,LI Wei,JING Hui,et al. Integrated positioning for coal mining machinery in enclosed underground mine based on SINS/WSN[J]. The Scientific World Journal,2014(1):460415.
[24] SONG Yang,HSU Lita. Tightly coupled integrated navigation system via factor graph for UAV indoor localization[J]. Aerospace Science and Technology,2021,108:106370. doi: 10.1016/j.ast.2020.106370
[25] 许晓伟,赖际舟,吕 品,等. 基于采煤机工作面端头量测的改进因子图高精度自主定位方法研究[J]. 控制与决策,2022,37(8):2170−2176. XU Xiaowei,LAI Jizhou,LYU Pin,et al. Research on the highprecision autonomous positioning method based on the improved factor graph of the measurements at both ends of shearer working face[J]. Control and Decision,2022,37(8):2170−2176.
[26] LIU Fei,LI Xin,WANG Jian,et al. An adaptive UWB/MEMS-IMU complementary kalman filter for indoor location in NLOS environment[J]. Remote Sensing,2019,11(22):2628. doi: 10.3390/rs11222628
[27] SHI Qin,ZHAO Sihao,CUI Xiaowei,et al. Anchor self-localization algorithm based on UWB ranging and inertial measurements[J]. Tsinghua Science and Technology,2019,24(6):728−737. doi: 10.26599/TST.2018.9010102
[28] 曹 波,王世博,葛世荣,等. 基于校准补偿和VBUKF平滑的超宽带采煤机定位技术[J]. 煤炭科学技术,2022,50(8):210−219. CAO Bo,WANG Shibo,GE Shirong,et al. Localization technology of ultra-wideband for shearer based on calibration compensation and VBUKF smoothing[J]. Coal Science and Technology,2022,50(8):210−219.
[29] 葛世荣, 王世佳, 曹 波, 等. 智能采运机组自主定位原理与技术[J]. 煤炭学报, 2022, 47(1): 75-86. GE Shirong, WANG Shijia, CAO Bo, et al. Autonomous positioning principle and technology of intelligent shearer and conveyor [J], Journal of China Coal Society, 2022, 47(1): 75-86.
-
期刊类型引用(8)
1. 汪洋,黄延明,张希,胡晓雪,葛政廷,肖飞,吴雨风. 鄂尔多斯盆地郝滩地区延安组延8—延10储集砂岩特征及孔隙演化. 河南科学. 2024(01): 79-88 . 百度学术
2. 黄延明,汪洋,胡晓雪,张博,葛政廷,吴頔,陈峻,肖飞,吴雨风. 鄂尔多斯盆地郝滩地区延安组延8—延10油藏富集规律. 能源与环保. 2024(04): 76-83+92 . 百度学术
3. 王二利,霍高普,李振林,边佳新. 榆神矿区隆德煤矿侏罗系岩层微观孔隙结构及分形特征研究. 中国煤炭地质. 2024(05): 13-20 . 百度学术
4. 梁凤鸣,汪妍静,罗腾文,高路遥,吴雨风. 鄂尔多斯盆地靖边JT430井区延9储集砂岩非均质性特征研究. 河南科技. 2024(09): 101-104 . 百度学术
5. 邓启锐,高建峰,刘飞,徐士哲,许珂,王杰,南忠辉. 基于不完整井非稳定运动的立井井筒涌水量预测研究. 煤炭工程. 2024(08): 172-176 . 百度学术
6. 王旭,尹尚先,曹敏,夏向学,刘德旺,张金福,吴传实,李启兴,王浩瑞,陆睿. 基于FHH分形理论的隆德煤矿砂岩微观孔隙研究. 煤矿安全. 2024(10): 179-189 . 百度学术
7. 谢昊天,徐颖,郑强强,于美鲁,谢守冬,李成杰. 冻融循环作用下饱水砂岩强度衰减及细观结构特征. 煤炭科学技术. 2024(12): 84-93 . 本站查看
8. 周对对,龙良良,刘家鹏,何静,汪庆国,罗旭东. 大佛寺井田洛河组含水层微观孔隙结构及富水性研究. 中国煤炭. 2023(09): 43-50 . 百度学术
其他类型引用(2)