一种利用UWB技术构建煤矿井下巷道测量控制网的方法及系统与流程

摘要: 本发明公开了一种利用uwb技术构建煤矿井下巷道测量控制网的方法及系统,属于煤矿井下测量、矿山智能化、无线定位、地质测绘和采掘巷道进尺自动化测量。术语解释在理解本...
一种利用UWB技术构建煤矿井下巷道测量控制网的方法及系统与流程

本发明公开了一种利用uwb技术构建煤矿井下巷道测量控制网的方法及系统,属于煤矿井下测量、矿山智能化、无线定位、地质测绘和采掘巷道进尺自动化测量。术语解释在理解本发明技术方案之前,首先对本发明中涉及的关键术语进行如下定义和说明:uwb:ultra-wideband,超宽带无线通信技术,是一种利用纳秒级窄脉冲或宽频带信号实现高精度测距、定位和通信的无线技术;井下巷道测量控制网:在煤矿井下巷道内布设的、用于提供空间基准、坐标约束和测量传递关系的控制网络;基准站:布设于巷道内已知或经平差确定坐标位置的uwb固定测量节点;流动站:可移动的uwb测量节点,可为手持端、车载端或安装于掘进装备上的移动端,用于采集与基准站之间的测距数据并解算空间坐标;ds-twr:double-sided two-way ranging,双边双向测距方法,通过多次往返通信削弱设备时钟不同步对测距结果的影响;tof:time of flight,飞行时间,指无线信号从发射端传播至接收端所经历的时间;toa:time of arrival,到达时间,指信号到达接收端的时间信息;los:line of sight,视距传播,指发射端与接收端之间无遮挡的直接传播状态;nlos:non-line of sight,非视距传播,指发射端与接收端之间存在遮挡、绕射或反射导致信号传播路径非直达的状态;多径效应:无线信号经煤壁、顶板、支护构件、设备表面等反射、绕射后形成多条传播路径并叠加影响测距精度的现象;vbakf:variational bayesian adaptive kalman filter,变分贝叶斯自适应卡尔曼滤波算法,用于在噪声统计特性未知或变化条件下自适应调整滤波参数,提高定位与状态估计精度;动态平差:根据新增观测数据、节点状态变化或控制网拓扑变化,对测量控制网中节点坐标、观测权重和残差进行实时或准实时修正的过程;gdop:geometric dilution of precision,几何精度因子,用于评价测量节点空间构型对定位精度的影响;进尺测量:对煤矿掘进工作面或采掘巷道实际推进距离进行测量的作业。

背景技术:

1、随着我国智能矿山建设的持续推进,煤矿井下生产对高精度、自动化、少人化和实时化测量技术提出了更高要求。井下采掘巷道的测量控制网是地质测绘、掘进进尺统计、采掘工程验收、生产调度、设备定位、灾害预警和智能化采掘控制的重要空间基础。传统井下测量主要依靠全站仪、导线测量、人工皮尺测距或人工记录掘进进尺等方式完成。上述方法虽然具备较高的单次测量精度,但存在作业时间长、劳动强度大、自动化程度低、无法连续测量、难以实时反映掘进动态变化等不足。

2、井下巷道属于典型的gnss拒止环境,卫星导航信号无法直接到达巷道内部。煤矿井下空间狭窄,巷道走向长、断面有限,煤壁、顶板、底板、金属支护、运输设备、管线、电缆和人员车辆均会影响无线信号传播。与此同时,井下温湿度变化、粉尘、巷道拐弯、设备遮挡和非视距传播等因素会导致测距误差随环境变化呈现非线性、非平稳特征。因此,简单套用地面无线定位方法难以满足煤矿井下巷道厘米级测量控制网构建和进尺自动化测量的要求。

3、超宽带uwb技术具有带宽大、脉冲窄、时间分辨率高、抗干扰能力强、功耗低、多径分辨能力强、测距精度高和设备成本适中等优点。uwb技术已广泛应用于室内定位、人员定位、装备定位、仓储物流和机器人导航等领域。与蓝牙、wi-fi、rfid等无线定位技术相比,uwb基于信号飞行时间进行测距,理论上具有更高的测距精度,适合在短中距离空间内实现厘米级至分米级定位。煤矿井下巷道具有明显的长距离线状空间特征,uwb信号在一定条件下还可能表现出巷道波导效应,使其具备在巷道中实现较长距离覆盖的潜力。

4、然而,井下巷道环境中的uwb测距和定位仍面临多径效应、非视距传播、节点几何构型退化、基站失效、测距噪声时变、温湿度影响、动态移动测量误差增大等问题。传统基于单一uwb基站或少量节点的定位方法,难以满足井下采掘巷道控制网建设对稳定性、冗余观测、坐标传递精度和动态自校准能力的要求。因此,有必要提出一种面向煤矿井下巷道环境的uwb测量控制网构建方法,通过多基准站联合组网、合理空间拓扑布设、测距误差建模、自适应滤波、动态平差和异常观测剔除,实现井下巷道测量控制网的高精度、长距离、连续化和自动化运行。

