基于无线传感器网络的矿井搜索探测多机器人系统技术方案

基于无线传感器网络的矿井搜索探测多机器人系统，本发明专利技术涉及矿井及井下事故现场的搜索探测领域，它克服了现有技术不能解决现场环境信息和被困人员信息的快速传递问题。它由以下装置组成：多关节体机器人，它具有蛇形细长结构并采用履带行走方式，具有搭载仓，可携带多个小型侦查机器人，携带的多种传感器能够确定受困矿工的位置、检测出有害气体的种类、有害气体的含量和环境温度；小型侦查机器人，通过沿途的被释放，实现多点信息采集和远距离通讯；远程操控终端，设置在地面上，与多关节体探测机器人和多个小型侦查机器人组成无线传感器网络，搭建起操作者和机器人间的通讯链路；救援人员在远端实时操控机器人各部分的运动，并获取现场环境信息和被困人员信息。

【技术实现步骤摘要】

本专利技术涉及矿井及井下事故现场的搜索探测领域，更具体地说是一种以移动 机器人为节点，采用无线传感器网络技术进行多机器人协调控制的矿井搜索探 测多机器人系统。技术背景目前国内外矿井事故搜救工作还是以人工搜救为主，只有美国和日本研制 了单体井下救援机器人的原型，但上述机器人结构上的抗倾覆能力和越障能力非常差。公开号为CN1931653A的《一种适用于煤矿矿井搜索探测的履带式多 关节铰接机器人》专利公开了一种不易倾覆，而且具有较好的越障能力且可以 非常容易地穿越狭小长缝的蛇形履带式多关节机器人，但该专利没有公开井下 搜救中多点传感和远距离通讯这两大关键问题，不能解决现场环境信息和被困 人员信息的快速传递问题。无线传感器网络作为一种全新的信息获取与处理技 术，其特有的多节点协作与动态拓扑控制技术、无线多跳通讯技术将为井下多 机器人协作采集信息和远距离通讯提供了很好的解决方案，为多机器人系统完 成矿井搜索探测任务提供了有力支持。
技术实现思路
本专利技术目的是提供一种基于无线传感器网络的矿井搜索探测多机器人系 统，以克服现有技术不能解决现场环境信息和被困人员信息的快速传递问题。 它由以下装置组成多关节体机器人，它具有蛇形细长结构并采用履带行走方式，能够满足矿 井井下复杂障碍对机器人地形附着能力和较小的体积的要求；多关节体机器人 具有搭载仓，可携带多个小型侦查机器人；多关节体机器人具有信息感知系统， 通过携带的多种传感器能够确定受困矿工的位置、检测出有害气体的种类、有害气体的含量和环境温度，确定是否存在明火以及明火的位置；小型侦査机器人，通过沿途的被释放，成为有害气体的种类、有害气体的含量和环境温度的监控节点和无线网络的信息传递节点，实现多点信息采集和 远距离通讯；远程操控终端，设置在地面上，与多关节体探测机器人和多个小型侦査机 器人组成无线传感器网络，搭建起操作者和机器人间的通讯链路；在此链路基 础上，采用遥操作模式进行人机交互，救援人员在远端通过人机接口可以实时 操控机器人各部分的运动，并获取现场环境信息和被困人员信息。本专利技术解决了矿井井下复杂环境中环境监测、人员搜索定位和远程通信等 问题，本专利技术通过多机协作有效穿越障碍，到达危险和灾害现场，采集(气、 火、水等)多种信息；该系统还通过沿途释放的小型机器人做为监控、通讯节 点构成无线传感器网络，接收和传递操作者的指令并将现场信息发送给操作者， 辅助生产和救护人员进行紧急决策或实施快速、有效的救助。本专利技术的优点是 能实现动态自组织、通讯可靠性高和环境感知能力强，能够在井下复杂地形中 运动并配置多机器人节点，搭建无线传感器网络，通过遥操作模式进行人机交 互，实现井下信息获取和多机器人控制。克服了现有技术不能解决现场环境信 息和被困人员信息的快速传递问题。附图说明图1是本专利技术多关节体机器人1的结构示意图，图2是本专利技术的系统构成 示意图，图3是多关节体机器人1的电路结构示意图，图4是小型侦查机器人2 的电路结构示意图。具体实施方式具体实施方式一下面结合图1和图2具体说明本实施方式。本实施方式 由以下装置组成:多关节体机器人1,它具有蛇形细长结构并采用履带行走方式， 能够满足矿井井下复杂障碍对机器人地形附着能力和较小的体积的要求；多关节体机器人1具有搭载仓，可携带多个小型侦査机器人2;多关节体机器人1具有信息感知系统，通过携带的多种传感器能够确定受困矿工的位置、检测出 有害气体的种类、有害气体的含量和环境温度，确定是否存在明火以及明火的位置；小型侦査机器人2，小型两轮侦査机器人具有结构简单、便于搭载的特点，通过沿途的被释放，成为有害气体的种类、有害气体的含量和环境温度的监控节点和无线网络的信息传递节点，实现多点信息采集和远距离通讯；给每个小 型侦査机器人2安装不同的传感元件，可以动态监控整个巷道内的各种气体、 温度变化情况。远程操控终端3，设置在地面上，与多关节体探测机器人1和多个小型侦查 机器人2组成无线传感器网络，搭建起操作者和机器人间的通讯链路。在此链 路基础上，采用遥操作模式进行人机交互，救援人员在远端通过友好的人机接 口 (PDA、 Monitor和控制按钮)就可以实时操控机器人各部分的运动，并获取 现场环境信息和被困人员信息；如图1所示，本实施方式的多关节体机器人1由七个关节体组成，分别是 头部单元1-1、尾部单元1-2、两个铰驱动单元1-3、搭载单元1-4、电源单元1-5 和控制传感单元1-6，关节体之间通过铰链连接，可以适应非常复杂的地形条件。 每个关节体上都装有自己的电动机、减速器、驱动器作为运动系统。头部单元 1-1的前端面上和尾部单元1-2后端面上分别装有可折叠柔性臂1-8，可折叠柔 性臂1-8的伸出端上安装有摄像头l-9，如此设置可通过折叠柔性适应狭小通道; 铰驱动单元1-3内有主动铰链的驱动机构；控制传感单元1-6内设置有无线通信 模块1-6-1、处理器模块1-6-2、运动模块1-6-3、传感器模块1-6-4等；如图3 所示。处理器模块采用飞利浦公司生产的ARM7芯片，型号是LPC2294，其集 成6路PWM输出、2个32位计数器等外设便于进行对运动模块的控制，4个 CAN控制器可方便组建CAN总线网络，完成运动部件驱动、传感器采集、数 据处理、通讯等功能。考虑系统的经济性和可靠性，以Nordic公司的无线通讯 芯片nRF401为核心设计了无线通讯模块。nRF401工作在433MHz国际通用的 ISM频段，釆用FSK调制解调技术，数据传输率最高可达20Kbps，具有无需曼 彻斯特编码、误码率低、体积小，所需外围元件少，可以采用PCB天线等特点， 非常符合本系统小型化的要求。电源单元1-5携带较大的锂聚合物电池，为各 模块供电;搭载单元1-4具有可开闭舱门的搭载仓，装有多个小型侦査机器人2。 小型两轮侦查机器人带有传感器模块、处理器模块、无线通信模块等，具有结 构简单、便于搭载的特点，通过沿途释放作为侦查节点，与主机器人一起构建 成无线传感器网络，可以实现多点信息采集和远距离通讯功能。多关节体机器人1的运动系统采用MAXON公司的EC系列无刷电机和相 应速比的减速器，可以避免有刷电机的换向火花，有利于井下防爆。运动控制 方面，选用成熟的商用电机驱动器ACK-055-06，与主控处理器采用CAN总线 通讯。小型侦査机器人2的运动机构采用MAXON公司的EC系列无刷电机和 相应速比的减速器。 -本专利技术的工作过程如下操作者通过远程操控终端3在用户层下达搜救任 务，并且通过友好的人机接口 (PDA、 Monitor、控制按钮)给多机系统发送运 动和操作指令。多关节体机器人1通过无线收发模块接收到指令后通过控制执 行层控制自身多关节体的运动，灵活地躲避障碍；每行进一段距离，多关节体 机器人1将舱门放下释放一个小型侦査机器人2作为节点。各小型侦査机器人2 和多关节体机器人1组成节点可移动的无线传感器网络， 一方面和远程操控终 端3的无线收发模块相连接，将可靠的通讯范围一步步扩大，另一方面通过各 小型侦查机器人2和多关节体机器人1携带的多种传感器，将可探测的环境范 围进一步扩大，实现了一个动态的主动移动无线传感器网络。这种多通讯传感 节点多跳组网的方本文档来自技高网...

