掘进机行走路径规划方法、装置及掘进机行走控制系统制造方法及图纸

本发明专利技术公开提供了一种掘进机行走路径规划方法、装置及掘进机行走控制系统，首先建立掘进工作面巷道在大地坐标系下的三维模型；根据掘进机的自身尺寸数据，建立掘进机的三维模型；获取掘进机的空间位置信息，计算掘进机在大地坐标系下的坐标；获取掘进机的方位角；基于掘进机在大地坐标系下的坐标和掘进机的方位角，将掘进机的三维模型与掘进工作面巷道的三维模型相结合，实时模拟掘进机的行走路径；根据所模拟的掘进机行走路径与设置的掘进机行走路径的偏移量，调整掘进机的行走方向和速度。本发明专利技术能够自动控制掘进机按照规划好的行走路径自动行走。

【技术实现步骤摘要】
掘进机行走路径规划方法、装置及掘进机行走控制系统
本公开涉及煤矿机械领域，具体涉及一种掘进机行走路径规划方法、装置及掘进机行走控制系统。
技术介绍
煤矿用掘进机的行走路径主要有履带行走的前向掘进、后退收煤、左右位姿调整等多自由度空间运动。目前煤矿掘进机普遍采用人工通过掘进机上操作手柄或者通过遥控器控制掘进机进行行走，掘进机行走完全依靠人工进行控制，无法实现掘进机在巷道内自动行走。综上所述，目前对于煤矿用掘进机行走路径完全依靠人工目测现场控制，不能实现掘进机在巷道内自动行走的问题，尚缺乏有效的解决方案。
技术实现思路
针对目前煤矿用掘进机行走路径完全依靠人工目测现场控制，不能实现掘进机在巷道内自动行走的问题，本公开提供了一种掘进机行走路径规划方法、装置及掘进机行走控制系统，能够自动控制掘进机按照规划好的行走路径自动行走。本公开所采用的技术方案是：一种掘进机行走路径规划方法，该方法包括以下步骤：建立掘进工作面巷道在大地坐标系下的三维模型；根据掘进机的自身尺寸数据，建立掘进机的三维模型；获取掘进机的空间位置信息，计算掘进机在大地坐标系下的坐标；获取掘进机的方位角；基于掘进机在大地坐标系下的坐标和掘进机的方位角，将掘进机的三维模型与掘进工作面巷道的三维模型相结合，实时模拟掘进机的行走路径；根据所模拟的掘进机行走路径与设置的掘进机行走路径的偏移量，调整掘进机的行走方向和速度。进一步的，所述掘进工作面巷道在大地坐标系下的三维模型的建立方法为：建立属性数据库和空间数据库，获取掘进工作面的钻孔数据、三维地震数据和物探数据，并存储到属性数据库中；获取物探区的地理分布、钻孔的地理位置及巷高、巷宽等数据，存储到空间数据库中；根据属性数据库中的钻孔数据确定掘进工作面巷道的采掘工程平面图；采用ArcEngine三维控件，并结合OpenGL技术，以采掘工程平面图、属性数据库和空间数据库为基础，建立掘进工作面巷道在大地坐标系下的三维模型。进一步的，获取掘进机在掘进工作面巷道内的空间位置信息以及掘进机的方位角信息；根据掘进机在掘进工作面巷道内的空间位置信息，计算掘进机在大地坐标系下的坐标。进一步的，所述掘进机的三维模型建立方法为：获取掘进机的型号，适应的巷道，主要的结构部件型号以及各部件参数，旋转角度以及摆动幅度信息；利用上述获取的信息，结合截割头、悬臂、铲板齿轮、输送机的选型和布置方式，使用autoCAD分别绘制出掘进机的本体部、截割部、输送机、载装机构、行走机构和后支撑机构的结构图；根据结构图使用三维建模中的表面造型、实体造型和.net二维绘画分别绘制出掘进机各机构的三维实体模型。进一步的，所述掘进机的行走方向和速度的调整方法为：将模拟的掘进机的行走路径与设置的掘进机行走路径相比较；若模拟的掘进机的行走路径与设置的掘进机的行走路径发生偏移，根据偏移量，计算掘进机的位置变化量和方位角变化量；利用掘进机的位置变化量和方位角变化量，计算掘进机的行走方向和速度的修正量；利用修正量调整掘进机的行走方向和速度，使掘进机按照规划好的行走路径自动行走。一种掘进机行走路径规划装置，该装置包括处理器、存储器和通信接口，所述处理器、所述存储器和所述通信接口通信总线相连；所述通信接口，用于接收掘进机的空间位置信息和方位角信息；所述存储器，用于存储程序代码；所述处理器，用于读取所述存储器中存储的程序代码，并执行如下步骤：建立掘进工作面巷道在大地坐标系下的三维模型；根据掘进机的自身尺寸数据，建立掘进机的三维模型；获取掘进机的空间位置信息，计算掘进机在大地坐标系下的坐标；获取掘进机的方位角；基于掘进机在大地坐标系下的坐标和掘进机的方位角，将掘进机的三维模型与掘进工作面巷道的三维模型相结合，实时模拟掘进机的行走路径；根据所模拟的掘进机行走路径与设置的掘进机行走路径的偏移量，调整掘进机的行走方向和速度。一种掘进机行走控制系统，其特征是，包括：掘进机行走路径规划装置，还包括：控制器；掘进机行走路径规划装置与控制器连接，接收控制器发送的掘进机的空间位置信息和方位角信息，并执行如上所述的掘进机行走路径规划方法；所述控制器接收掘进机行走路径规划装置反馈的掘进机的行走方向和速度的修正量，调整掘进机的行走方向和速度，使掘进机按照规划好的行走路径自动行走。进一步的，还包括与控制器连接的伺服比例阀，控制器根据行走速度的修正量，通过伺服比例阀分别调节液压泵给两台液压马达提供的油量，通过两台液压马达控制两条履带动作。进一步的，当通过伺服比例阀分别调节液压泵给两台液压马达提供的油量相同时，两台液压马达控制两条履带同步行走；当通过伺服比例阀分别调节液压泵给两台液压马达提供的油量不同时，两台液压马达控制两条履带不同步，实现转弯。进一步的，当通过伺服比例阀分别调节液压泵给两台液压马达提供的油量大于阈值时，调整掘进机的行走速度变大；当通过伺服比例阀分别调节液压泵给两台液压马达提供的油量小于阈值时，调整掘进机的行走速度减小。本公开的有益效果是：(1)本公开实现了掘进机按照规划好的行走路径自动行走，解决了目前煤矿井下掘进机行走路径完全依靠人工目测现场控制，不能实现掘进机在巷道内自动行走的问题，为掘进机的智能控制奠定了基础；(2)本公开通过模拟掘进机的行走路径，将其与规划好的行走路径相比较，来调整掘进机的行走方向和速度，从而自动控制掘进机按照规划好的行走路径自动行走。附图说明构成本公开的一部分的说明书附图用来提供对本公开的进一步理解，本公开的示意性实施例及其说明用于解释本公开，并不构成对本公开的不当限定。图1是掘进机行走路径规划方法流程图；图2是掘进机行走路径规划装置结构框图；图3是掘进机行走控制系统结构框图。具体实施方式应该指出，以下详细说明都是例示性的，旨在对本公开提供进一步的说明。除非另有指明，本文使用的所有技术和科学术语具有与本公开所属
的普通技术人员通常理解的相同含义。需要注意的是，这里所使用的术语仅是为了描述具体实施方式，而非意图限制根据本公开的示例性实施方式。如在这里所使用的，除非上下文另外明确指出，否则单数形式也意图包括复数形式，此外，还应当理解的是，当在本说明书中使用术语“包含”和/或“包括”时，其指明存在特征、步骤、操作、器件、组件和/或它们的组合。一种或多种实施例提供了一种煤矿用的掘进机行走路径规划方法，如图1所示，该方法包括以下步骤：步骤S101，建立掘进工作面巷道在大地坐标系下的三维模型。根据掘进工作面的采掘工程平面图、钻孔数据、三维地震数据及物探数据，建立掘进工作面巷道的三维模型。掘进工作面巷道是在地表与矿体之间钻凿出的各种通路，用来运矿、通风、排水、行人以及为采矿设备采出矿石新开凿的各种必要准备工程等。其中，采掘工程平面图是反映开采煤层或开采分层内采掘工程现状及采掘计划和地质资料的综合性图纸，是煤矿生产建设中最基本最重要的图纸；煤矿采掘工程平面图是将开采煤层或其分层内的采掘工程和地质情况，采用标高投影的原理，按一定比例尺绘制而成的图纸。图上包括内容有：井田技术边界线，本煤层内的以及与开采本煤层有关的邻近巷道，回采区、丢煤区或注销或报损区，永久导线点和水准点的位置，勘探和表明煤层埋藏的资料，如钻孔和勘探线区，重要采掘安全资料，如发火区、积水区、煤及瓦斯突本文档来自技高网...

【技术保护点】
1.一种掘进机行走路径规划方法，其特征是，包括以下步骤：建立掘进工作面巷道在大地坐标系下的三维模型；根据掘进机的自身尺寸数据，建立掘进机的三维模型；获取掘进机的空间位置信息，计算掘进机在大地坐标系下的坐标；获取掘进机的方位角；基于掘进机在大地坐标系下的坐标和掘进机的方位角，将掘进机的三维模型与掘进工作面巷道的三维模型相结合，实时模拟掘进机的行走路径；根据所模拟的掘进机行走路径与设置的掘进机行走路径的偏移量，调整掘进机的行走方向和速度。

【技术特征摘要】
1.一种掘进机行走路径规划方法，其特征是，包括以下步骤：建立掘进工作面巷道在大地坐标系下的三维模型；根据掘进机的自身尺寸数据，建立掘进机的三维模型；获取掘进机的空间位置信息，计算掘进机在大地坐标系下的坐标；获取掘进机的方位角；基于掘进机在大地坐标系下的坐标和掘进机的方位角，将掘进机的三维模型与掘进工作面巷道的三维模型相结合，实时模拟掘进机的行走路径；根据所模拟的掘进机行走路径与设置的掘进机行走路径的偏移量，调整掘进机的行走方向和速度。2.根据权利要求1所述的掘进机行走路径规划方法，其特征是，所述掘进工作面巷道在大地坐标系下的三维模型的建立方法为：建立属性数据库和空间数据库，获取掘进工作面的钻孔数据、三维地震数据和物探数据，并存储到属性数据库中；获取物探区的地理分布、钻孔的地理位置及巷高、巷宽数据，存储到空间数据库中；根据属性数据库中的钻孔数据确定掘进工作面巷道的采掘工程平面图；采用ArcEngine三维控件，并结合OpenGL技术，以采掘工程平面图、属性数据库和空间数据库为基础，建立掘进工作面巷道在大地坐标系下的三维模型。3.根据权利要求1所述的掘进机行走路径规划方法，其特征是，获取掘进机在掘进工作面巷道内的空间位置信息以及掘进机的方位角信息；根据掘进机在掘进工作面巷道内的空间位置信息，计算掘进机在大地坐标系下的坐标。4.根据权利要求1所述的掘进机行走路径规划方法，其特征是，所述掘进机的三维模型建立方法为：获取掘进机的型号，适应的巷道，主要的结构部件型号以及各部件参数，旋转角度以及摆动幅度信息；利用上述获取的信息，结合截割头、悬臂、铲板齿轮、输送机的选型和布置方式，使用autoCAD分别绘制出掘进机的本体部、截割部、输送机、载装机构、行走机构和后支撑机构的结构图；根据结构图使用三维建模中的表面造型、实体造型和.net二维绘画分别绘制出掘进机各机构的三维实体模型。5.根据权利要求1所述的掘进机行走路径规划方法，其特征是，所述掘进机的行走方向和速度...

【专利技术属性】
技术研发人员：李国鑫，石泉，
申请(专利权)人：山东新矿信息技术有限公司，
类型：发明
国别省市：山东,37