[发明专利]一种钻锚机器人与掘进机会车防碰撞方法及系统

说明书

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

技术领域

本发明涉及煤矿机器人防碰撞技术领域，具体涉及一种钻锚机器人与掘进机会车防碰撞方法及系统。

背景技术

针对复杂地质条件煤矿巷道掘进难题，研发了一套龙门式钻锚机器人+传统悬臂式掘进机煤矿巷道快速掘进系统，该系统通过龙门式钻锚机器人和传统悬臂式掘进机协同作业，发挥掘进机与钻锚机器人各自最大优势，提高掘进效率。由于系统工作时掘进机需要从钻锚机器人内部穿行，受巷道空间限制，掘进机与钻锚机器人之间的距离较小，钻锚机器人与煤壁之间距离较小，导致会车时易发生碰撞，从而造成生产隐患。因此，构建钻锚机器人与掘进机会车系统，解决两者在会车时易发生碰撞的问题就显得极其重要。

目前，井下设备上所采用的主动安全防碰撞装置众多，但是均存在一定的弊端。红外测距传感器受煤矿井下煤壁吸收红外光的影响，测距效果不佳。激光测距传感器测距精度高，响应速度快，但是在井下烟雾，粉尘浓度较高，直接影响激光测距传感器的测距精度。机器视觉测距系统，受粉尘、水雾等影响，在煤矿井下使用有很大的局限性。此外，上述防碰撞装置，大多应用于防止机车与障碍物纵向发生碰撞的情况，并不适用于钻锚机器人与掘进以及巷道侧向发生碰撞的情况。

发明内容

为解决上述问题，本发明提供了一种钻锚机器人与掘进机会车防碰撞方法及系统，利用多点位并行的超声波传感器，实现了钻锚机器人与掘进机会车过程中的碰撞检测与预警。

为实现上述目的，本发明采取的技术方案为：

一种钻锚机器人与掘进机会车防碰撞方法，通过在钻锚机器人机身内外两侧安装的多个超声波传感器实时检测其与掘进机以及巷道的距离关系，实现碰撞检测与预警；同时根据掘进机与其他物体宽度不同，剔除因工作人员以及其他因素引起无效报警信息。

进一步地，利用钻锚器机器人外壁左右两侧多个外壁超声波传感器，实时检测钻锚机器人机身与煤壁的距离，并利用钻锚机器人内壁的多个内壁超声波传感器实时检测钻锚器机器人与掘进机的距离关系，实现钻锚机器人与掘进机会车的过程中防碰撞预警，同时根据掘进机与其他物体宽度不同，剔除因工作人员以及其他因素引起无效报警信息。

进一步地，包括以下步骤：

S1、在钻锚机器人机身上布置多个点位并行的超声波传感器，共28个，其中，钻锚机器人两侧外壁共安装12个外壁超声波传感器，左右各6个，传感器以机器人机身中心轴线为基准呈左右分布，外壁两侧传感器安装位置相同，钻锚机器人内壁两侧共安装16个内壁超声波传感器，左右各8个，左右两侧传感器安装位置相同；

S2、利用钻锚器机器人外壁左右两侧多个外壁超声波传感器，实时检测钻锚机器人机身各个位置与煤壁的距离，当达到报警门限时，声光报警器报警，具体的：

S201、利用RS458通信模块将传感器检测的信息传入多传感器融合信息处理器，进行信息处理，采用渡越时间(TOF)算法测算钻锚机器人与煤壁之间的距离d_m。

式中，c为超声波的传输速度，τ为超声波从发射到接收的时间，即超声渡越时间；为提高TOF算法的检测精度，采用互相关时延估计法计算超声波渡越时间，在同一个超声测距系统中，回波信号与发射信号的频率和周期均保持不变，因此对2种信号做互相关运算，互相关函数为：