【技术保护点】
基于无线传感器网络的矿井搜索探测多机器人系统，其特征在于它由以下装置组成：多关节体机器人（１），它具有蛇形细长结构并采用履带行走方式，能够满足矿井井下复杂障碍对机器人地形附着能力和较小的体积的要求；多关节体机器人（１）具有搭载仓，可携带多个小型侦查机器人（２）；多关节体机器人（１）具有信息感知系统，通过携带的多种传感器能够确定受困矿工的位置、检测出有害气体的种类、有害气体的含量和环境温度，确定是否存在明火以及明火的位置；小型侦查机器人（２），通过沿途的被释放，成为有害气体的种类、有害气体的含量和环境温度的监控节点和无线网络的信息传递节点，实现多点信息采集和远距离通讯；远程操控终端（３），设置在地面上，与多关节体探测机器人（１）和多个小型侦查机器人（２）组成无线传感器网络，搭建起操作者和机器人间的通讯链路；在此链路基础上，采用遥操作模式进行人机交互，救援人员在远端通过人机接口可以实时操控机器人各部分的运动，并获取现场环境信息和被困人员信息。

【技术特征摘要】

【专利技术属性】
技术研发人员：赵杰，闫继宏，刘刚峰，樊继壮，刘玉斌，高永生，
申请(专利权)人：哈尔滨工业大学，
类型：发明
国别省市：93[]