一种钻锚机器人与掘进机会车防碰撞方法及系统技术方案

本发明专利技术涉及煤矿机器人防碰撞技术领域，具体涉及一种钻锚机器人与掘进机会车防碰撞方法及系统，利用钻锚机器人外壁左右两侧多个外壁超声波传感器，实时检测钻锚机器人机身各个位置与煤壁的距离，并利用钻锚机器人内壁的多个内壁超声波传感器实时检测钻锚器机器人与掘进机的距离关系，实现钻锚机器人与掘进机会车过程防碰撞预警，同时根据掘进机与其他物体宽度不同，剔除因工作人员以及其他因素引起无效报警信息。本发明专利技术利用多超声波传感器信息融合，提高检测精度，同时剔除了无效报警信息，克服了单一传感器易引起误报警的缺点。服了单一传感器易引起误报警的缺点。服了单一传感器易引起误报警的缺点。

【技术实现步骤摘要】
一种钻锚机器人与掘进机会车防碰撞方法及系统


[0001]本专利技术涉及煤矿机器人防碰撞
，具体涉及一种钻锚机器人与掘进机会车防碰撞方法及系统。

技术介绍

[0002]针对复杂地质条件煤矿巷道掘进难题，研发了一套龙门式钻锚机器人+传统悬臂式掘进机煤矿巷道快速掘进系统，该系统通过龙门式钻锚机器人和传统悬臂式掘进机协同作业，发挥掘进机与钻锚机器人各自最大优势，提高掘进效率。由于系统工作时掘进机需要从钻锚机器人内部穿行，受巷道空间限制，掘进机与钻锚机器人之间的距离较小，钻锚机器人与煤壁之间距离较小，导致会车时易发生碰撞，从而造成生产隐患。因此，构建钻锚机器人与掘进机会车系统，解决两者在会车时易发生碰撞的问题就显得极其重要。
[0003]目前，井下设备上所采用的主动安全防碰撞装置众多，但是均存在一定的弊端。红外测距传感器受煤矿井下煤壁吸收红外光的影响，测距效果不佳。激光测距传感器测距精度高，响应速度快，但是在井下烟雾，粉尘浓度较高，直接影响激光测距传感器的测距精度。机器视觉测距系统，受粉尘、水雾等影响，在煤矿井下使用有很大的局限性。此外，上述防碰撞装置，大多应用于防止机车与障碍物纵向发生碰撞的情况，并不适用于钻锚机器人与掘进以及巷道侧向发生碰撞的情况。

技术实现思路

