一种基于ucosii的矿井搜救系统及搜救方法
【技术领域】
[0001] 本发明属于智能机器人技术领域，具体涉及一种基于UC0SII的矿井搜救系统及搜 救方法。
【背景技术】
[0002] 煤炭是一个国家不可或缺的能源，也是我国主要的能源之一。然而，国内外煤矿事 故频发，给经济建设与人们带来了极大的损害。在加强矿井安全措施与注重矿井安全监管 的同时，还需要一种应用于事故发生后救援的搜救设备，将灾害降到最低。井下一旦发生事 故，通道狭隘，复杂的矿洞巷道，且空气中充满着爆炸性气体，都将给矿难救援带来极大的 困难。这就是需要井下救援机器人除具备良好的移动设备之外，还需要良好的地形适应能 力、避障能力以及搜索功能。因此，本发明针对目前国内矿难频发的状况以及国内外的机器 人研究现状，提出了一种基于UC0SII的矿井搜救系统，可有效智能地执行井下搜救任务，便 于矿难发生时被困人员的快速搜救。
【发明内容】
[0003] 本发明的目的在于提供一种基于UC0SII的矿井搜救系统及搜救方法，能够在矿难 发生后第一时间进入现场，帮助救援人员快速获取现场信息，探明被困人员位置、采集灾难 现场环境参数信息、实时地返回灾难现场图像、动态规划搜救路径，力求搜救过程的高效 性，为生命救援提供保障。
[0004] 为解决上述技术问题，本发明采用的技术方案是：
[0005] 本发明基于UC0SII的矿井搜救系统由控制中心、网络协调器、路由器节点和搜救 机器人组成;所述的搜救机器人携带移动终端节点；所述的移动终端节点将搜救机器人采 集到的数据发送到路由器节点；所述的路由器节点负责移动终端节点的路径查询，并将数 据转发到网络协调器;所述的网络协调器在接收到移动终端节点采集的数据信息后，通过 串口向控制中心发送数据;所述的控制中心在接收到数据后，实时显示现场环境参数信息， 并向搜救机器人发出指令。
[0006] 所述的搜救机器人包括搜救机器人本体和搜救机器人动力系统;所述的搜救机器 人本体为三层车体结构;车体底层放置电机驱动模块，包括电机驱动板和电机;车体中间层 放置电源模块及主控板，电源模块包括蓄电池和电源转换模块;机器人顶层放置多类环境 传感器、三轴加速度传感器、无线通信模块和机械手;所述的环境传感器包括烟雾传感器、 甲烷传感器、温湿度传感器和热释电红外传感器;所述的机械手为六自由度机械手;所述的 主控板设有负责控制算法调度及驱动各类传感器的下位机系统;搜救机器人本体设有视觉 传感器、雷达模块和轮胎。
[0007] 所述主控板的核心为STM32F103RC型号微处理器;搜救机器人之间通过无线通信 模块自主组网及精确定位，无线通信模块采用ZigBee模块;ZigBee模块的TX1、RX1脚分别与 微处理器的29、30脚相连;烟雾传感器采用MQ2烟雾传感器，温湿度传感器采用M2301数字温 湿度传感器;烟雾传感器的输出脚ADC1与微处理器的11脚相连，微处理器的ADC米样烟雾传 感器的输出电压;数字温湿度传感器的输出引脚ADC2与微处理器的20引脚相连;热释电红 外传感器是BIS0001热释电红外传感器;热释电红外传感器的触发脚EXTER1与微处理器的 41脚相连，当热释电红外传感器感应到人体红外线时，输出一个上升沿脉冲，微处理器捕获 到这个脉冲，并向控制中心发出报警信号；视觉传感器的TX2、RX2脚分别与微处理器的51 脚、52脚相连，实现现场图像的实时采集与传输;三轴加速度传感器型号为MPU6050，其SCL 引脚和SDA引脚分别与微处理器的86、87引脚相连;雷达的OUT引脚与微处理器的57引脚相 连;雷达、三轴加速度传感器、ZigBee模块、烟雾传感器、温湿度传感器、视觉传感器和热释 电红外传感器的VCC端都与电源模块相连，GND端均接地;三轴加速度传感器的其它引脚悬 空。
[0008]所述的搜救机器人动力系统包括第一电机、第二电机、第三电机、第四电机、第一 驱动器和第二驱动器;第一电机和第二电机驱动搜救机器人本体前面的两个轮胎，第三电 机和第四电机驱动搜救机器人本体后面的两个轮胎;第一驱动器控制第一电机和第二电 机，第二驱动器控制第三电机和第四电机;微处理器的2~10脚依次接第一驱动器的输入端 口八1)2、81、82及第二驱动器的输入端口(：1工2、01、02 ;微处理器的58、59、61、62脚依次接 入第一驱动器的PWMA、PWMB脚及第二驱动器的PWMA、PWMB脚。
[0009] 所述的机械手以Arduino Uno R3单片机为控制板;Arduino Uno R3单片机的5、6、 7、15、16、17脚与实现机械手六个自由度的六个舵机的信号端相连;六个舵机的VCC端都与 电源模块相连，GND端均接地;Arduino Uno R3单片机的2引脚与微处理器的46引脚相连，3 引脚与微处理器的45引脚相连。
[0010] 所述的无线通信模块采用基于RSSI的极大似然估计算法来精确定位搜救机器人 方位，确定搜救机器人坐标;RSSI测距技术的公式为： 中，Pt表示移动终端节点的发射功率，取值为0dBm;pL(dQ)表示距离为lm处的接受功率;p(d) 为距离未知节点d处接收的RSSI信号强度值;X。为遮蔽因子;极大似然估计算法是在已知η 个参考节点的情况下，通过求取未知节点到各个参考节点的距离均方差最小得到，η 2 3。
[0011] 所述的每种传感器在无线传感器网络传输数据之前，通过卡尔曼滤波原理对采集 的数据进行去噪处理。
[0012] 所述的下位机系统为UC0SII嵌入式系统，包括开始任务模块及与开始任务模块通 信的数据采集任务模块、无线通讯任务模块、机械手控制任务模块和算法调度任务模块;数 据采集任务模块管理环境传感器、三轴加速度传感器和视觉传感器;环境传感器通过RS232 接口与数据采集任务模块通讯;视觉传感器通过RS485接口将现场图像传送到数据采集任 务模块中；三轴加速度传感器通过IIC接口将角度值传送到数据采集任务模块中；机械手控 制任务模块管理搜救机器人上搭载的机械手;算法调度任务模块通过主控板中的动态寻优 算法输出PWM值，控制各个电机的转速;无线通信任务模块通过RS485与无线传感器网络通 信;无线传感器网络将控制中心、无线通信模块和搜救机器人联系起来。
[0013] 所述控制中心的上位机系统包括菜单模块、状态模块、串口模块、摄像头模块、机 械臂模块、传感器模块和帮助模块;菜单模块选择软件功能;状态模块显示机器人的运动状 态；串口模块设置串口参数;摄像头模块显示视觉传感器的当前数据和控制视觉传感器的 角度;机械臂模块控制机械臂的动作;传感器模块显示各类传感器的数据并且具有报警功 能;帮助模块显示软件使用的注意事项及基本操作。
[0014] 基于UC0SII的矿井搜救系统进行搜救的方法，具体步骤如下：
[0015] 步骤一、控制中心发出搜索指令，通过无线通信模块传输到搜救机器人，搜救机器 人开始无序搜索。
[0016] 步骤二、搜救机器人在搜索过程中，通过环境传感器采集当前环境参数信息，并且 将当前环境参数信息进行卡尔曼滤波后反馈至控制中心，控制中心对采集到的环境参数信 息进行实时分析。
[0017] 步骤三、搜救机器人将视觉传感器采集到的现场图像信息实时地反馈到控制中 心，控制中心的视频显示界面显示出当前灾难现场的图像信息。
[0018] 步骤四、无线通信模块通过定位算法对当前的搜救机器人进行定位，并将搜救机 器人的坐标信息反馈至控制中心的上位机系统;上位机系统绘制各个搜救机器人运行轨迹 图，实时分析当前搜救路线。
[0019] 步骤五、搜救机器人若通过热释电红外传感器检测到生命信息，便将在当前坐标 定位一个标志点，并将该标志点坐标信息反馈至控制中心，控制中心发出警报声，所有搜救 机器人都将以该标志点坐标为中心，进行组网联动搜索，逐步扩大搜索范围。搜救机器人若 没有检测到生命信息，则继续无序搜索。
[0020] 步骤六、搜救机器人上搭载的主控板在搜索过程中进行算法分析，对多种传感器 及组网信息进行数据融合算法，规划动态路径。
[0021] 步骤七、灾难现场地图已搜索完毕，各搜救机器人按当前规划的最优搜救路径返 回。
[0022]步骤八、进行下一个地图的搜索工作。
[0023]本发明的有益效果在于:为矿难发生时矿井环境复杂、潜在危险性大、救援工作开 展缓慢、大型救援设备难以及时到位提供了一套解决方案。与传统的人力救援相比，其优势 在于：（1)用机器代替人去执行复杂、危险的矿井救援任务，保障了救援人员的安全性。（2) 通过搜救机器人上搭载的视觉传感器及多种环境传感器，救援人员可对灾难现场有一个初 步环境认知，解决了传统救援环境数据缺失的缺点。（3)通过先进的搜救算法，由搜救机器 人作为"先行者"，合理地规划出一条"最优搜救路径"，提高了搜救效率。（4)能够在矿难发 生后第一时间进入现场，帮助救援人员快速获取现场信息，探明被困人员位置、采集灾难现 场环境参