一种矿用环境探测机器人控制装置制造方法.docx

一种矿用环境探测机器人控制装置制造方法一种矿用环境探测机器人控制装置制造方法本实用新型涉及一种矿用环境探测机器人控制装置，所述以太网网络服务器的光纤端口与中继模块相连通，以太网网络服务器的天线接口与前向天线相连接；以太网网络服务器的三个PoE口分别连接着机头网络摄像机、机尾前向网络摄像机及机尾后向网络摄像机，以太网网络服务器的三个RJ45端口分别连接着运动控制板、数据采集板及音频对讲模块；所述音频对讲模块与本安对讲系统相连通该控制系统集成能力强、可扩展性好，有利于实现机电一体化，减少装载空间，并且也有利于系统的移植，缩短开发周期，降低开发成本；可以快速的响应环境动态变化，从而适应非结构化环境，并可以满足多机器人系统的协作专利说明】一种矿用环境探测机器人控制装置【技术领域】[0001]本实用新型涉及一种机器人控制装置，尤其是控制机器人进入矿井瓦斯爆炸灾害现场进行环境探测的一种矿用环境探测机器人控制装置背景技术】[0002]矿用环境探测机器人是代替救护队员对灾害后煤矿井下环境进行探测的设备矿用环境探测机器人属于危险作业机器人的一种，为适应非结构化环境，危险作业机器人应该是一种具有环境认知、行为决策、运动控制等能力的智能移动机器人。

而机器人控制装置是根据指令以及传感信息控制机器人完成以上功能的装置，是机器人的关键部件[0003]矿用环境探测机器人一般由救援人员搬运至灾害现场，因此重量要求轻还要考虑防爆要求增加的负载正常工作的矿井系统是根据地质特点与生产需要，按照一定的标准设计建设的，属于结构化环境，并且从结构上可分为竖井、巷道、回采工作面三类矿井系统的空间非常狭窄，随着矿井服务年限的增加，环境也会发生变化，从而变成了非结构化环境煤矿发生瓦斯和煤尘爆炸后，爆炸冲击波所波及到的巷道、工作面会受到不同程度的破坏事故后的工作环境是由事故后对煤矿系统结构有影响的部分和事故后对煤矿工作环境无影响的部分组成，后者与正常工作的环境结构一致，并且，事故后的工作环境的非几何特征(如温度、风向、风速、瓦斯含量等)也发生了变化，瓦斯爆炸也会破坏供排水系统造成局部积水矿井通信条件恶劣，矿井无线信号传输衰减大，发射功率受到限制，采用有线方式，会增加机器人的负载因此，矿井环境对机器人来说是一种复杂的、多样的非结构环境机器人主要依靠电池供电，并且应用于煤矿井下的电池种类有限，像比能量高的锂电池至今不允许用于煤矿井下，在重量限制下，所携带的电池有限，因此提供的能量也是有限的。

[0004]作为矿用环境探测机器人关键部件的控制装置，为适应以上非结构化环境，需要满足以下性能要求:低功耗，体积小，重量轻，减少防爆结构的负载，从而使机器人的负载减轻，提高续航能力；有集成能力强、可扩展性好，有利于实现机电一体化，减少装载空间，并且也有利于系统的移植，缩短开发周期，降低开发成本；采用实时多任务系统实时系统可以快速的响应环境动态变化，从而适应非结构化环境；多任务处理方式可以充分利用计算能力；具有网络通信功能，满足多机器人系统的协作[0005]目前，国内已经研发多款矿用环境探测机器人控制装置主要有以下几种:[0006]基于工控机的闭式控制体系结构以功能较强、结构紧凑、可靠性高的工控机为核心，采用集中控制方式，通过采集卡采集各种数据，并通过I/o控制机器人驱动器由于工控机的硬件多为固定的标准结构，因此不能灵活布置工控机的功耗一般很高，热量释放较多机器人为了防爆、防水，多采用密封设计，因此散热困难采用闭式结构，专用性很强，扩展性不高改变功能时，需要重新设计控制体系结构[0007]复合式体系结构采用慎思方式分布式控制装置具有较好的开放性和扩展性，是实现智能机器人控制体系结构理想的途径，可以满足对非结构环境进行建模与规划，并运用反应式行为来克服执行过程中动态变化的不确定性，具有较强的功能与应用灵活性。

