基于Wifi的井下机器人通信控制系统的制作方法
【技术领域】
[0001]本发明涉及一种基于Wifi的井下机器人通信控制系统，该系统涉及无线通信和视频、音频采集等领域。
【背景技术】
[0002]随着各类矿井生产的机械化、信息化和自动化程度的提高，中国矿井安全生产形势逐年好转，各类事故率和死亡率均大幅下降。然而井下生产环境复杂，还是不可避免的发生各类事故，事故发生后，及时掌握井下事故现场情况，是正确、有效救援，减少人员伤亡的关键。井下瓦斯爆炸和火灾等事故，会产生大量C0，C02，CH4等有毒有害气体，消耗大量02。当事故现场有毒有害气体浓度超高、O2含量较低时、搜寻，救护人员难以到达有关区域进行侦察、搜寻和救援。井下机器人除用于救灾外，也可用于井下巡检领域。因此、研究井下机器人相关的技术十分必要。由于目前井下无线通信的接入设备需供电系统和通信光缆或电缆连接，所以事故发生时，巷道内原有无线通信系统无法使用，井下机器人必须自带通信系统进行通信。轮式、履带式、蛇形等地面行进的机器人可通过有线通信方式与控制设备进行通信，而采用飞行行进方式的机器人则应采用无线通信方式，目前井下Wifi无线通信网络已得到较广泛的应用，Wifi无线通信具有数据传输高度、安全可靠、使用灵活方便等特点，但通信距离受发射功率和空间阻挡等因素影响，直接影响井下机器人的工作距离。所以需要新的通信组网方式和系统以保证井下机器人的通信距离。
【发明内容】
[0003]本发明目的在于提供一种基于Wifi的井下机器人通信控制系统，所述系统用于使井下机器人的无线通信距离随机器人的行进而不断增长。井下机器人采用Wifi多跳无线网络与控制设备通信，井下机器人携带有多个Wifi路由设备，在行进过程中同时根据设定条件投放Wifi无线路由设备，使Wifi网络的覆盖范围随井下机器人的行进路程的增加而不断推进，以保证井下机器人与机器人控制设备的通信;所述通信控制系统通过井下机器人携带的视频采集设备采集视频或图像数据，将数据通过Wifi多跳无线网络传输至机器人控制设备;井下机器人携带有语音采集元件和语音放大设备，通过语音采集元件采集语音信号，通过语音放大设备将通过网络下传的语音数据还原为语音信号放大播放。
[0004]所述系统井下机器人携带有多个无线路由设备，铺设无线网络的方法包括以下3种:
[0005]1.井下机器人在行进过程中监测最近的固定Wifi路由设备信号强度，当信号强度低于设定阈值时，则井下机器人在当前位置投放新的固定Wifi路由设备，重复执行以上监测与投放过程，使Wifi网络的覆盖范围随井下机器人的行进不断推进。
[0006]2.井下机器人在行进过程中测量并记录行进的路程长度，当以最近的固定Wifi路由设备为起点行进的路程长度达到设定阈值时，则在当前位置投放新的固定Wifi路由设备，重复执行以上监测和投放过程，使Wifi网络的覆盖范围随井下机器人的行进路程的增加而不断推进。
[0007]3.井下机器人在行进过程中监测最近的固定Wifi路由设备信号强度，同时测量以最近的固定无线路由设备为起点的行进路程长度，当满足Wifi信号强度低于设定阈值或行进的路程长度达到设定阈值时，则在当前位置投放新的固定Wifi路由设备，重复执行以上监测和投放过程，使Wifi网络的覆盖范围随井下机器人的行进路程的增加而不断推进。所述系统还包括以下特点:
[0008]1.井下机器人采用模块化结构，具有标准通信接口，用于携带各类与井下现场环境监测相关的传感器模块，所采集数据通过多跳无线网络传输至控制设备。
[0009]2.井下机器人携带的传感器包括:温度、一氧化碳、二氧化碳、甲烷和氧气传感器。
[0010]3.机器人控制设备可部署于井上也可部署于井下，井下机器人可受机器人控制设备控制从井上出发移动至井下。
[0011]4.井下机器人包括采用两轴或多轴旋翼飞行移动的机器人。
【附图说明】
[0012]图1系统实施方式I示意图。
[0013]图2系统实施方式2示意图。
[0014]图3四轴旋翼井下机器人结构示意图。
[0015]图4Wifi路由器投放装置示意图。
[0016]图5Wifi路由器投放装置仰视图。
[0017]图6四轴旋翼井下机器人主控板结构示意图。
[0018]图7四轴旋翼井下机器人数据采集板结构示意图。
[0019]图8四轴旋翼井下机器人主控板软件示意图。
[0020]图9Wifi路由投放子系统流程图
【具体实施方式】
[0021]所述通信控制系统的【具体实施方式】I如图1所示，组成包括:
[0022]1.机器人控制设备(101)，负责控制井下机器人，通过多跳Wifi网络和以太网接收井下机器人上传的各类数据，包括视频或图像数据，各类传感器数据、语音数据；同时通过以太网和多跳Wifi网络向井下机器人发送控制数据和语音数据。
[0023]2.井上交换机(102)，负责所有接入以太网的设备的管理和数据交换。
[0024]3.井下交换机(103)，负责井下所有接入以太网的设备的数据交换。
[0025]4.井下机器人(104)，可采用旋翼飞行机器人，也可采用轮式、履带式、蛇形等地面行进的机器人，携带多个Wifi路由设备(106)，用于在行进中投放布网。
[0026]5.Wifi核心交换机(105)，负责多跳Wifi网络的管理，接收和转发所有Wifi路由设备的数据，具有网络接口用于连接井下交换机或井下机器人控制设备。
[0027]6.Wifi路由设备(106)，负责Wifi终端设备的接入和Wifi网络接续，由电池供电，体积小重量轻，便于井下机器人携带，处理器采用Atheros AR7161，无线芯片采用AtherosAR9220。
[0028]所述通信控制系统的【具体实施方式】2如图2所示，与实施方式I的区别在于机器人控制设备(101)直接连接Wifi核心交换机(105)，机器人控制设备可部署于井上也可部署于井下，机器人控制设备部署于井上时，井下机器人可直接通过斜井、平硐飞行至井下。
[0029]所述通信控制系统中的井下机器人可采用飞行机器人也可采用地面行进机器人，在本示例采用四轴旋翼井下机器人，机器人结构如图3所示:
[0030]1.旋翼(301),通过旋转使空气向下运动产生升力，使机器人悬浮在空中。
[0031]2.电机(302)，负责为旋翼提供动力，由控制板控制转速，通过各旋翼不同转速而实现机器人的不同运动方向和姿态。
[0032]3.传感器仓(303)用于放置各种类与井下现场环境监测相关的传感器模块。
[0033]4.天线(304)用于无线信号发送和接收。。
[0034]5.控制板仓(305)内置无人机控制板，用于飞行控制、数据采集和无线通信等。
[0035]6.电池仓(306)用于电池存放，为旋翼、控制板及各传感器模块供电。
[0036]7.麦克风(307)用于语音信号采集，当救援无人机到达井下工作人员被困地点时，可通过麦克风采集被困人员的语音信号，并通过无线网络和以太网将语音数据传送至控制设备。
[0037]8.数字摄像机(308)用于视频信号采集，由将视频信号数字化并编码压缩，通过无线网络和以太网将视频或图像数据传送至控制设备。
[0038]9.舵机(311)为路由设备投放装置提供动力，由控制板发出的脉冲信号控制，根据脉冲信号转动特定角度。
[0039]10.Wifi路由设备存放仓(309)用于Wifi路由设备存放。
[0040]11.转盘(310)用于Wifi路由设备投放控制。
[0041 ]路由设备投放装置结构如图4和图5所示，主要包括Wifi路由设备存放仓(309)和转盘(310)，Wifi路由设备存放仓(309)在上部，底部为带有投放窗口的转盘，舵机(311)的传动轴连接舵盘(312)通过转盘连接孔(317)和螺钉连接在转盘(310)上，舵机带动转盘转动将投放窗口(314)转至Wifi路由设备(106)下方，Wifi路由设备(106)在重力作用下离开存放仓。
[0042]如图6所示为机器人的主控单元，包括:
[0043]1.主控板(601)，是机器人控制的核心部件，板上元件包括核心处理器、存储单元、电源与时钟单元、姿态传感器的电机驱动单元;主控板还通过各类接口连接板外的各模块或功能设备。
[0044]2.核心处理器(602)，采用三星S3C2440处理器，S3C2440是基于ARM920T内核的微处理器，具有3个UART接口，2个SPI接口，2个USB接口，I个IIC-BUS接口 ；搭载Linux系统。
[0045]3.存储单元(603);包括256M NAND Flash、一片4M NOR Flash、128M SDRAM、一片IIC-BUS接口的 EEPR0M。
[0046]4.电源与时钟模块(604)包括电压转换和时钟管理元件，DC电压转换均采用MAX1724系列电源芯片，为所有芯片供电；选用12MHz晶振。
[0047]5.姿态传感器(605)，采用invensense公司的MPU9150，该传感器内部包含三轴陀螺仪、三轴加速度计和一个AK8975三轴磁强计的MEMS器件，具有封装体积小，读写配置方便的优点，MPU-9150内部分别自带了 16位的A/D，将其测量的模拟量，转化为可输出的数字量，