[发明专利]矿用皮带运输机巡检机器人控制系统和控制方法

说明书

技术领域

本发明涉及设备运行状态监测领域，具体的说是一种矿用皮带运输机巡检机器人控制系统和控制方法。

背景技术

在煤炭生产过程中，皮带运输机作为重要的煤炭运输设备，应用十分广泛，然而在皮带运输机运行过程中，容易发生托辊损坏、皮带断裂、纵撕、跑偏等事故，造成设备甚至人员的重大损失。由于皮带运输机的工作环境恶劣、照明差，不利于巡检人员巡视和及时发现问题。因此，利用矿用皮带运输机巡检机器人，代替巡检人员完成对皮带运输机运行状态的监测非常必要，如何利用皮带运输机巡检机器人对皮带运输机工作中的各种数据进行采集及监控，是本发明专利研究和解决的问题。

发明内容

本发明的目的是为矿用皮带运输机巡检机器人提供一种控制系统和控制方法，利用皮带运输机巡检机器人装置，实时采集皮带运输机运行中的各种数据信息，及时发现皮带运输机工作过程中产生的问题，发现故障时及时报警处理，为皮带运输机安全生产提供保障。

本发明采用的技术方案是：一种矿用皮带运输机巡检机器人控制系统和控制方法，其特征在于：该控制系统由PLC控制箱和皮带运输机巡检机器人装置构成，PLC控制箱包括：西门子S7-200CN系列PLC、轴编码器、PC显示器、防爆开关、停车开关、过卷限位开关；皮带运输机巡检机器人装置包括：机器人本体、音频传感器、烟雾传感器、红外温度传感器一、红外温度传感器二、摄像机一、摄像机二、摄像机三。

音频传感器、烟雾传感器、红外温度传感器以及摄像机安装在机器人本体上，负责采集皮带机工作环境中的声音、烟雾、温度以及视频图像信号，其输出的数据信息被编码压缩后，通过无线通讯的方式传送到PLC控制箱；轴编码器、防爆开关、停车开关和过卷限位开关的信号通过输入/输出接口与PLC相连，PLC与PC显示器通过工业以太网方式相连。

所述PLC控制箱通过系统控制软件实现皮带运输机巡检机器人系统的控制功能，系统控制软件采用模块化程序设计且包括：音视频控制程序模块、机器人本体牵引系统控制程序模块、皮带机运行控制程序模块和中断程序模块。

所述音视频控制程序模块包括录像、静音、图像切换、PC关机/重启、摄像机前转和后转功能。录像功能控制机器人本体采集现场的图像和声音并存储到硬盘指定路径文件；静音功能控制机器人本体采集的现场声音的播放；图像切换功能控制三路视频图像的显示；PC关机/重启功能控制显示界面系统的关机和重启；摄像机前、后转功能控制机器人本体的第三路摄像机的视频采集角度。

所述机器人本体牵引系统控制程序模块用来控制牵引系统带动机器人本体运行，实现皮带机沿线的往复巡检，采集现场数据。

所述皮带机运行控制程序模块完成控制皮带机的运行，当采集现场的温度或者烟雾数据超限报警时，紧急控制皮带机停车，也可手动控制皮带机急停。

所述中断程序模块通过采集轴编码器转动方向，实时获取机器人本体的实际运行方向。

本发明还提供一种矿用皮带运输机巡检机器人控制系统的控制方法，具体步骤如下：

步骤一：首先初始化各寄存器，进行中断参数设置，设置时基中断并使能，关联中断程序，初始化高速计数器和以太网模块；

步骤二：进行输入信号的采集，将采集到的各输入信号读取到过程映像输入寄存器中；

步骤三：根据输入信号的不同转入相应功能的程序模块。

步骤四：执行完各部分功能程序模块后，刷新过程映像输出寄存器，输出结果；

步骤五：判断PLC是否停止运行，如果PLC停止运行，则程序退出；否则，返回到步骤二进行输入信号的采集，并循环执行以上步骤。

在程序循环执行的任意点，当定时时间到，则触发中断，执行关联中断程序，通过采集轴编码器转动方向，实时获取机器人本体的实际运行方向。

步骤三中所述的功能程序模块包括：音视频控制程序模块、机器人本体牵引系统控制程序模块、皮带机运行控制程序模块。

本发明提供的技术方案产生的有益效果是：矿用皮带机巡检机器人控制系统配置了多路传感器，对各路传感器输入信号进行分析判断，进而给出相应的开车、停车控制和报警信号，保证机器人本体牵引系统的安全可靠运行。当机器人本体采集的烟雾浓度、温度超过程序中设定的烟雾和温度保护时，系统输出皮带机控制保护信号，紧急停车，防止事故进一步扩大，保证皮带机的安全运行。

附图说明

图1是矿用皮带运输机巡检机器人控制系统组成示意图。

图2是矿用皮带运输机巡检机器人控制程序流程图。

具体实施方式