一种掘进机行进与截割的控制系统及控制方法技术方案

本发明专利技术公开了一种掘进机行进与截割的控制系统及控制方法，涉及机械自动化技术领域，四个第一超声波距离传感器分别安置在掘进机机身的两侧，并根据四个第一超声波距离传感器测得的数据判断掘进机的航向角，里程计和双轴倾角传感器安置在掘进机机身上端，多源激光发射器和摄像头分别安置在掘进机机体上方，进而可以自动完成掘进机机身的位姿检测和定位工作、截割头的位姿检测和截割头截割轨迹规划工作，解决了传统指向激光常出现的超挖、欠挖且无法保证工作人员人身安全的问题和现有位姿检测和定位技术手段需要不断人工调整相关设备或易受环境影响的问题。备或易受环境影响的问题。备或易受环境影响的问题。

【技术实现步骤摘要】
一种掘进机行进与截割的控制系统及控制方法


[0001]本专利技术涉及机械自动化
，尤其涉及一种掘进机行进与截割的控制系统及控制方法。

技术介绍

[0002]随着机械自动化行业的发展，自动化技术应用领域越来越广。为了满足近年来提出的增加煤炭产量，减少工人数量的要求，自动化技术愈来愈多的应用在煤矿机械上。掘进工作面尚未安置永久支护，严重威胁到工作人员的生命安全，掘进机作为井下的主要掘进设备，实现其自动化可以提高掘进工作效率，减少工作人员数量，而且对保证施工安全具有重要意义。
[0003]现在，掘进作业时主要采用指向激光对掘进机进行导航，掘进质量完全由现场环境和操作工人的熟练程度决定。而且，在掘进过程中，需要不断的人工调整指向激光的位置，工作效率底下。现在提出的一些技术手段，例如十字激光、图像识别等都由于需要不断挪动装置位置或者受环境影响，均不能理想的工作效果。

技术实现思路

[0004]本专利技术提供一种掘进机行进与截割的控制系统及控制方法，旨在实现自动完成掘进机的位姿检测和定位，并自动控制截割头部分连续完成岩壁的截割工作。
[0005]本专利技术提供的具体技术方案如下：
[0006]第一方面，本专利技术提供的一种掘进机行进与截割的控制系统包括第一超声波距离传感器、里程计、多源激光发射器、双轴倾角传感器、处理器、摄像头、第二超声波距离传感器和截割头驱动液压，其中，四个第一超声波距离传感器分别安置在掘进机机身的两侧，并根据四个第一超声波距离传感器测得的数据判断掘进机的航向角，里程计和双轴倾角传感器安置在掘进机机身上端，多源激光发射器和摄像头分别安置在掘进机机体上方。
[0007]可选的，截割头驱动液压上安装有磁致伸缩距离传感器，截割臂转轴上设置有角度传感器，磁致伸缩距离传感器和角度传感器相互配合实现截割头的位姿检测和定位。
[0008]可选的，第一超声波距离传感器、里程计、第二超声波距离传感器和双轴倾角传感器相互配合实现掘进机的位姿检测和定位。
[0009]可选的，两个第二超声波距离传感器安装在掘进机机身设备箱左右两侧，第二超声波距离传感器面向待截割岩壁安装，第二超声波距离传感器用于测量掘进机与待掘进岩壁之间的距离和角度。
[0010]可选的，四个第一超声波距离传感器分别安装在掘进机机身两侧的前后端，四个第一超声波距离传感器的测量参数用于计算掘进机的航向角。
[0011]可选的，双轴倾角传感器用于掘进机的俯仰角和翻滚角，多源激光发射器上设置有第一倾角传感器和第二倾角传感器。
[0012]第二方面，本专利技术还提供一种掘进机行进与截割的控制方法，所述控制方法采用
如所述权利要求第一方面所述的掘进机行进与截割的控制系统，所述控制方法包括：
[0013]在截割头对岩壁进行掘进作业时，由安置在掘进机截割头驱动液压缸中的六个磁致伸缩传感器和安置在截割臂转轴度上的角度传感器实时获取掘进机截割头的位姿信息，实现对截割过程的监控；
[0014]截割头走过本次规划的所有轨迹后，掘进机更换位置，通过两个第二超声波测距传感器继续测量掘进机与岩壁之间的距离和角度，结合掘进机的位姿信息继续对截割头进行轨迹规划；
[0015]当截割头走完所规划的全部轨迹后，由摄像头识别岩壁是否清楚干净，若没有清除干净，则规划轨迹后继续清除剩余部分；
[0016]当前截割工作完成后，掘进机继续移动，根据其位姿、机身到墙壁的距离和激光落点继续规划截割头轨迹，重复截割工作；
[0017]多源激光器在倾角传感器的辅助下自动补偿掘进机俯仰角和翻滚角的变化，使激光依然以原角度出射，进而掘进机根据指令自动掘进弯道。
[0018]可选的，所述当前截割工作完成后，掘进机继续移动，根据其位姿、机身到墙壁的距离和激光落点继续规划截割头轨迹，具体包括：
[0019]当前截割工作完成后，掘进机继续移动，根据掘进的位姿参数调整激光发射器的俯仰角和翻滚角，使发射器位姿自适应掘进机位姿；
[0020]当需要水平掘进巷道时，按1：1补偿掘进机俯仰角，当需要掘进斜坡时，改变补偿系数；
[0021]激光发射器仅改变俯仰角和翻滚角，当控制掘进机改变航向角时，激光跟随一起运动，以相同的形状照射在不同角度的岩壁上；
[0022]根据掘进机到岩壁的距离和与岩壁之间的夹角和利用图像识别技术得到的激光落点的具体位置继续规划截割头轨迹。
[0023]本专利技术提供的一种掘进机行进与截割的控制系统及控制方法，四个第一超声波距离传感器分别安置在掘进机机身的两侧，并根据四个第一超声波距离传感器测得的数据判断掘进机的航向角，里程计和双轴倾角传感器安置在掘进机机身上端，多源激光发射器和摄像头分别安置在掘进机机体上方，进而可以自动完成掘进机机身的位姿检测和定位工作、截割头的位姿检测和截割头截割轨迹规划工作，解决了传统指向激光常出现的超挖、欠挖且无法保证工作人员人身安全的问题和现有位姿检测和定位技术手段需要不断人工调整相关设备或易受环境影响的问题。
附图说明
[0024]为了更清楚地说明本专利技术实施例中的技术方案，下面将对实施例描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本专利技术的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
[0025]图1为本专利技术实施例的一种掘进机行进与截割的控制系统的结构示意图；
[0026]图2为本专利技术实施例的一种掘进机行进与截割的控制系统安装位置示意图；
[0027]图3本专利技术实施例的一种多源激光发射器的激光落点示意图；
[0028]图4为本专利技术实施例的一种多源激光发射器的结构示意图；
[0029]图5为本专利技术实施例的一种掘进机行进与截割的控制方法的流程示意图；
[0030]图6为本专利技术实施例的一种掘进机行进与截割的控制系统的结构示意图。
具体实施方式
[0031]为了使本专利技术的目的、技术方案和优点更加清楚，下面将结合附图对本专利技术作进一步地详细描述，显然，所描述的实施例仅仅是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例，都属于本专利技术保护的范围。
[0032]下面将结合图1～图6对本专利技术实施例的一种掘进机行进与截割的控制系统及控制方法进行详细的说明。
[0033]为了解决传统指向激光常出现的超挖、欠挖且无法保证工作人员人身安全的问题和现有的部分技术手段需要不断人工调整相关设备或易受环境影响的问题，本专利技术提出了一种掘进机行进与截割的控制系统及控制方法，主要用于自动完成掘进机机身的位姿检测和定位工作、截割头的位姿检测和截割头截割轨迹规划工作。
[0034]参考图1～图6所示，本专利技术实施例提供的一种掘进机行进与截割的控制系统包括第一超声波距离传感器1、里程计2、多源激光发射器3、双轴倾角传感器4、处理器5、摄像头6、第本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种掘进机行进与截割的控制系统，其特征在于，所述控制系统包括第一超声波距离传感器、里程计、多源激光发射器、双轴倾角传感器、处理器、摄像头、第二超声波距离传感器和截割头驱动液压，其中，四个第一超声波距离传感器分别安置在掘进机机身的两侧，并根据四个第一超声波距离传感器测得的数据判断掘进机的航向角，里程计和双轴倾角传感器安置在掘进机机身上端，多源激光发射器和摄像头分别安置在掘进机机体上方。2.根据权利要求1所述的掘进机行进与截割的控制系统，其特征在于，截割头驱动液压上安装有磁致伸缩距离传感器，截割臂转轴上设置有角度传感器，磁致伸缩距离传感器和角度传感器相互配合实现截割头的位姿检测和定位。3.根据权利要求1所述的掘进机行进与截割的控制系统，其特征在于，第一超声波距离传感器、里程计、第二超声波距离传感器和双轴倾角传感器相互配合实现掘进机的位姿检测和定位。4.根据权利要求1所述的掘进机行进与截割的控制系统，其特征在于，两个第二超声波距离传感器安装在掘进机机身设备箱左右两侧，第二超声波距离传感器面向待截割岩壁安装，第二超声波距离传感器用于测量掘进机与待掘进岩壁之间的距离和角度。5.根据权利要求1或4所述的掘进机行进与截割的控制系统，其特征在于，四个第一超声波距离传感器分别安装在掘进机机身两侧的前后端，四个第一超声波距离传感器的测量参数用于计算掘进机的航向角。6.根据权利要求5所述的掘进机行进与截割的控制系统，其特征在于，双轴倾角传感器用于掘进机的俯仰角和翻滚角，多源激光发射器上设置有第一倾角传感器和第二倾角传感器。7.一种掘进机行进与截割的控制方法，其特征在于...

【专利技术属性】
技术研发人员：刘亚，黄梁松，孙凌飞，杜明超，杨木易，张坤，余铜柱，苏立堂，张代祥，孙政贤，李玉霞，
申请(专利权)人：山东科技大学，
类型：发明
国别省市：