CN116136176B - 掘进设备的控制方法、控制装置和掘进设备 - Google Patents

掘进设备的控制方法、控制装置和掘进设备 Download PDF

Info

Publication number
CN116136176B
CN116136176B CN202310399172.XA CN202310399172A CN116136176B CN 116136176 B CN116136176 B CN 116136176B CN 202310399172 A CN202310399172 A CN 202310399172A CN 116136176 B CN116136176 B CN 116136176B
Authority
CN
China
Prior art keywords
distance
tunneling
roadway
tunneling equipment
central axis
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202310399172.XA
Other languages
English (en)
Other versions
CN116136176A (zh
Inventor
张明明
刘洋
苏昌奇
武永亮
程乐
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Sany Intelligent Equipment Co ltd
Sany Heavy Equipment Co Ltd
Original Assignee
Sany Intelligent Equipment Co ltd
Sany Heavy Equipment Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Sany Intelligent Equipment Co ltd, Sany Heavy Equipment Co Ltd filed Critical Sany Intelligent Equipment Co ltd
Priority to CN202310399172.XA priority Critical patent/CN116136176B/zh
Publication of CN116136176A publication Critical patent/CN116136176A/zh
Application granted granted Critical
Publication of CN116136176B publication Critical patent/CN116136176B/zh
Priority to PCT/CN2024/070265 priority patent/WO2024212624A1/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • EFIXED CONSTRUCTIONS
    • E21EARTH OR ROCK DRILLING; MINING
    • E21DSHAFTS; TUNNELS; GALLERIES; LARGE UNDERGROUND CHAMBERS
    • E21D9/00Tunnels or galleries, with or without linings; Methods or apparatus for making thereof; Layout of tunnels or galleries
    • E21D9/10Making by using boring or cutting machines
    • E21D9/108Remote control specially adapted for machines for driving tunnels or galleries
    • EFIXED CONSTRUCTIONS
    • E21EARTH OR ROCK DRILLING; MINING
    • E21DSHAFTS; TUNNELS; GALLERIES; LARGE UNDERGROUND CHAMBERS
    • E21D9/00Tunnels or galleries, with or without linings; Methods or apparatus for making thereof; Layout of tunnels or galleries
    • E21D9/003Arrangement of measuring or indicating devices for use during driving of tunnels, e.g. for guiding machines
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02PCLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Landscapes

  • Engineering & Computer Science (AREA)
  • Mining & Mineral Resources (AREA)
  • Environmental & Geological Engineering (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • General Life Sciences & Earth Sciences (AREA)
  • Geochemistry & Mineralogy (AREA)
  • Geology (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明涉及工程设备技术领域,提出了一种掘进设备的控制方法、控制装置和掘进设备,其中,掘进设备的控制方法包括:分别获取掘进设备的本体的第一侧面与巷道的第一侧壁之间的第一距离,以及掘进设备的本体的第二侧面与巷道的第二侧壁之间的第二距离;根据第一距离和第二距离控制掘进设备的行驶方向,以使掘进设备的中心轴线与巷道的中心轴线之间的夹角小于预设角度,且与巷道的中心轴线之间的最大距离小于预设距离;控制掘进设备按照预设进尺量进行掘进工作。本发明提供的掘进设备的控制方法,能够保证掘进设备的中心轴线与巷道的中心轴线之间的偏离量不会过大,从而使得掘进设备不会偏离预设掘进路线,以避免发生超挖现象。

Description

掘进设备的控制方法、控制装置和掘进设备
技术领域
本发明涉及工程设备技术领域,具体而言,涉及一种掘进设备的控制方法、控制装置和掘进设备。
背景技术
相关技术中,掘进机在运行过程中,需要以预设的轮廓线为基准进行掘进,以保证巷道的形状,然而,在实现本发明过程中,发明人发现现有技术中至少存在如下问题:掘进机前进的过程中会产生位移偏差,从而导致掘进出现超挖和欠挖现象,无法保证进尺的准确性,因此,如何提高掘进机运行过程中进尺量的准确性,成为了亟待解决的问题。
发明内容
本发明旨在至少解决现有技术或相关技术中存在的掘进机前进的过程中会产生位移偏差,从而导致掘进出现超挖和欠挖现象,无法保证进尺的准确性的问题。
为此,本发明的第一方面提出了一种掘进设备的控制方法。
本发明的第二方面提出了一种掘进设备的控制装置。
本发明的第三方面提出了一种掘进设备的控制装置。
本发明的第四方面提出了一种可读存储介质。
本发明的第五方面提出了一种掘进设备。
有鉴于此,本发明的第一方面提出了一种掘进设备的控制方法,包括:分别获取掘进设备的本体的第一侧面与巷道第一侧壁之间的第一距离,以及掘进设备的本体的第二侧面与巷道的第二侧壁之间的第二距离;根据第一距离和第二距离控制掘进设备的行驶方向,以使掘进设备的中心轴线与巷道的中心轴线之间的夹角小于预设角度,且与巷道的中心轴线之间的最大距离小于预设距离;控制掘进设备按照预设进尺量进行掘进工作。
本发明提供的掘进设备的控制方法,可以用于控制掘进设备的运行,以实现掘进设备的自动运行,提高掘进设备的自动化程度,减少人工劳动力,提高掘进设备的运行效率。
具体地,掘进设备的控制方法包括:首先,分别获取掘进设备的本体的第一侧面与巷道第一侧壁之间的第一距离,以及掘进设备的本体的第二侧面与巷道的第二侧壁之间的第二距离。可以理解的是,掘进设备在掘进的过程中,会按照预设的方向和预设的进尺量在巷道内进行掘进。此时,可以分别获取掘进设备的本体的两侧与巷道的两个侧壁之间的距离。也就是掘进设备本体的第一侧面与巷道的第一侧壁之间的第一距离,以及掘进设备的本体的第二侧面与巷道的第二侧壁之间的第二距离。可以理解的是,在掘进设备的行驶方向的两侧,掘进设备的本体具有第一侧面和第二侧面,相应地,在巷道内,与第一侧面相对的侧壁为第一侧壁,与第二侧面相对的侧壁为第二侧壁。
进一步地,在获取到第一距离和第二距离之后,可以根据第一距离和第二距离对掘进设备的行驶方向进行调整。从而使得掘进设备的中心轴线的延伸方向与巷道的中心轴线的延伸方向之间的夹角小于预设角度,优选使得掘进设备的中心轴线的延伸方向与巷道的中心轴线的延伸方向能够一致,也就是使得掘进设备的行驶方向能够沿预设的巷道的延伸方向前进,从而避免掘进设备角度发生过度倾斜导致发生超挖现象。
同时,在保证掘进设备的中心轴线的方向与巷道的延伸方向之间的夹角小于预设角度的基础上,还可以使得掘进设备的中心轴线与巷道的中心轴线之间的最大距离小于预设距离。可以理解的是,由于掘进设备的长度是有限的,也就是掘进设备的中心轴线长度是有限的。因此,沿垂直于巷道的底面的方向观察,掘进设备的中心轴线与巷道的中心轴线之间的最大距离,即为掘进设备的中心轴线的一侧端部在垂直于巷道的中心轴线的方向上与巷道的中心轴线之间的距离。通过掘进设备的中心轴线与巷道的中心轴线之间的最大距离的限定,从而使得掘进设备不会偏离预设掘进路线过多,以避免发生超挖现象。
最后,在调整好掘进设备的行驶方向之后,即可按照预设的进尺量控制掘进设备进行掘进工作。
具体地,掘进设备可以设置有惯性导航系统,惯性导航系统用于对掘进设备的行驶方向和行驶距离进行导航,从而保证掘进设备的进尺量。进一步地,掘进设备还可以设置有毫米波雷达,通过毫米波雷达的设置,可以实现对掘进设备本体与巷道的侧壁之间的距离的检测。具体地,毫米波雷达可以分别设置于掘进设备的本体的第一侧面和第二侧面上,并且将毫米波雷达的发射方向朝向巷道的第一侧壁和第二侧壁,以保证第一距离和第二距离的检测的准确性。进一步地,掘进设备还可以设置有控制器,控制器分别与惯性导航系统以及毫米波雷达相连接。在毫米波雷达获取到第一距离和第二距离后,即可将数据传输至控制器,同时,控制器对数据进行处理,并发送给惯性导航系统,惯性导航系统即可根据数据进行导航。
本发明提供的掘进设备的控制方法,通过分别获取掘进设备的本体的第一侧面与巷道第一侧壁之间的第一距离,以及掘进设备的本体的第二侧面与巷道的第二侧壁之间的第二距离。从而可根据第一距离和第二距离对掘进设备的行驶方向进行控制,从而保证掘进设备的行驶方向与巷道的中心轴线方向之间的夹角小于预设角度,从而避免掘进设备角度发生倾斜导致发生超挖现象。同时还能够保证掘进设备的中心轴线与巷道的中心轴线之间的偏离量不会过大,从而使得掘进设备不会偏离预设掘进路线,以避免发生超挖现象。
另外,根据本发明提供的上述技术方案中的掘进设备的控制方法,还可以具有如下附加技术特征:
在上述技术方案中,进一步地,根据第一距离和第二距离控制掘进设备的行驶方向的步骤,包括:获取第一距离和第二距离之间的距离差值;在距离差值大于预设差值的情况下,根据第一距离和第二距离获取掘进设备的移动方向;根据第一距离和第二距离获取掘进设备的移动距离;根据移动方向和移动距离,控制掘进设备移动。
在该技术方案中,在获取到掘进设备的本体的第一侧面与巷道第一侧壁之间的第一距离,以及掘进设备的本体的第二侧面与巷道的第二侧壁之间的第二距离之后,首先可以根据第一距离和第二距离确定二者之间的距离差值,并判断该距离差值是否大于预设差值。也就是说,通过第一距离和第二距离之间的距离差值,判断掘进设备当前是否发生偏离,具体地,在第一距离和第二距离之间的距离差值小于预设差值的情况下,则表明掘进设备的本体的两侧与巷道的两个侧壁之间相差的距离没有过大,也就是当前掘进设备并未发生偏离。相反,如果第一距离和第二距离之间的距离差值大于预设差值,则表明当前掘进设备的本体的两侧与巷道的两个侧壁之间相差的距离过大,也就是当前掘进设备发生偏离,需要进行横向调整。
进一步地,在第一距离与第二距离之间的距离差值大于预设差值的情况下,首先可以根据第一距离和第二距离确定掘进设备所需要进行横向调整的移动方向,然后,再根据第一距离和第二距离确定掘进设备需要进行横向调整的移动距离。最后,在掘进设备的移动方向和移动距离均确定的情况下,即可控制掘进设备按照移动方向和移动距离进行移动,进而完成掘进设备的横向调整。
在上述任一技术方案中,进一步地,根据第一距离和第二距离获取掘进设备的移动方向的步骤,包括:在第一距离大于第二距离的情况下,确定移动方向为朝向第一侧壁;在第一距离小于第二距离的情况下,确定移动方向为朝向第二侧壁。
在该技术方案中,在第一距离和第二距离之间的距离差值大于预设差值的情况下,可以根据第一距离和第二距离之间的大小关系,确定掘进设备的移动方向。具体地,在第一距离大于第二距离的情况下,则表明掘进设备的本体的第一侧面与巷道的第一侧壁之间的距离大于掘进设备的本体的第二侧面与巷道的第二侧壁之间的距离,也就是此时掘进设备的本体偏向巷道的第二侧壁,此时则可以确定掘进设备需要调整的移动方向为朝向巷道的第一侧壁。相反,在第一距离小于第二距离的情况下,则表明掘进设备的本体的第一侧面与巷道的第一侧壁之间的距离小于掘进设备的本体的第二侧面与巷道的第二侧壁之间的距离,也就是此时掘进设备的本体偏向巷道的第一侧壁,此时则可以确定掘进设备需要调整的移动方向为朝向巷道的第二侧壁。
在上述任一技术方案中,进一步地,根据预设公式:∣X1-X2∣÷2=X确定移动距离;其中,X1为第一距离,X2为第二距离,X为移动距离。
在该技术方案中,可以根据预设公式:∣X1-X2∣÷2=X确定掘进设备调整所需要的移动距离。其中,X1为第一距离,X2为第二距离,X为移动距离。可以理解的是,当掘进设备发生偏离时,第一距离与第二距离之间的距离差值为掘进设备的本体两侧与巷道侧壁之间的距离差,此时,将该距离差值除以2,则表示掘进设备偏离巷道的中心轴线的距离,也即掘进设备所需要调整的移动距离。最后,在掘进设备的移动方向和移动距离均确定的情况下,即可控制掘进设备按照移动方向和移动距离进行移动,进而完成掘进设备的横向调整。
在上述任一技术方案中,进一步地,掘进设备的控制方法还包括:获取掘进设备前方的巷道的前壁的点云信息;根据点云信息,确定巷道的前壁上未达到预设进尺量的欠挖位置;控制掘进设备对欠挖位置进行掘进工作。
在该技术方案中,在掘进设备的行驶方向调整完成之后,即可按照预设进尺量控制掘进设备进行掘进工作。而在掘进设备的中轴线上,当进尺量达到预设进尺量后,即可控制掘进设备停止前进。可以理解的是,掘进设备的悬臂的一端设置在掘进设备的本体上,悬臂的另一端设置有截割头,并且,掘进设备的悬臂相对于掘进设备的本体转动,同时,由于悬臂的长度是固定不变的,这样,在掘进设备的行驶方向上,当悬臂与掘进设备的中心轴线之间的夹角小于预设角度时,掘进的进尺量是最大的,而在掘进设备的中心轴线的两侧,进尺量相对较小。
因此,当在掘进设备的中轴线上进尺量达到最大时,停止控制掘进设备前进,从而可避免悬臂转动至与掘进设备的中心轴线之间的夹角小于预设角度时发生超挖现象。而此时,在掘进设备的中心轴线两侧的巷道前壁上的进尺量小于中心轴线上的进尺量,也就是中心轴线两侧存在欠挖现象,此时需要对中心轴线两侧的巷道前壁进行欠挖补偿。
具体地,首先获取巷道前壁的点云信息,然后根据巷道前壁的点云信息,确定巷道前壁上未达到预设进尺量的欠挖位置,最后,控制掘进设备对欠挖位置进行掘进,以实现欠挖补偿。
具体地,可以通过毫米波雷达进行巷道前壁的点云数据的获取。可以在掘进设备的本体的前端的两侧分别设置毫米波雷达,以保证点云数据的准确性。
在上述任一技术方案中,进一步地,获取掘进设备前方的巷道的前壁的点云信息的步骤之前,还包括:调节掘进设备的位置,以使掘进设备的中心轴线与巷道的中心轴线重合。
在该技术方案中,在控制掘进设备对巷道的前壁进行欠挖补偿之前,也就是获取巷道的前壁的点云数据之前,可以调节掘进设备的位置,以使得掘进设备的中心轴线与巷道的中心轴线重合,从而可以保证巷道前壁的点云数据的获取的准确性,避免获取巷道前壁的点云数据时发生位置偏离。
根据本发明的第二方面,提出了一种掘进设备的控制装置,包括:获取单元,用于分别获取掘进设备的本体的第一侧面与巷道第一侧壁之间的第一距离,以及掘进设备的本体的第二侧面与巷道的第二侧壁之间的第二距离;控制单元,用于根据第一距离和第二距离控制掘进设备的行驶方向,以使掘进设备的中心轴线与巷道的中心轴线之间的夹角小于预设角度,且与巷道的中心轴线之间的最大距离小于预设距离;以及用于控制掘进设备按照预设进尺量进行掘进工作。
本发明提供的掘进设备的控制装置,通过获取单元分别获取掘进设备的本体的第一侧面与巷道第一侧壁之间的第一距离,以及掘进设备的本体的第二侧面与巷道的第二侧壁之间的第二距离。从而使得控制单元可根据第一距离和第二距离对掘进设备的行驶方向进行控制,从而保证掘进设备的行驶方向与巷道的中心轴线方向之间的夹角小于预设角度,从而避免掘进设备角度发生倾斜导致发生超挖现象。同时还能够保证掘进设备的中心轴线与巷道的中心轴线之间的偏离量不会过大,从而使得掘进设备不会偏离预设掘进路线,以避免发生超挖现象。
在上述任一技术方案中,进一步地,获取单元具体可以用于:获取第一距离和第二距离之间的距离差值;控制单元具体用于:在距离差值大于预设差值的情况下,根据第一距离和第二距离获取掘进设备的移动方向;根据第一距离和第二距离获取掘进设备的移动距离;根据移动方向和移动距离,控制掘进设备移动。
进一步地,控制单元具体还用于:在第一距离大于第二距离的情况下,确定移动方向为朝向第一侧壁;在第一距离小于第二距离的情况下,确定移动方向为朝向第二侧壁。
进一步地,控制单元具体还用于:根据预设公式:∣X1-X2∣÷2=X确定移动距离;其中,X1为第一距离,X2为第二距离,X为移动距离。
进一步地,获取单元还用于:在掘进设备的中心轴线上,巷道的进尺量达到预设进尺量的情况下,获取掘进设备前方的巷道的前壁的点云信息;根据点云信息,确定巷道的前壁上未达到预设进尺量的欠挖位置;控制单元还用于:控制掘进设备对欠挖位置进行掘进工作。
进一步地,在获取掘进设备前方的巷道的前壁的点云信息的步骤之前,控制单元还用于:调节掘进设备的位置,以使掘进设备的中心轴线与巷道的中心轴线重合。
根据本申请的第三方面,提出了一种掘进设备的控制装置,包括:处理器和存储器,存储器存储可在处理器上运行的程序或指令,程序或指令被处理器执行时实现如上述技术方案中任一项的掘进设备的控制方法的步骤。
本申请提供的掘进设备的控制装置,包括存储器和处理器,还包括存储在存储器上的程序或指令,该程序或指令被处理器执行时,能够实现上述技术方案中任一项的掘进设备的控制方法的步骤,因此该掘进设备的控制方法具备上述掘进设备的控制方法的全部有益效果,在此不再赘述。
根据本申请的第四方面,提出了一种可读存储介质,其上存储有程序或指令,程序或指令被处理器执行时实现如上述技术方案中任一项的掘进设备的控制方法的步骤。
本申请提供的可读存储介质,其上存储有程序或指令,因该程序或指令被处理器执行时,能够实现如上述技术方案中任一项的掘进设备的控制方法,因此该可读存储介质具备上述掘进设备的控制方法的全部有益效果,在此不再赘述。
根据本申请的第五方面,提出了一种掘进设备,包括如上述第二方面提供的掘进设备的控制装置或如上述第三方面提供的掘进设备的控制装置。
本申请提供的掘进设备,包括如上述第二方面提供的掘进设备的控制装置或如上述第三方面提供的掘进设备的控制装置,因此该掘进设备具备上述掘进设备的控制装置的全部有益效果,在此不再赘述。
本发明的附加方面和优点将在下面的描述部分中变得明显,或通过本发明的实践了解到。
附图说明
本发明的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得明显和容易理解,其中:
图1示出了本发明的一个实施例的掘进设备的控制方法的流程示意图;
图2示出了本发明的另一个实施例的掘进设备的控制方法的流程示意图;
图3示出了本发明的再一个实施例的掘进设备的控制方法的流程示意图;
图4示出了本发明的一个实施例的掘进设备位于巷道内的示意图;
图5示出了本发明的一个实施例的掘进设备的控制方法的流程框图。
具体实施方式
为了能够更清楚地理解本发明的上述目的、特征和优点,下面结合附图和具体实施方式对本发明进行进一步的详细描述。需要说明的是,在不冲突的情况下,本申请的实施例及实施例中的特征可以相互组合。
在下面的描述中阐述了很多具体细节以便于充分理解本发明,但是,本发明还可以采用其他不同于在此描述的其他方式来实施,因此,本发明的保护范围并不受下面公开的具体实施例的限制。
下面参照图1至图5描述根据本发明一些实施例的掘进设备的控制方法、掘进设备的控制装置、可读存储介质和掘进设备。
如图1所示,根据本发明的一个实施例,提出了一种掘进设备的控制方法,包括:
S102,分别获取掘进设备的本体的第一侧面与巷道的第一侧壁之间的第一距离,以及掘进设备的本体的第二侧面与巷道的第二侧壁之间的第二距离;
S104,根据第一距离和第二距离控制掘进设备的行驶方向;
S106,控制掘进设备按照预设进尺量进行掘进工作。
本发明提供的掘进设备的控制方法,如图1所示,可以用于控制掘进设备的运行,以实现掘进设备的自动运行,提高掘进设备的自动化程度,减少人工劳动力,提高掘进设备的运行效率。
具体地,如图4所示,掘进设备以掘进机为例,掘进设备的控制方法包括:首先,分别获取掘进机的本体的第一侧面与巷道第一侧壁之间的第一距离,以及掘进机的本体的第二侧面与巷道的第二侧壁之间的第二距离。可以理解的是,掘进机在掘进的过程中,会按照预设的方向和预设的进尺量在巷道内进行掘进。此时,可以分别获取掘进机的本体的两侧与巷道的两个侧壁之间的距离。也就是掘进机本体的第一侧面与巷道的第一侧壁之间的第一距离,以及掘进机的本体的第二侧面与巷道的第二侧壁之间的第二距离。可以理解的是,在掘进机的行驶方向的两侧,掘进机的本体具有第一侧面和第二侧面,相应地,在巷道内,与第一侧面相对的侧壁为第一侧壁,与第二侧面相对的侧壁为第二侧壁。
进一步地,在获取到第一距离和第二距离之后,可以根据第一距离和第二距离对掘进机的行驶方向进行调整。从而使得掘进机的中心轴线的延伸方向与巷道的中心轴线的延伸方向之间的夹角小于预设角度,优选使得掘进机的中心轴线的延伸方向与巷道的中心轴线的延伸方向能够一致,也就是使得掘进机的行驶方向能够沿预设的巷道的延伸方向前进,从而避免掘进机角度发生倾斜导致发生超挖现象。
同时,在保证掘进机的中心轴线的方向与巷道的延伸方向之间的夹角小于预设角度的基础上,还可以使得掘进机的中心轴线与巷道的中心轴线之间的最大距离小于预设距离。可以理解的是,由于掘进设备的长度是有限的,也就是掘进设备的中心轴线长度是有限的。因此,沿垂直于巷道的底面的方向观察,掘进设备的中心轴线与巷道的中心轴线之间的最大距离,即为掘进设备的中心轴线的一侧端部在垂直于巷道的中心轴线的方向上与巷道的中心轴线之间的距离。通过掘进设备的中心轴线与巷道的中心轴线之间的最大距离的限定,从而使得掘进机不会偏离预设掘进路线过多,以避免发生超挖现象。
具体地,在实际运行过程中,可以根据巷道的整体尺寸或者根据掘进机的整体尺寸设定预设距离,也就是根据巷道和掘进机的尺寸设定掘进过程中的误差量,以使得掘进过程的误差量保持在预设距离内。具体地,预设距离可以设置为3米至5米。
最后,在调整好掘进机的行驶方向之后,即可按照预设的进尺量控制掘进机进行掘进工作。
具体地,掘进机可以设置有惯性导航系统,惯性导航系统用于对掘进机的行驶方向和行驶距离进行导航,从而保证掘进机的进尺量。进一步地,掘进机还可以设置有毫米波雷达,通过毫米波雷达的设置,可以实现对掘进机本体与巷道的侧壁之间的距离的检测。具体地,毫米波雷达可以分别设置于掘进机的本体的第一侧面和第二侧面上,并且将毫米波雷达的发射方向朝向巷道的第一侧壁和第二侧壁,以保证第一距离和第二距离的检测的准确性。进一步地,掘进机还可以设置有控制器,控制器分别与惯性导航系统以及毫米波雷达相连接。在毫米波雷达获取到第一距离和第二距离后,即可将数据传输至控制器,同时,控制器对数据进行处理,并发送给惯性导航系统,惯性导航系统即可根据数据进行导航。
本发明提供的掘进设备的控制方法,通过分别获取掘进设备的本体的第一侧面与巷道第一侧壁之间的第一距离,以及掘进设备的本体的第二侧面与巷道的第二侧壁之间的第二距离。从而可根据第一距离和第二距离对掘进设备的行驶方向进行控制,从而保证掘进设备的行驶方向与巷道的中心轴线方向之间的夹角小于预设角度,从而避免掘进设备角度发生倾斜导致发生超挖现象。同时还能够保证掘进设备的中心轴线与巷道的中心轴线之间的偏离量不会过大,从而使得掘进设备不会偏离预设掘进路线,以避免发生超挖现象。
根据本发明的一个实施例,如图2所示,提出了一种掘进设备的控制方法,包括:
S202,分别获取掘进设备的本体的第一侧面与巷道的第一侧壁之间的第一距离,以及掘进设备的本体的第二侧面与巷道的第二侧壁之间的第二距离;
S204,获取第一距离和第二距离之间的距离差值;
S206,在距离差值大于预设差值的情况下,根据第一距离和第二距离获取掘进设备的移动方向;
S208,根据第一距离和第二距离获取掘进设备的移动距离;
S210,根据移动方向和移动距离,控制掘进设备移动;
S212,控制掘进设备按照预设进尺量进行掘进工作。
在该实施例中,在获取到掘进设备的本体的第一侧面与巷道第一侧壁之间的第一距离,以及掘进设备的本体的第二侧面与巷道的第二侧壁之间的第二距离之后,首先可以根据第一距离和第二距离确定二者之间的距离差值,并判断该距离差值是否大于预设差值。也就是说,通过第一距离和第二距离之间的距离差值,判断掘进设备当前是否发生偏离,具体地,在第一距离和第二距离之间的距离差值小于预设差值的情况下,则表明掘进设备的本体的两侧与巷道的两个侧壁之间相差的距离没有过大,也就是当前掘进设备并未发生偏离。相反,如果第一距离和第二距离之间的距离差值大于预设差值,则表明当前掘进设备的本体的两侧与巷道的两个侧壁之间相差的距离过大,也就是当前掘进设备发生偏离,需要进行横向调整。
进一步地,在第一距离与第二距离之间的距离差值大于预设差值的情况下,首先可以根据第一距离和第二距离确定掘进设备所需要进行横向调整的移动方向,然后,再根据第一距离和第二距离确定掘进设备需要进行横向调整的移动距离。最后,在掘进设备的移动方向和移动距离均确定的情况下,即可控制掘进设备按照移动方向和移动距离进行移动,进而完成掘进设备的横向调整。
在上述实施例中,进一步地,根据第一距离和第二距离获取掘进设备的移动方向的步骤,包括:在第一距离大于第二距离的情况下,确定移动方向为朝向第一侧壁;在第一距离小于第二距离的情况下,确定移动方向为朝向第二侧壁。
在该实施例中,如图4所示,在第一距离和第二距离之间的距离差值大于预设差值的情况下,可以根据第一距离和第二距离之间的大小关系,确定掘进设备的移动方向。具体地,在第一距离大于第二距离的情况下,则表明掘进设备的本体的第一侧面与巷道的第一侧壁之间的距离大于掘进设备的本体的第二侧面与巷道的第二侧壁之间的距离,也就是此时掘进设备的本体偏向巷道的第二侧壁,此时则可以确定掘进设备需要调整的移动方向为朝向巷道的第一侧壁。相反,在第一距离小于第二距离的情况下,则表明掘进设备的本体的第一侧面与巷道的第一侧壁之间的距离小于掘进设备的本体的第二侧面与巷道的第二侧壁之间的距离,也就是此时掘进设备的本体偏向巷道的第一侧壁,此时则可以确定掘进设备需要调整的移动方向为朝向巷道的第二侧壁。
进一步地,根据预设公式:∣X1-X2∣÷2=X确定移动距离;其中,X1为第一距离,X2为第二距离,X为移动距离。
具体地,可以根据预设公式:∣X1-X2∣÷2=X确定掘进设备调整所需要的移动距离。其中,X1为第一距离,X2为第二距离,X为移动距离。可以理解的是,当掘进设备发生偏离时,第一距离与第二距离之间的距离差值为掘进设备的本体两侧与巷道侧壁之间的距离差,此时,将该距离差值除以2,则表示掘进设备偏离巷道的中心轴线的距离,也即掘进设备所需要调整的移动距离。最后,在掘进设备的移动方向和移动距离均确定的情况下,即可控制掘进设备按照移动方向和移动距离进行移动,进而完成掘进设备的横向调整。
根据本发明的一个实施例,如图3所示,提出了一种掘进设备的控制方法,包括:
S302,分别获取掘进设备的本体的第一侧面与巷道第一侧壁之间的第一距离,以及掘进设备的本体的第二侧面与巷道的第二侧壁之间的第二距离;
S304,根据第一距离和第二距离控制掘进设备的行驶方向;
S306,控制掘进设备按照预设进尺量进行掘进工作;
S308,在掘进设备的中心轴线上,巷道的进尺量达到预设进尺量的情况下,获取掘进设备前方的巷道的前壁的点云信息;
S310,根据点云信息,确定巷道的前壁上未达到预设进尺量的欠挖位置;
S312,控制掘进设备对欠挖位置进行掘进工作。
在该实施例中,在掘进设备的行驶方向调整完成之后,即可按照预设进尺量控制掘进设备进行掘进工作。而在掘进设备的中轴线上,当进尺量达到预设进尺量后,即可控制掘进设备停止前进。可以理解的是,掘进设备的悬臂的一端设置在掘进设备的本体上,悬臂的另一端设置有截割头,并且,掘进设备的悬臂相对于掘进设备的本体转动,同时,由于悬臂的长度是固定不变的,这样,在掘进设备的行驶方向上,当悬臂与掘进设备的中心轴线之间的夹角小于预设角度时,掘进的进尺量是最大的,而在掘进设备的中心轴线的两侧,进尺量相对较小。
因此,当在掘进设备的中轴线上进尺量达到最大时,停止控制掘进设备前进,从而可避免悬臂转动至与掘进设备的中心轴线之间的夹角小于预设角度时发生超挖现象。而此时,在掘进设备的中心轴线两侧的巷道前壁上的进尺量小于中心轴线上的进尺量,也就是中心轴线两侧存在欠挖现象,此时需要对中心轴线两侧的巷道前壁进行欠挖补偿。
具体地,首先获取巷道前壁的点云信息,然后根据巷道前壁的点云信息,确定巷道前壁上未达到预设进尺量的欠挖位置,最后,控制掘进设备对欠挖位置进行掘进,以实现欠挖补偿。
具体地,可以通过毫米波雷达进行巷道前壁的点云数据的获取。可以在掘进设备的本体的前端的两侧分别设置毫米波雷达,以保证点云数据的准确性。
具体地,在实际运行过程中,如图5所示,首先分别获取掘进设备的本体的第一侧面与巷道第一侧壁之间的第一距离X1,以及掘进设备的本体的第二侧面与巷道的第二侧壁之间的第二距离X2。然后根据第一距离和第二距离确定二者之间的距离差值∣X1-X2∣,并判断该距离差值是否大于预设差值SP1。在第一距离与第二距离之间的距离差值大于预设差值的情况下,则需要对掘进设备进行横向矫正。
进一步地,在掘进设备的中轴线上,当进尺量达到预设进尺量后,即可控制掘进设备停止前进。然后获取巷道前壁的点云信息,然后根据巷道前壁的点云信息,确定巷道前壁上未达到预设进尺量的欠挖位置X3和X4。其中,X3表示掘进设备中心轴线一侧的某一位置的进尺量,相应地,X4表示掘进设备中心轴线另一侧的某一位置的进尺量,可以理解的是,在实际运行中,X3和X4所表示的位置并不只是一个,也可以为多个。然后,将X3和X4与预设进尺量K进行比较,在X3或X4与预设进尺量K之间的差值小于预设值SP2时,也就是∣X3-K∣<SP2,或∣X4-K∣<SP2,则不需要对X3或X4所在的位置进行欠挖补偿。相反,如果∣X3-K∣≥SP2,或∣X4-K∣≥SP2,则需要对X3或X4所在的位置进行欠挖补偿,也就是控制掘进设备进行进尺校正,以保证该位置的进尺量。
在上述实施例中,进一步地,获取掘进设备前方的巷道的前壁的点云信息的步骤之前,还包括:调节掘进设备的位置,以使掘进设备的中心轴线与巷道的中心轴线重合。
在该实施例中,在控制掘进设备对巷道的前壁进行欠挖补偿之前,也就是获取巷道的前壁的点云数据之前,可以调节掘进设备的位置,以使得掘进设备的中心轴线与巷道的中心轴线重合,从而可以保证巷道前壁的点云数据的获取的准确性,避免获取巷道前壁的点云数据时发生位置偏离。
根据本发明的第二方面,提出了一种掘进设备的控制装置,包括:获取单元,用于分别获取掘进设备的本体的第一侧面与巷道第一侧壁之间的第一距离,以及掘进设备的本体的第二侧面与巷道的第二侧壁之间的第二距离;其中,第一侧面与第一侧壁相对,第二侧面与第二侧壁相对;控制单元,用于根据第一距离和第二距离控制掘进设备的行驶方向,以使掘进设备的中心轴线与巷道的中心轴线之间的夹角小于预设角度,且与巷道的中心轴线之间的最大距离小于预设距离;以及用于控制掘进设备按照预设进尺量进行掘进工作。
本发明提供的掘进设备的控制装置,通过获取单元分别获取掘进设备的本体的第一侧面与巷道第一侧壁之间的第一距离,以及掘进设备的本体的第二侧面与巷道的第二侧壁之间的第二距离。从而使得控制单元可根据第一距离和第二距离对掘进设备的行驶方向进行控制,从而保证掘进设备的行驶方向与巷道的中心轴线方向之间的夹角小于预设角度,从而避免掘进设备角度发生倾斜导致发生超挖现象。同时还能够保证掘进设备的中心轴线与巷道的中心轴线之间的偏离量不会过大,从而使得掘进设备不会偏离预设掘进路线,以避免发生超挖现象。
在上述任一技术方案中,进一步地,获取单元具体可以用于:获取第一距离和第二距离之间的距离差值;控制单元具体用于:在距离差值大于预设差值的情况下,根据第一距离和第二距离获取掘进设备的移动方向;根据第一距离和第二距离获取掘进设备的移动距离;根据移动方向和移动距离,控制掘进设备移动。
进一步地,控制单元具体还用于:在第一距离大于第二距离的情况下,确定移动方向为朝向第一侧壁;在第一距离小于第二距离的情况下,确定移动方向为朝向第二侧壁。
进一步地,控制单元具体还用于:根据预设公式:∣X1-X2∣÷2=X确定移动距离;其中,X1为第一距离,X2为第二距离,X为移动距离。
进一步地,获取单元还用于:在掘进设备的中心轴线上,巷道的进尺量达到预设进尺量的情况下,获取掘进设备前方的巷道的前壁的点云信息;根据点云信息,确定巷道的前壁上未达到预设进尺量的欠挖位置;控制单元还用于:控制掘进设备对欠挖位置进行掘进工作。
进一步地,在获取掘进设备前方的巷道的前壁的点云信息的步骤之前,控制单元还用于:调节掘进设备的位置,以使掘进设备的中心轴线与巷道的中心轴线重合。
根据本申请的第三方面,提出了一种掘进设备的控制装置,包括:处理器和存储器,存储器存储可在处理器上运行的程序或指令,程序或指令被处理器执行时实现如上述技术方案中任一项的掘进设备的控制方法的步骤。
本申请提供的掘进设备的控制装置,包括存储器和处理器,还包括存储在存储器上的程序或指令,该程序或指令被处理器执行时,能够实现上述技术方案中任一项的掘进设备的控制方法的步骤,因此该掘进设备的控制方法具备上述掘进设备的控制方法的全部有益效果,在此不再赘述。
根据本申请的第四方面,提出了一种可读存储介质,其上存储有程序或指令,程序或指令被处理器执行时实现如上述技术方案中任一项的掘进设备的控制方法的步骤。
本领域技术人员可以理解实现上述实施例方法中的全部或部分步骤是可以通过程序来指令相关的硬件来完成,程序可以存储于一计算机的可读存储介质中,该程序在执行时,包括如下步骤:分别获取掘进设备的本体的第一侧面与巷道第一侧壁之间的第一距离,以及掘进设备的本体的第二侧面与巷道的第二侧壁之间的第二距离;根据第一距离和第二距离控制掘进设备的行驶方向,以使掘进设备的中心轴线与巷道的中心轴线之间的夹角小于预设角度,且与巷道的中心轴线之间的最大距离小于预设距离;控制掘进设备按照预设进尺量进行掘进工作。可读存储介质包括如只读存储器、随机存取存储器、磁碟或光盘等。
根据本申请的第五方面,提出了一种掘进设备,包括如上述第二方面提供的掘进设备的控制装置或如上述第三方面提供的掘进设备的控制装置。
本申请提供的掘进设备,包括如上述第二方面提供的掘进设备的控制装置或如上述第三方面提供的掘进设备的控制装置,因此该掘进设备具备上述掘进设备的控制装置的全部有益效果,在此不再赘述。
在本发明中,术语“多个”则指至少两个或至少两个以上,除非另有明确的限定。术语“安装”、“相连”、“连接”、“固定”等术语均应做广义理解,例如,“连接”可以是固定连接,也可以是可拆卸连接,或一体地连接;“相连”可以是直接相连,也可以通过中间媒介间接相连。对于本领域的普通技术人员而言,可以根据具体情况理解上述术语在本发明中的具体含义。
在本说明书的描述中,术语“一个实施例”、“一些实施例”、“具体实施例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或特点包含于本发明的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不一定指的是相同的实施例或实例。而且,描述的具体特征、结构、材料或特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
以上仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。

Claims (8)

1.一种掘进设备的控制方法,其特征在于,包括:
分别获取掘进设备的本体的第一侧面与巷道的第一侧壁之间的第一距离,以及所述掘进设备的本体的第二侧面与所述巷道的第二侧壁之间的第二距离;
其中,所述第一侧面与所述第一侧壁相对,所述第二侧面与所述第二侧壁相对;
根据所述第一距离和所述第二距离控制所述掘进设备的行驶方向,以使所述掘进设备的中心轴线与所述巷道的中心轴线之间的夹角小于预设角度,且与所述巷道的中心轴线之间的最大距离小于预设距离;
控制所述掘进设备按照预设进尺量进行掘进工作;
所述掘进设备的控制方法,还包括:
在所述掘进设备的中心轴线上,所述巷道的进尺量达到所述预设进尺量的情况下,获取所述掘进设备前方的所述巷道的前壁的点云信息;
根据所述点云信息,确定所述巷道的前壁上未达到所述预设进尺量的欠挖位置;
控制所述掘进设备对所述欠挖位置进行掘进工作;
所述获取所述掘进设备前方的所述巷道的前壁的点云信息的步骤之前,还包括:
调节所述掘进设备的位置,以使所述掘进设备的中心轴线与所述巷道的中心轴线重合。
2.根据权利要求1所述的掘进设备的控制方法,其特征在于,所述根据所述第一距离和所述第二距离控制所述掘进设备的行驶方向的步骤,包括:
获取所述第一距离和所述第二距离之间的距离差值;
在所述距离差值大于预设差值的情况下,根据所述第一距离和所述第二距离获取所述掘进设备的移动方向;
根据所述第一距离和所述第二距离获取所述掘进设备的移动距离;
根据所述移动方向和所述移动距离,控制所述掘进设备移动。
3.根据权利要求2所述的掘进设备的控制方法,其特征在于,所述根据所述第一距离和所述第二距离获取所述掘进设备的移动方向的步骤,包括:
在所述第一距离大于所述第二距离的情况下,确定所述移动方向为朝向所述第一侧壁;
在所述第一距离小于所述第二距离的情况下,确定所述移动方向为朝向所述第二侧壁。
4.根据权利要求2所述的掘进设备的控制方法,其特征在于,根据预设公式:∣X1-X2∣÷2=X确定所述移动距离;
其中,X1为所述第一距离,X2为所述第二距离,X为所述移动距离。
5.一种掘进设备的控制装置,其特征在于,包括:
获取单元,用于分别获取掘进设备的本体的第一侧面与巷道的第一侧壁之间的第一距离,以及所述掘进设备的本体的第二侧面与所述巷道的第二侧壁之间的第二距离;
其中,所述第一侧面与所述第一侧壁相对,所述第二侧面与所述第二侧壁相对;
控制单元,用于根据所述第一距离和所述第二距离控制所述掘进设备的行驶方向,以使所述掘进设备的中心轴线与所述巷道的中心轴线之间的夹角小于预设角度,且与所述巷道的中心轴线之间的最大距离小于预设距离;以及
用于控制掘进设备按照预设进尺量进行掘进工作;
所述获取单元还用于:在所述掘进设备的中心轴线上,所述巷道的进尺量达到所述预设进尺量的情况下,获取所述掘进设备前方的所述巷道的前壁的点云信息;
根据所述点云信息,确定所述巷道的前壁上未达到所述预设进尺量的欠挖位置;
所述控制单元还用于:控制所述掘进设备对所述欠挖位置进行掘进工作;
在所述获取所述掘进设备前方的所述巷道的前壁的点云信息的步骤之前,所述控制单元还用于:
调节所述掘进设备的位置,以使所述掘进设备的中心轴线与所述巷道的中心轴线重合。
6.一种掘进设备的控制装置,其特征在于,包括:
处理器和存储器,所述存储器存储可在所述处理器上运行的程序或指令,所述程序或指令被所述处理器执行时实现如权利要求1至4中任一项所述的掘进设备的控制方法的步骤。
7.一种可读存储介质,其特征在于,所述可读存储介质上存储程序或指令,所述程序或指令被处理器执行时实现如权利要求1至4中任一项所述的掘进设备的控制方法的步骤。
8.一种掘进设备,其特征在于,包括:
如权利要求5或6所述的掘进设备的控制装置。
CN202310399172.XA 2023-04-14 2023-04-14 掘进设备的控制方法、控制装置和掘进设备 Active CN116136176B (zh)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN202310399172.XA CN116136176B (zh) 2023-04-14 2023-04-14 掘进设备的控制方法、控制装置和掘进设备
PCT/CN2024/070265 WO2024212624A1 (zh) 2023-04-14 2024-01-03 掘进设备的控制方法、控制装置和掘进设备

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202310399172.XA CN116136176B (zh) 2023-04-14 2023-04-14 掘进设备的控制方法、控制装置和掘进设备

Publications (2)

Publication Number Publication Date
CN116136176A CN116136176A (zh) 2023-05-19
CN116136176B true CN116136176B (zh) 2023-08-11

Family

ID=86326957

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202310399172.XA Active CN116136176B (zh) 2023-04-14 2023-04-14 掘进设备的控制方法、控制装置和掘进设备

Country Status (2)

Country Link
CN (1) CN116136176B (zh)
WO (1) WO2024212624A1 (zh)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2004035990A2 (en) * 2002-10-15 2004-04-29 Placer Dome Technical Services Limited Automated excavation machine
CN110439570A (zh) * 2019-08-14 2019-11-12 张占军 一种掘进控制方法、掘进控制装置和掘进机
CN110703266A (zh) * 2019-10-12 2020-01-17 山东科技大学 一种掘进机精准定位及导航系统
CN210134942U (zh) * 2019-03-14 2020-03-10 中铁工程装备集团隧道设备制造有限公司 掘进机截割控制装置及悬臂掘进机
CN212202064U (zh) * 2020-05-15 2020-12-22 阳泉煤业(集团)股份有限公司 一种掘进机自动可视化操作系统
CN113250693A (zh) * 2021-05-31 2021-08-13 北京瑞华高科技术有限责任公司 掘进控制装置、方法及掘进设备
CN114991800A (zh) * 2022-07-07 2022-09-02 中国铁建重工集团股份有限公司 一种掘进机的纠偏控制方法、系统、掘进机及存储介质

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2004035990A2 (en) * 2002-10-15 2004-04-29 Placer Dome Technical Services Limited Automated excavation machine
CN210134942U (zh) * 2019-03-14 2020-03-10 中铁工程装备集团隧道设备制造有限公司 掘进机截割控制装置及悬臂掘进机
CN110439570A (zh) * 2019-08-14 2019-11-12 张占军 一种掘进控制方法、掘进控制装置和掘进机
CN110703266A (zh) * 2019-10-12 2020-01-17 山东科技大学 一种掘进机精准定位及导航系统
CN212202064U (zh) * 2020-05-15 2020-12-22 阳泉煤业(集团)股份有限公司 一种掘进机自动可视化操作系统
CN113250693A (zh) * 2021-05-31 2021-08-13 北京瑞华高科技术有限责任公司 掘进控制装置、方法及掘进设备
CN114991800A (zh) * 2022-07-07 2022-09-02 中国铁建重工集团股份有限公司 一种掘进机的纠偏控制方法、系统、掘进机及存储介质

Also Published As

Publication number Publication date
CN116136176A (zh) 2023-05-19
WO2024212624A1 (zh) 2024-10-17

Similar Documents

Publication Publication Date Title
AU2016288150B2 (en) Work assist system for work machines
CN103197675B (zh) 地下铲运机自主行驶和避障运动控制及目标路径规划方法
US7191060B2 (en) Method for automatically guiding a mining machine
KR101934052B1 (ko) 작업기 제어 장치 및 작업 기계
JP6756450B2 (ja) クレーンの制御システム及び制御方法
WO2021106938A1 (ja) 作業機械の制御システム、作業機械、作業機械の制御方法
US12012729B2 (en) System and method for automatically controlling work machine including work implement
US20220106764A1 (en) Control system for construction machine, construction machine, and control method for construction machine
WO2020137520A1 (ja) クレーンの制御システム及び制御方法
CN116136176B (zh) 掘进设备的控制方法、控制装置和掘进设备
CN111399494B (zh) 一种无人驾驶装载导引方法、装置和系统
JP6587734B1 (ja) クレーンの制御システム及び制御方法
JP7101146B2 (ja) クレーンの制御システム及び制御方法
CN115649199A (zh) 车辆轨迹确定方法、设备及存储介质
CN111457918B (zh) 一种基于多传感器信息融合的连续采煤机导航与定位系统
CN114089730B (zh) 机器人的运动规划方法和自动引导车
JP4269170B2 (ja) 軌道追従制御方法および装置
CN117311353A (zh) 井下自动移车方法、系统、作业机械、设备、介质和芯片
JP7090053B2 (ja) クレーンの制御システム及び制御方法
CN114165231B (zh) 连采机快速准直控制系统
JP2004284699A (ja) ヤードクレーン
CN114215537B (zh) 掘进机截割臂伸缩控制方法及装置
JP2018167940A (ja) 荷役機器の制御システム及び制御方法
CN116945208B (zh) 一种机器人系统
CN117780372A (zh) 掘进装备的控制方法及装置

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant