掘进机截割路径规划方法、装置及掘进机截割控制系统

摘要

本发明公开了一种煤矿用掘进机截割路径规划方法、装置及掘进机截割控制系统，首先建立掘进工作面在大地坐标系下的三维模型；然后获取掘进机的空间位置信息、方位角、位姿信息及各油缸的位移信息，计算掘进机截割头在大地坐标系下的坐标；将掘进机截割头的坐标与掘进工作面的三维模型相结合，根据巷道断面的大小、形状以及煤岩的分布情况和性质，确定掘进机的截割方式、截割头的运动路径和速度；根据掘进机的空间位置变化，调整截割头的运动路径，判断掘进机截割头的截割效果，修正截割头的速度。本发明能够根据掘进机的位置变化和掘进工作面的岩壁硬度变化自动调整截割头的运动路径和速度。