一种基于TSN的遥操作巡检机器人控制系统及控制方法技术方案

本发明专利技术属于机器人和工业互联网领域，具体说是一种基于TSN的遥操作巡检机器人控制系统，包括：上位机、设于机器人本体上的控制器模块、通信模块、电机驱动模块、信息采集模块、导航定位模块、图像识别模块以及存储模块；上位机，用于通过通信模块与控制器模块无线通信，以实现无线操控机器人本体，并接收控制器模块传回的环境数据；控制器模块，通过电机驱动模块控制机器人本体的位姿和机器人本体机械臂的动作；同时，获取信息采集模块实时采集目标区域内的环境数据，并将环境数据通过通信模块回传至上位机；本发明专利技术在操控机器人的过程中，可以改善多种传感器进行数据采集的数据流与操控机器人移动的数据流产生的流量拥塞问题。操控机器人移动的数据流产生的流量拥塞问题。操控机器人移动的数据流产生的流量拥塞问题。

【技术实现步骤摘要】
一种基于TSN的遥操作巡检机器人控制系统及控制方法


[0001]本专利技术属于机器人和工业互联网领域，具体说是一种基于TSN的遥操作巡检机器人控制系统及控制方法。

技术介绍

[0002]作为国民经济的命脉，我国矿产资源的开采工作始终在有条不紊地进行，这些矿产资源为工业生产提供稳定的能源供应，也为科技发展与科学进步提供了有力保障，更是改善国民生活水平的重要物资。矿产资源开采是指固体金属与非金属矿床的开采，包括地表矿体露头及浅部矿体的露天开采和盲矿、深部矿体的地下开采，而地下开采通常需要采集人员深入到幽深的矿洞中进行作业任务，然而频繁发生的矿洞安全事故带来了巨大的生命与财产损失。加强矿洞巡查，实时监测矿洞状态并传递给监控中心，及时发现并排除矿洞安全隐患，将大大减少矿洞安全事故的发生。出于无人则安、少人则安的考虑，我们将矿洞的巡检工作交给远程操控的机器人。远程操控机器人是一种十分有效的解决方案，借助对机器人进行实时、异地远端操控，可以很大程度上保证从业人员的生命安全并且可以有效解放生产力。远程操控机器人的关键性问题是机器人的主从端系统操作一致性和实时性问题，其中包括信号的实时性、稳定性和传输多种信号时发生冲突等技术问题，同时在极端的网络环境下需要保证传输时延可控。
[0003]在现有技术中，专利申请号为201810984133.5的一种基于网络的机器人控制系统，将网络通信模块运用到机器人的远程控制当中，便于使用与开发。专利申请号为201911173667.0的基于STM32的矿井勘测机器人控制系统，对微处理器STM32F103ZET6进行开发，利用STM32接口丰富的特点加装各类传感器的方法，实现矿井机器人异地控制，从而达到监测的目的。专利申请号为202011064929.2的一种基于5G网络的户外勘测机器人控制方法及系统，利用了5G网络的优势，实现了在勘测机器人上运行大流量应用，解决了远程遥控功能单一的问题，改善了勘测机器人的工作过程。
[0004]然而在通信协议方面，一些传统的工业以太网通信协议如PROFINET、Ethernet/IP、EtherCAT、SERCOSIII、CC
‑
Link、POWERLINK等，无法提供同时具备实时性、有界低时延性、可靠性并且兼容性较好的服务。

技术实现思路