技术实现思路

1、(一)发明目的

2、针对现有技术中人工测量效率低、无线定位精度不足、井下巷道几何构型弱、多径和非视距误差明显、控制网缺少自校准能力等问题,本发明提供一种利用uwb技术构建煤矿井下巷道测量控制网的方法,以实现井下巷道厘米级测距和高精度定位,提高采掘巷道进尺测量自动化水平,增强测量控制网的稳定性和鲁棒性。

3、(二)技术方案

4、针对现有技术中人工测量效率低、无线定位精度不足、井下巷道几何构型弱、多径和非视距误差明显、控制网缺少自校准能力等问题,本发明提供一种利用uwb技术构建煤矿井下巷道测量控制网的方法,以实现井下巷道厘米级测距和高精度定位,提高采掘巷道进尺测量自动化水平,增强测量控制网的稳定性和鲁棒性。

5、本发明提出一种利用uwb技术构建煤矿井下巷道测量控制网的方法。该方法以多个固定uwb基准站为井下空间控制骨架,以一个或多个uwb流动站为测量节点,通过双边双向测距获取基准站与流动站之间、基准站与基准站之间的距离观测值;通过巷道拓扑约束、多基站冗余观测、测距误差补偿、变分贝叶斯自适应卡尔曼滤波和动态平差算法,实现井下巷道三维坐标解算、控制网动态校准和掘进进尺自动化测量。

6、本发明的总体技术路线包括以下步骤:

7、s1:在井下巷道内布设多个uwb基准站,并建立各uwb基准站的坐标初值;

8、s2:通过uwb流动站与所述多个uwb基准站进行双边双向测距,获取所述uwb流动站与各可见uwb基准站之间的距离观测值;

9、s3:建立井下巷道uwb测距误差补偿模型,对所述距离观测值进行误差补偿,得到改正后的测距值;

10、s4:基于所述改正后的测距值,采用变分贝叶斯自适应卡尔曼滤波或加权最小二乘方法,解算所述uwb流动站的三维坐标;

11、s5:根据所述uwb流动站的三维坐标序列,结合巷道方向约束,计算沿巷道走向的掘进进尺增量;

12、s6:对由所述多个uwb基准站和所述uwb流动站构成的测量控制网进行动态平差与自校准,所述动态平差与自校准包括:对基准站间和基准站与流动站间的观测残差进行统计检验以识别异常观测,对异常观测进行降权或剔除,并根据基准站完好性评分实现基站自动切换。

13、下面对上述各步骤进行说明:

14、骤s1,进一步地,在井下巷道内布设多个uwb基准站,并建立各uwb基准站的坐标初值。多个uwb基准站采用非对称空间梯度布设方式,相邻基准站分别布设于巷道两帮或同一帮的不同高度位置,以在平面和高程方向形成交错几何构型。各基准站天线距离煤壁、金属支护和大型设备大于30cm。每个流动站测量位置同时观测不少于4个基准站。uwb基准站坐标通过井下已有导线点约束或基站间测距平差的方式建立并初始化。

15、步骤s2,进一步地,通过uwb流动站与所述多个uwb基准站进行双边双向测距(ds-twr),获取所述uwb流动站与各可见uwb基准站之间的距离观测值。所述ds-twr方法通过流动站与基准站之间的多次消息交互(poll-resp-final)计算无线信号飞行时间(tof),再根据电磁波传播速度换算得到距离观测值,从而削弱节点时钟不同步造成的测距误差。

16、步骤s3,进一步地,建立井下巷道uwb测距误差补偿模型,对所述距离观测值进行误差补偿,得到改正后的测距值。所述测距误差补偿模型对系统误差、多径误差、非视距误差和随机噪声中的至少一者进行补偿。所述误差补偿模型利用标定距离或控制网冗余观测,以温度、湿度、信号强度、首径功率、接收功率、距离、信噪比等参数作为输入,输出改正后的测距值。

17、步骤s4,进一步地,基于所述改正后的测距值,采用变分贝叶斯自适应卡尔曼滤波(vbakf)或加权最小二乘方法,解算所述uwb流动站的三维坐标。所述加权最小二乘方法通过迭代解算流动站坐标,直至坐标改正数满足预设收敛阈值。所述vbakf通过变分贝叶斯推断对过程噪声协方差和观测噪声协方差进行自适应估计,并在滤波过程中引入来源于巷道设计坡度或导线点高程的高程先验约束,以提高三维定位稳定性。

18、步骤s5,进一步地,根据所述uwb流动站的三维坐标序列,结合巷道方向约束,计算沿巷道走向的掘进进尺增量。所述进尺增量通过将流动站在当前时刻与初始时刻的位置差向量向巷道中心线或掘进方向的单位方向向量投影计算得到。对连续多个时刻的流动站坐标进行滤波处理,并通过巷道方向约束剔除明显偏离中心线的异常位置。