但PLC的实时性不高，不能进行多任务的处理，难以实现智能控制PLC的体积也较大，不便于布置[0008]基于工控机的分布式控制体系结构以工控机为主控制器，各个模块之间采用总线方式通信这种控制体系结构集成能力强、可扩展性好但上述控制体系结构由于采用工控机，存在与基于工控机的闭式控制体系结构的功耗问题[0009]综上所述，目前没有一种矿用环境探测机器人控制装置能够完全满足要求所以需要针对矿用环境探测机器人的特殊需求开发一套控制装置实用新型内容[0010]为了解决现有的矿用环境探测机器人控制装置功耗高、体积大，防爆结构负载大且开发成本高的问题，本实用新型提供一种矿用环境探测机器人控制装置，该控制装置采用基于以太网的分布式结构，有集成能力强、可扩展性好，有利于实现机电一体化，减少装载空间，并且也有利于系统的移植，缩短开发周期，降低开发成本；采用高性能的32位微控制器嵌入式系统作为运用控制器和数据采集器，低功耗，体积小，重量轻，减少防爆结构的负载，从而使机器人的负载减轻，提高续航能力；采用实时多任务系统，可以快速的响应环境动态变化，从而适应非结构化环境，多任务处理方式可以充分利用计算能力；基于以太网和无线WLAN网的网络通信功能，满足多机器人系统的协作。

采用以太网供电技术(PoE)可以实现数据和直流电源同时通过网线传输，简化布线，设备布置更加灵活[0011]本实用新型解决其技术问题所采用的技术方案是:该控制装置包括前向天线、机头网络摄像机、机尾前向网络摄像机、机尾后向网络摄像机、中继模块、以太网网络服务器、运动控制板、数据采集板、音频对讲模块、本安对讲系统、风速传感器、气体传感器、避障传感器、位姿传感器、电机1、驱动器1、驱动器II及电机II ;所述以太网网络服务器是可以实现以太网供电(PoE)的八口交换机，以太网网络服务器的光纤端口通过光纤跳线①与中继模块相连通，以太网网络服务器的天线接口通过网线②与前向天线相连接，从而组成通信系统，通过前向天线与前面的机器人中继模块建立无线WLAN连接，通过中继模块与后面的机器人的前向天线建立无线WLAN连接；以太网网络服务器的三个PoE 口依次通过网线③、网线④及网线⑤分别连接着机头网络摄像机、机尾前向网络摄像机及机尾后向网络摄像机，从而为机头网络摄像机、机尾前向网络摄像机及机尾后向网络摄像机提供工作电源，同时三个网络摄像机的视频信号通过网线传输到通信网络中，以太网网络服务器的三个RJ45端口依次通过网线⑥、网线⑦及网线⑧分别连接着运动控制板、数据采集板及音频对讲模块，所述运动控制板和数据采集板以高性能的32位STM微控制器嵌入式系统为核心，32位微控制器集成网络接口 ；所述数据采集板的RS485端口通过485总线⑩与位姿传感器、避障传感器、气体传感器及风速传感器相连，从而采集各个传感器的数据，经过以太网网络服务器传送到网络上；所述音频对讲模块由KXY12矿用浇封兼本安型音箱、ZYF127-M矿用本安型麦克风及E702T型网络音频传输模块组成，所述音频对讲模块的音频接口通过音频线⑨与本安对讲系统相连通，将机器人采集的音频信号转变为网络信号，将上位机经以太网传送过来的音频信号转变为声音，从而实现控制终端操作人员与幸存人员的对讲功能；运动控制板的RS232端口通过串口线I与驱动器I相连，驱动器I通过电缆线III与电机I相连，驱动器I与驱动器II之间通过CAN总线II相连接，驱动器II通过电缆线IV连接着电机II，从而实现对电机I及电机II的控制。