[0004]为解决上述问题，本专利技术提供了一种钻锚机器人与掘进机会车防碰撞方法及系统，利用多点位并行的超声波传感器，实现了钻锚机器人与掘进机会车过程中的碰撞检测与预警。
[0005]为实现上述目的，本专利技术采取的技术方案为：
[0006]一种钻锚机器人与掘进机会车防碰撞方法，通过在钻锚机器人机身内外两侧安装的多个超声波传感器实时检测其与掘进机以及巷道的距离关系，实现碰撞检测与预警；同时根据掘进机与其他物体宽度不同，剔除因工作人员以及其他因素引起无效报警信息。
[0007]进一步地，利用钻锚器机器人外壁左右两侧多个外壁超声波传感器，实时检测钻锚机器人机身与煤壁的距离，并利用钻锚机器人内壁的多个内壁超声波传感器实时检测钻锚器机器人与掘进机的距离关系，实现钻锚机器人与掘进机会车的过程中防碰撞预警，同时根据掘进机与其他物体宽度不同，剔除因工作人员以及其他因素引起无效报警信息。
[0008]进一步地，包括以下步骤：
[0009]S1、在钻锚机器人机身上布置多个点位并行的超声波传感器，共28个，其中，钻锚机器人两侧外壁共安装12个外壁超声波传感器，左右各6个，传感器以机器人机身中心轴线为基准呈左右分布，外壁两侧传感器安装位置相同，钻锚机器人内壁两侧共安装16个内壁超声波传感器，左右各8个，左右两侧传感器安装位置相同；
[0010]S2、利用钻锚器机器人外壁左右两侧多个外壁超声波传感器，实时检测钻锚机器
人机身各个位置与煤壁的距离，当达到报警门限时，声光报警器报警，具体的：
[0011]S201、利用RS458通信模块将传感器检测的信息传入多传感器融合信息处理器，进行信息处理，采用渡越时间(TOF)算法测算钻锚机器人与煤壁之间的距离d
m
。
[0012][0013]式中，c为超声波的传输速度，τ为超声波从发射到接收的时间，即超声渡越时间；为提高TOF算法的检测精度，采用互相关时延估计法计算超声波渡越时间，在同一个超声测距系统中，回波信号与发射信号的频率和周期均保持不变，因此对2种信号做互相关运算，互相关函数为：
[0014][0015]式中，T为信号周期；t为时间；f(t)为发射信号，g(t+τ)为回波信号；
[0016]S202、判断传感器检测的距离信息d
m
是否达到所设定的门限值，若超过门值，声光报警器报警，提醒司机调整钻锚机器人的位姿；
[0017]S3、利用钻锚机器人内壁的多个内壁超声波传感器实时检测钻锚器机器人与掘进机的距离关系，实现钻锚机器人与掘进机会车的过程中防碰撞预警，同时根据掘进机与其他物体宽度不同，剔除因工作人员以及其他因素引起无效报警信息，具体的：
[0018]S301、利用RS458通信模块将钻锚机器人内壁两侧的传感器检测的信息传入多传感器融合信息处理器，进行信息处理，检测掘进机的宽度信息；
[0019]钻锚机器人内壁两侧的16个超声波传感器两两正对，且上下齐平，在同一水平面上的两个超声波传感器构成一组宽度采集模块，则一共有八组信息采集模块，按S形分布依次记为I，II，...VIII，分别采集宽度数据，假设钻锚机器人内壁的宽度为h，当掘进机或者其他物体从钻锚机器人内部通过时，其左右两侧传感器利用渡越时间算法检测距离信息；
[0020][0021]式中，d
l
为左侧超声波传感器检测的距离信息，d
r
为右侧超声波传感器检测的距离信息，T
dl
为左侧超声波传感器收到回波的时间，T
dr
为右侧超声波传感器收到回波的时间；
[0022]当h
‑
(d
l
+d
r
)超过一定阈值时，就认为有物体或者掘进机通过，并计算出其宽度L为：
[0023]L＝h
‑
(d
l
+d
r
)
[0024]S302、利用D
‑
S证据理论融合多个超声波传感器采集的宽度信息，具体的：
[0025]系统中超声波传感器的采样周期为0.2S，采集次数为6次，当掘进机从钻锚机器人内部通过时，其内侧的超声检测模块并行工作，以钻锚机器人最前端的检测模块I与II为例，其余三组宽度信息融合原理与I组和II组相同，首先得到超声检测模块6次采样数据的均值A
I
，AII，分别为：
[0026][0027]式中，i，j为采样次数，L
Ii
，L
IIj
分别为I组和II组传感器采集的宽度信息；
[0028]根据以往大量试验数据的基础上，确定出I组和II组超声检测模块的可信度概率分配值分别为m
I
和m
II
，得到两组宽度采集模块的融合结果L
w
为：
[0029]L
w
＝A
I
m
I
+A
II
m
II
[0030]S303、根据掘进机与其他物体的宽度不同，剔除无效报警信息；
[0031]由于掘进机的宽度与其他物体的宽度不同，若融合后的宽度信息L
w
在掘进机机声宽度和铲板宽度之间则保留，并判断钻锚机器人两侧传感器检测的距离d是否达到门限值，若达到门限值，利用声光报警器报警，提醒司机调整其位姿，否则继续行驶，对于超出合理范围的离群值，则直接舍弃。
[0032]本专利技术还提供了一种钻锚机器人与掘进机会车防碰撞系统，该系统采用如上述的方法实现钻锚机器人与掘进机会车的会车防碰撞预警。
[0033]本专利技术具有以下有本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种钻锚机器人与掘进机会车防碰撞方法，其特征在于，通过在钻锚机器人机身内外两侧安装的多个超声波传感器实时检测其与掘进机以及巷道的距离关系，实现碰撞检测与预警；同时根据掘进机与其他物体宽度不同，剔除因工作人员以及其他因素引起无效报警信息。2.如权利要求1所述的一种钻锚机器人与掘进机会车防碰撞方法，其特征在于，利用钻锚器机器人外壁左右两侧多个外壁超声波传感器，实时检测钻锚机器人机身各个位置与煤壁的距离，并利用钻锚机器人内壁的多个内壁超声波传感器实时检测钻锚器机器人与掘进机的距离关系，实现钻锚机器人与掘进机会车的过程中防碰撞预警，同时根据掘进机与其他物体宽度不同，剔除因工作人员以及其他因素引起无效报警信息。3.如权利要求1所述的一种钻锚机器人与掘进机会车防碰撞方法，其特征在于，包括以下步骤：S1、在钻锚机器人机身上布置多个点位并行的超声波传感器，其中，钻锚机器人两侧外壁安装有外壁超声波传感器，传感器以机器人机身中心轴线为基准呈左右分布，外壁两侧传感器安装位置相同；钻锚机器人内壁两侧安装有内壁超声波传感器，左右两侧传感器安装位置相同；S2、利用钻锚器机器人外壁左右两侧多个外壁超声波传感器，实时检测钻锚机器人机身各个位置与煤壁的距离，当达到报警门限时，声光报警器报警，具体的：S201、利用RS458通信模块将传感器检测的信息传入多传感器融合信息处理器，进行信息处理，采用渡越时间(TOF)算法测算钻锚机器人与煤壁之间的距离d
m
：式中，c为超声波的传输速度，τ为超声波从发射到接收的时间，即超声渡越时间；采用互相关时延估计法计算超声波渡越时间，在同一个超声测距系统中，回波信号与发射信号的频率和周期均保持不变，因此对2种信号做互相关运算，互相关函数为：式中，T为信号周期；t为时间；f(t)为发射信号，g(t+T)为回波信号；S202、判断传感器检测的距离信息d
m
是否达到所设定的门限值，若超过门值，声光报警器报警，提醒司机调整钻锚机器人的位姿；S3、利用钻锚机器人内壁的多个超声波传感器实时检测钻锚器机器人与掘进机的距离关系，实现钻锚机器人与掘进机会车过程防碰撞预警，同时根据掘进机与其他物体宽度不同，剔除因工作人员以及其他因素引起无效报警信息，具体的：S301、利用RS458通信模块将钻锚机器人内壁两侧的传感器检测的信息传入多传感器融合信息处理器，进行信息处理，检测掘进机的宽度信息；钻锚机器人内壁两侧的内壁超声波传感器两两正对，且上下齐平，在同一水平面上的两个超声波传感器构成一组宽度采集模块，将信...

【专利技术属性】
技术研发人员：马宏伟，宋金全，赵军利，毛清华，师岗，薛旭升，刘武，王川伟，汪强，贾泽林，王荣泉，
申请(专利权)人：西安科技大学，
类型：发明
国别省市：