[0005]为解决上述问题，本专利技术提供一种基于TSN的遥操作巡检机器人控制系统，充分利用TSN时间敏感网络所具备的低时延、时延有界性等确定性传输特征，从而在保证矿洞巡检机器人主从端操控一致性的同时，操作过程具有确定性的低时延，并且由于TSN这项技术具备的多业务统一承载特性，节约了现场网络布置的成本，为矿洞的巡检工作提供了一种优异、实用且低成本的解决方案。
[0006]本专利技术为实现上述目的所采用的技术方案是：一种基于TSN的遥操作巡检机器人控制系统，包括：上位机、设于机器人本体上的控制器模块、通信模块、电机驱动模块、信息
采集模块、导航定位模块、图像识别模块以及存储模块；
[0007]所述上位机，用于通过通信模块与控制器模块无线通信，以实现无线操控机器人本体，并接收控制器模块传回的环境数据；
[0008]所述控制器模块，用于接收上位机发送的操纵指令，并通过电机驱动模块控制机器人本体的位姿和机器人本体机械臂的动作；同时，获取信息采集模块实时采集目标区域内的环境数据，并将环境数据通过通信模块回传至上位机；
[0009]所述信息采集模块，用于采集目标区域内的环境数据，并反馈至控制器模块；
[0010]所述导航定位模块为北斗导航系统，用于对机器人本体进行定位，并将定位数据发送至控制器模块；
[0011]所述图像识别模块，用于拍摄目标区域的实时图像，并将图像发送至上位机，实现对目标区域内的实时监控；同时，将当前图像发送至存储模块存储，以用于通过控制器模块调用进行地图构建。
[0012]所述信息采集模块，包括：均与控制器模块连接的温湿度传感器、气体浓度传感器、风力传感器、距离传感器、声音传感器以及红外热像仪；
[0013]所述温湿度传感器、气体浓度传感器、风力传感器、距离传感器、声音传感器以及红外热像仪均支持TSN协议；
[0014]所述温湿度传感器，用于测量矿井内环境温度以及矿井主扇轴温的设备温度；
[0015]所述气体浓度传感器，用于测量矿井内甲烷气体的浓度；
[0016]所述风力传感器，用于测量矿井内风速风向；
[0017]所述距离传感器，发送距离数据至图像识别模块进行地图构建；
[0018]所述声音传感器，该传感器内置一对声音敏感的电容式驻极体话筒，通过声波使话筒内的驻极体薄膜振动，导致电容的变化，进而产生与之对应变化的微小电压；
[0019]所述红外热像仪，用于检测矿洞内的热源。
[0020]所述通信模块为支持TSN协议的无线通信模块或TSN交互机。
[0021]所述上位机，包括：远程操纵模块、数据显示模块、数据存储模块以及数据诊断模块；
[0022]所述远程操纵模块，用于向控制器模块发送操纵指令，以实现远程控制机器人本体的位姿和机器人本体机械臂的动作；
[0023]所述数据显示模块，用于对接收控制器模块传输的目标区域内的环境数据进行实时显示；
[0024]所述数据存储模块，用于实时存储控制器模块发送的目标区域内的环境数据；
[0025]所述数据诊断模块，用于判断控制器模块发送的目标区域内的环境数据是否满足预设定的标准值。
[0026]一种基于TSN的遥操作巡检机器人控制系统的控制方法，包括以下步骤：
[0027]1)操作人员通过位于监控中心的上位机创建任务新项目，通过通信模块与矿洞中的机器人建立远程连接；
[0028]2)控制器模块通过信息采集模块采集当前位置的环境数据，并将环境数据回传至上位机的数据显示模块，若数据显示模块显示各类传感器采集的环境数据，则上位机通过通信模块与机器人建立远程连接成功；
[0029]3)上位机的远程操纵模块通过通信模块向控制器模块发送操纵指令，控制器模块根据操纵指令对机器人本体进行远程控制；
[0030]4)机器人本体巡检过程中，控制器模块通过通信模块采用融合SA算法与GA算法的遗传算法，将实时数据发送至上位机，以防止数据传输延迟。
[0031]所述步骤3)，执行以下步骤：
[0032]3‑
1)巡检机器人上的进入矿洞根据操纵指令通过电机驱动模块控制机器人本体的位姿和机器人本体机械臂的动作；
[0033]3‑
2)导航定位模块实时对机器人本体进行定位，并将定位数据经控制器模块发送至上位机；
[0034]3‑
3)信息采集模块实时采集目标区域内的环境数据，并将环境数据通过通信模块回传至上位机；
[0035]3‑
4)图像识别模块实时拍摄目标区域的实时图像，并将图像分别发送至上位机，实现对目标区域内的实时监控；图像识本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于TSN的遥操作巡检机器人控制系统，其特征在于，包括：上位机、设于机器人本体上的控制器模块、通信模块、电机驱动模块、信息采集模块、导航定位模块、图像识别模块以及存储模块；所述上位机，用于通过通信模块与控制器模块无线通信，以实现无线操控机器人本体，并接收控制器模块传回的环境数据；所述控制器模块，用于接收上位机发送的操纵指令，并通过电机驱动模块控制机器人本体的位姿和机器人本体机械臂的动作；同时，获取信息采集模块实时采集目标区域内的环境数据，并将环境数据通过通信模块回传至上位机；所述信息采集模块，用于采集目标区域内的环境数据，并反馈至控制器模块；所述导航定位模块为北斗导航系统，用于对机器人本体进行定位，并将定位数据发送至控制器模块；所述图像识别模块，用于拍摄目标区域的实时图像，并将图像发送至上位机，实现对目标区域内的实时监控；同时，将当前图像发送至存储模块存储，以用于通过控制器模块调用进行地图构建。2.根据权利要求1所述的一种基于TSN的遥操作巡检机器人控制系统，其特征在于，所述信息采集模块，包括：均与控制器模块连接的温湿度传感器、气体浓度传感器、风力传感器、距离传感器、声音传感器以及红外热像仪；所述温湿度传感器、气体浓度传感器、风力传感器、距离传感器、声音传感器以及红外热像仪均支持TSN协议；所述温湿度传感器，用于测量矿井内环境温度以及矿井主扇轴温的设备温度；所述气体浓度传感器，用于测量矿井内甲烷气体的浓度；所述风力传感器，用于测量矿井内风速风向；所述距离传感器，发送距离数据至图像识别模块进行地图构建；所述声音传感器，该传感器内置一对声音敏感的电容式驻极体话筒，通过声波使话筒内的驻极体薄膜振动，导致电容的变化，进而产生与之对应变化的微小电压；所述红外热像仪，用于检测矿洞内的热源。3.根据权利要求1所述的一种基于TSN的遥操作巡检机器人控制系统，其特征在于，所述通信模块为支持TSN协议的无线通信模块或TSN交互机。4.根据权利要求1所述的一种基于TSN的遥操作巡检机器人控制系统，其特征在于，所述上位机，包括：远程操纵模块、数据显示模块、数据存储模块以及数据诊断模块；所述远程操纵模块，用于向控制器模块发送操纵指令，以实现远程控制机器人本体的位姿和机器人本体机械臂的动作；所述数据显示模块，用于对接收控制器模块传输的目标区域内的环境数据进行实时显示；所述数据存储模块，用于实时存储控制器模块发送的目标区域内的环境数据；所述数据诊断模块，用于判断控制器模块发送的目标区域内的环境数据是否满足预设定的标准值。5.根据权利要求1所述的一种基于TSN的遥操作巡检机器人控制系统的控制方法，其特征在于，包括以下步骤：
1)操作人员通过位于监控中心的上位机创建任务新项目，通过通信模块与矿洞中的机器人建立远程连接；2)控制器模块通过信息采集模块采集当前位置的环境数据，并将环境数据回传至上位机的数据显示模块，若数据显示模块显示各类传感器采集的环境数据，则上位机通过通信模块与机器人建立远程连接成功；3)上位机的远程操纵模块通过通信模块向控制器模块发送操纵指令，控制器模块根据操纵指令对机器人本体进行远程控制；4)机器人本体巡检过程中，控制器模块通过通信模块采用融合SA算法与GA算法的遗传算法，将实时数据发送至上位机，以防止数据传输延迟。6.根据权利要求5所述的一种基于TSN的遥操作巡检机器人控制系统的控制方法，其特征在于，所述步骤3)，执行以下步骤：3
‑
1)巡检机器人上的进入矿洞根据操纵指令通过电机驱动模块控制机器人本体的位姿和机器人本体机械臂的动作；3
‑
2)导航定位模块实时对机器人本体进行定位，并将定位数据经控制器模块发送至上位机；3
‑
3)信息采集模块实时采集目标区域内的环境数据，并将环境数据通过通信模块回传至上位机；3
‑
4)图像识别模块实时拍摄目标区域的实时图像，并将图像分别发送至上位机，实现对目标区域内的实时监控；图像识别模块还将当前图像发送至存储模块存储，以用于通过控制器模块调用进行地图构建；3
‑
5)信息采集模块中的距离传感器实时监测巡检机器人与洞穴墙壁之间的距离数据，并存储至存储模块中；3
‑
6)控制机器人本体巡检完毕后，操控机器人返回原点，控制器模块调取存储模块中距离数据与环境数据进行地图构建，得到完整的矿洞建模图；3
‑
7)上位机获取矿洞各处的相应数据以及完整的矿洞建模图，并存储在数据存储模块，同时，通过数据诊断模块对环境数据与预设定的标准值进行对比，将出现不满足预设定标准值的标记在矿洞建模图中。7.根据权利要求6所述的一种基于TSN的遥操作巡检机器人控制系统的控制方法，其特征在于，步骤3
‑
6)中，所述控制器模块调取存储模块中距离数据与环境数据进行地图构建，得到完整的矿洞建模图，具体为：(1)收集距离数据：控制器模块通过安装在移动机器人上的距离传感器获取矿洞内部的距离数据；(2)收集环境数据：使用各类环...

【专利技术属性】
技术研发人员：郭暂明，崔龙，刘钊铭，王宏伟，许伟，缪磊，田申，白宁，张峰，王上，郭鑫，
申请(专利权)人：中国科学院沈阳自动化研究所，
类型：发明
国别省市：