[0012]所述机头网络摄像机、机尾前向网络摄像机及机尾后向网络摄像机的型号为DS-2⑶2012-1 ;所述以太网网络服务器的型号为TL-SF1008P ;所述风速传感器的型号为GFff15 ;所述气体传感器的型号为CD8 ;所述位姿传感器的型号为AHRS1000[0013]本实用新型的有益效果是，该控制装置采用基于以太网的分布式结构，有集成能力强、可扩展性好，有利于实现机电一体化，减少装载空间，并且也有利于系统的移植，缩短开发周期，降低开发成本；采用高性能的32位微控制器嵌入式系统作为运用控制器和数据采集器，低功耗，体积小，重量轻，减少防爆结构的负载，从而使机器人的负载减轻，提高续航能力；采用实时多任务系统，可以快速的响应环境动态变化，从而适应非结构化环境，多任务处理方式可以充分利用计算能力；基于以太网和无线WLAN网的网络通信功能，满足多机器人系统的协作采用以太网供电技术(PoE)可以实现数据和直流电源同时通过网线传输，简化布线，设备布置更加灵活专利附图】【附图说明】[0014]下面结合附图和实施例对本实用新型作进一步说明[0015]图1是本实用新型的结构原理示意图[0016]图1中，1.前向天线，2.机头网络摄像机，3.机尾前向网络摄像机，4.机尾后向网络摄像机，5.中继模块，6.以太网网络服务器，7.运动控制板，8.数据采集板，9.音频对讲模块，10.本安对讲系统，11.风速传感器，12.气体传感器，13.避障传感器，14.位姿传感器，15.电机I , 16.驱动器I，17.驱动器II，18.电机II。

具体实施方式】[0017]在图1中，该控制装置包括前向天线1、机头网络摄像机2、机尾前向网络摄像机3、机尾后向网络摄像机4、中继模块5、以太网网络服务器6、运动控制板7、数据采集板8、音频对讲模块9、本安对讲系统10、风速传感器11、气体传感器12、避障传感器13、位姿传感器14、电机I 15、驱动器I 16、驱动器II 17及电机II 18 ;所述以太网网络服务器6是可以实现以太网供电(PoE)的八口交换机，以太网网络服务器6的光纤端口通过光纤跳线①与中继模块5相连通，以太网网络服务器6的天线接口通过网线②与前向天线I相连接，从而组成通信系统，通过前向天线I与前面的机器人中继模块建立无线WLAN连接，通过中继模块5与后面的机器人的前向天线建立无线WLAN连接；以太网网络服务器6的三个PoE 口依次通过网线③、网线④及网线⑤分别连接着机头网络摄像机2、机尾前向网络摄像机3及机尾后向网络摄像机4，从而为机头网络摄像机2、机尾前向网络摄像机3及机尾后向网络摄像机4提供工作电源，同时三个网络摄像机的视频信号通过网线传输到通信网络中，以太网网络服务器6的三个RJ45端口依次通过网线⑥、网线⑦及网线⑧分别连接着运动控制板7、数据采集板8及音频对讲模块9，所述运动控制板7和数据采集板8以高性能的32位STM微控制器嵌入式系统为核心，32位微控制器集成网络接口 ；所述数据采集板8的RS485端口通过485总线⑩与位姿传感器14、避障传感器13、气体传感器12及风速传感器11相连，从而采集各个传感器的数据，经过以太网网络服务器6传送到网络上；所述音频对讲模块9由KXY12矿用浇封兼本安型音箱、ZYF127-M矿用本安型麦克风及E702T型网络音频传输模块组成，所述音频对讲模块9的音频接口通过音频线⑨与本安对讲系统10相连通，将机器人采集的音频信号转变为网络信号，将上位机经以太网传送过来的音频信号转变为声音，从而实现控制终端操作人员与幸存人员的对讲功能；运动控制板7的RS232端口通过串口线I与驱动器I 16相连，驱动器I 16通过电缆线III与电机I 15相连，驱动器I 16与驱动器II 17之间通过CAN总线II相连接，驱动器II 17通过电缆线IV连接着电机II 18，从而实现对电机I 15及电机II 18的控制。

[0018]所述机头网络摄像机2、机尾前向网络摄像机3及机尾后向网络摄像机4的型号为DS-2⑶2012-1 ;所述以太网网络服务器6的型号为TL-SF1008P;所述风速传感器11的型号为GFW15 ;所述气体传感器12的型号为CD8 ;所述位姿传感器14的型号为AHRS1000权利要求】1.一种矿用环境探测机器人控制装置，该控制装置包括前向天线(I)、机头网络摄像机(2)、机尾前向网络摄像机(3)、机尾后向网络摄。