19、步骤s6,进一步地,对由所述多个uwb基准站和所述uwb流动站构成的测量控制网进行动态平差与自校准,所述动态平差与自校准包括:对基准站间和基准站与流动站间的观测残差进行统计检验以识别异常观测,对异常观测进行降权或剔除,并根据基准站完好性评分实现基站自动切换。周期性采集基准站之间、基准站与流动站之间的距离观测值,采用迭代最小二乘方法进行控制网整体平差。对残差进行统计检验,按3σ准则识别异常观测并予以剔除或降权。基准站完好性评分由观测成功率、残差稳定性、通信质量和电源状态中的至少一者加权确定,当部分基准站失效或评分低于预设阈值时,系统通过冗余观测自动切换至相邻可用基准站组合,维持控制网连续运行。

20、进一步地,步骤s1中所述多个uwb基准站采用非对称空间梯度布设方式,相邻基准站分别布设于巷道两帮或同一帮的不同高度位置,以在平面和高程方向形成交错几何构型。

21、进一步地,步骤s2中所述双边双向测距的信号飞行时间按下式计算:

22、

23、其中,tround1和tround2分别表示两次往返测量时间,treply1和treply2分别表示两端设备内部响应时间,tof表示信号飞行时间。

24、进一步地,步骤s3中所述测距误差补偿模型对系统误差、多径误差、非视距误差和随机噪声中的至少一者进行补偿;改正后的测距值通过对原始测距值减去距离相关误差修正项、系统偏置修正项和非视距误差修正项得到。

25、进一步地,步骤s4中所述变分贝叶斯自适应卡尔曼滤波通过变分贝叶斯推断对过程噪声协方差和观测噪声协方差进行自适应估计,并在滤波过程中引入来源于巷道设计坡度或导线点高程的高程先验约束。

26、进一步地,步骤s5中所述进尺增量按下式计算:

27、

28、其中,po和pt分别为所述uwb流动站在初始时刻和当前时刻的位置,u为巷道中心线或掘进方向的单位方向向量。

29、进一步地,步骤s6中所述异常观测按残差超过预设阈值进行识别,所述基准站完好性评分由观测成功率、残差稳定性、通信质量和电源状态中的至少一者加权确定;控制网平差的目标函数为观测残差加权平方和最小。

30、进一步地,所述uwb基准站固定安装于巷道帮部或顶部锚杆,所述uwb流动站为手持式、车载式、机器人搭载式或掘进装备搭载式。

31、进一步地,提供一种基于uwb测量控制网的煤矿井下巷道掘进进尺自动测量方法,采用上述方法构建的uwb测量控制网,通过连续获取位于掘进工作面附近或掘进装备上的uwb流动站的三维坐标,并结合巷道方向约束进行投影计算,以自动获取掘进进尺增量。

32、进一步地,提供一种用于煤矿井下的uwb测量控制网系统,包括:多个uwb固定基准站,布设于井下巷道内,用于提供空间坐标基准;至少一个uwb流动站,用于与所述多个uwb固定基准站进行双边双向测距;后台数据处理系统,用于接收测距数据,并执行上述方法中的误差补偿、坐标解算、进尺计算以及动态平差与自校准步骤。

33、针对现有技术中人工测量效率低、无线定位精度不足、井下巷道几何构型弱、多径和非视距误差明显、控制网缺少自校准能力等问题,本发明具有以下有益效果。

34、第一,实现井下巷道厘米级测距和高精度定位。通过ds-twr测距、误差补偿、自适应滤波和动态平差,本发明能够在井下巷道环境中实现厘米级测距。实施例表明,静态测距rmse可达到约1.67cm,动态测距rmse可达到约2.79cm,静态平面定位rmse可达到约1.97cm,动态平面定位rmse可达到约4.69cm。

35、第二,提高采掘巷道进尺测量自动化水平。本发明利用uwb流动站实时获取位置坐标,并结合巷道方向约束自动计算进尺,可显著减少人工进尺测量作业时间和劳动强度,提高进尺统计的实时性、准确性和自动化水平。

36、第三,适应gnss不可用的煤矿井下环境。本发明不依赖gnss信号,利用井下布设的uwb基准站构建独立的空间测量控制网,适用于地下巷道、隧道、矿井和其他卫星信号不可达环境。

37、第四,增强井下测量控制网的稳定性和鲁棒性。通过多基准站冗余观测、动态平差、异常观测剔除和基站自动切换,本发明能够在部分观测受干扰或部分基站状态异常时维持测量控制网运行,提高系统可靠性。

38、第五,降低井下测量作业成本和安全风险。本发明能够减少测量人员频繁进入掘进工作面附近进行人工测量的次数,降低井下作业风险,同时提升测量数据获取效率。

39、第六,具备长距离连续测量能力。本发明所述uwb系统在井下巷道中的有效测量距离可超过300m,并可在不同基站之间自动切换,适合长距离采掘巷道连续测量。

40、第七,可扩展性强。本发明可与惯性导航、温湿度传感器、lora通信、井下机器人、掘进机位姿测量系统和矿山生产调度系统集成,形成面向智能矿山的井下高精度空间位置服务平台。