Intelligent cutting control method and system for cantilever type heading machine
Through the intelligent cutting control system, using multiple sensors and scanning data, analyzing coal rock distribution and joint angles, and updating behavioral models, the problem of low efficiency of the cantilever boring machine control system is solved, real-time monitoring and efficient coal mine excavation process is achieved control.
Patent Information
- Application Number
- CN202410991472.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-23
- Publication Date
- 2024-11-12
AI Technical Summary
The existing cantilever boring machine control system is mainly manual control, which is difficult to meet the needs of adaptive cutting control and remote monitoring, resulting in low coal mining boring efficiency and inability to support the monitoring of workflows of complex mechanical equipment.
Adopt intelligent cutting control system to obtain data through displacement sensors, pressure sensors, acceleration sensors and current sensors, combine tunnel section scanning data, analyze coal rock distribution, calculate joint angle and attitude information, update behavior model, and realize the cantilever boring machine Real-time monitoring and control.
It improves the efficiency of coal mine excavation, realizes real-time monitoring and control of cantilever boring machines, and facilitates real-time management of coal mine mining process.
Smart Images

Figure CN118933762A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of coal mining, and in particular to an intelligent cutting control method and system for a cantilever type roadheader. Background Art
[0002] The cantilever roadheader is the core equipment for coal mine tunneling. Improving its intelligence level is the key to ensuring the quality and efficiency of coal mine tunneling.
[0003] At present, the control system of roadheaders is developing slowly, mainly based on manual control, with low tunnel excavation efficiency, and it is difficult to meet the needs of adaptive cutting control and remote monitoring, which restricts the efficient production of coal mines. As the intelligence level of roadheaders gradually improves, the workflow becomes more and more complicated. The roadheader working status monitoring method based on two-dimensional reports and configuration monitoring is gradually unable to support the complex mechanical equipment workflow monitoring, which seriously affects the efficiency of coal mine excavation. Summary of the invention
[0004] The present invention provides a cantilever roadheader intelligent cutting control method and system, which can realize real-time monitoring and control of the cantilever roadheader and improve the coal mine excavation efficiency.
[0005] In a first aspect, the present invention provides an intelligent cutting control method for a cantilevered tunnel boring machine, wherein the cantilevered tunnel boring machine comprises a cutting arm and an intelligent cutting control system, wherein the intelligent cutting control system comprises a displacement sensor, a pressure sensor, an acceleration sensor and a current sensor, and the method comprises: acquiring detection data of each sensor of the intelligent cutting control system, and scanning data of a tunnel section; performing coal and rock analysis based on the scanning data of the tunnel section, and determining the distribution of coal and rock in the tunnel section; calculating each joint angle of the cantilevered tunnel boring machine based on the detection data of each sensor; determining the posture information of the cantilevered tunnel boring machine based on the joint angles of the cantilevered tunnel boring machine; updating a tunnel boring machine behavior model based on the posture information of the cantilevered tunnel boring machine; and controlling the movement of the cutting arm of the cantilevered tunnel boring machine based on the coal and rock distribution in the tunnel section and the tunnel boring machine behavior model, so as to achieve cutting of coal and rock in the tunnel section.
[0006] In one possible implementation, the scanning data includes the reflection intensity and curvature of each point on the tunnel section; accordingly, a coal-rock analysis is performed based on the scanning data of the tunnel section to determine the coal-rock distribution of the tunnel section, including: generating an identification vector based on the reflection intensity and curvature of each point on the tunnel section, the identification vector including the position coordinates, reflection intensity and curvature of each point in the tunnel section; inputting the identification vector into a preset identification model to obtain the coal-rock properties of each point on the tunnel section, the coal-rock properties including coal areas and rock areas; determining the coal-rock distribution of the tunnel section based on the coal-rock properties of each point on the tunnel section; the coal-rock distribution is used to characterize the areas and boundaries of the coal areas and rock areas on the tunnel section.
[0007] In a possible implementation, the posture information of the cantilever tunnel boring machine is determined based on the joint angles of the cantilever tunnel boring machine, including: determining the starting point coordinates and direction of the rotating part based on the position coordinates of the cantilever tunnel boring machine; determining the starting point coordinates and direction of the telescopic part based on the second joint angle between the telescopic part and the rotating part, and the starting point coordinates and direction of the rotating part; determining the position coordinates and direction of the cutting part based on the first joint angle between the cutting part and the telescopic part, and the starting point coordinates and direction of the telescopic part; determining the position coordinates of the cutting head based on the position coordinates and direction of the cutting part, and detection data of the fifth displacement sensor and the sixth displacement sensor; determining the posture information of the cantilever tunnel boring machine based on the position coordinates of the cutting head, the position coordinates and direction of the cutting part, the starting point coordinates and direction of the telescopic part, and the starting point coordinates and direction of the rotating part.
[0008] In a possible implementation, the tunnel boring machine behavior model is updated based on the posture information of the cantilever tunnel boring machine, including: updating the position coordinates of the tunnel boring machine behavior model based on the latest coordinate data of the cantilever tunnel boring machine; updating the rotating part of the tunnel boring machine behavior model after the updated coordinates based on the starting point coordinates and direction of the rotating part; updating the telescopic part of the tunnel boring machine behavior model after the rotating part is updated based on the starting point coordinates and direction of the telescopic part; updating the cutting part of the tunnel boring machine behavior model after the telescopic part is updated based on the position coordinates of the cutting head and the position coordinates and direction of the cutting part, to obtain an updated tunnel boring machine behavior model.
[0009] In one possible implementation, based on the coal and rock distribution in the tunnel section and the tunnel boring machine behavior model, the movement of the cutting arm of the cantilever tunnel boring machine is controlled to achieve cutting of the coal and rock in the tunnel section, including: determining the tunneling area at the next moment and the cutting acceleration corresponding to the tunneling area based on the coal and rock distribution in the tunnel section; generating tunneling control instructions based on the tunneling area at the next moment and the tunnel boring machine behavior model, the tunneling control instructions are used to instruct the cutting head to move to the tunneling area at the next moment; generating cutting instructions based on the cutting acceleration corresponding to the tunneling area, the cutting instructions are used to instruct the cutting head to cut the tunneling area at the next moment with the cutting acceleration.
[0010] In a possible implementation, based on the excavation area at the next moment and the behavior model of the tunnel boring machine, an excavation control instruction is generated, including: based on the excavation area at the next moment and the behavior model of the tunnel boring machine, the rotational displacement of the rotating part, the pitch displacement of the telescopic part and the telescopic displacement of the cutting part are determined; based on the rotational displacement of the rotating part, the pitch displacement of the telescopic part and the telescopic displacement of the cutting part, the motion displacement and motion direction of each cylinder rod of the cutting arm are determined; based on the motion displacement and motion direction of each cylinder rod of the cutting arm, an excavation control instruction is generated.
[0011] In a possible implementation, based on the distribution of coal and rock in the tunnel section and the behavior model of the tunnel boring machine, the movement of the cutting arm of the cantilever tunnel boring machine is controlled to achieve the cutting of the coal and rock in the tunnel section. It also includes: obtaining the excavation point position of the cutting head at each moment in the historical period; drawing the cutting path of the cantilever tunnel boring machine based on the excavation point position of the cutting head at each moment; determining the three-dimensional cutting path of the cantilever tunnel boring machine based on the cutting path and the tunnel model; and displaying the three-dimensional cutting path.
[0012] In the second aspect, an embodiment of the present invention provides a control device for a cantilever tunneling machine intelligent cutting control system, the cantilever tunneling machine includes a cutting arm and an intelligent cutting control system, the intelligent cutting control system includes a displacement sensor, a pressure sensor, an acceleration sensor and a current sensor, the control device includes: a communication module, used to obtain detection data of each sensor of the intelligent cutting control system, and scanning data of the tunnel section; a processing module, used to perform coal and rock analysis based on the scanning data of the tunnel section, and determine the distribution of coal and rock in the tunnel section; based on the detection data of each sensor, calculate each joint angle of the cantilever tunneling machine; based on each joint angle of the cantilever tunneling machine, determine the posture information of the cantilever tunneling machine; based on the posture information of the cantilever tunneling machine, update the tunneling machine behavior model; based on the coal and rock distribution of the tunnel section, and the tunneling machine behavior model, control the movement of the cutting arm of the cantilever tunneling machine to achieve cutting of coal and rock in the tunnel section.
[0013] In the third aspect, an embodiment of the present invention provides a cantilever tunneling machine intelligent cutting control system, the cantilever tunneling machine includes a cutting arm and an intelligent cutting control system, the intelligent cutting control system includes a displacement sensor, a pressure sensor, an acceleration sensor, a current sensor and a control device, the cutting arm includes a cutting part, a telescopic part and a rotating part; the cutting part is installed at one end of the telescopic part, the other end of the telescopic part is installed at one end of the rotating part, and the other end of the rotating part is installed on the cantilever tunneling machine; the cutting part includes a cutting head, a first telescopic cylinder rod and a second telescopic cylinder rod; the first telescopic cylinder rod and the second telescopic cylinder rod control the forward and backward extension of the cutting head; the telescopic part includes a first pitch cylinder rod and a second pitch cylinder rod; the telescopic part controls the up and down pitch of the cutting part; the rotating part includes a first rotary cylinder rod and a second rotary cylinder rod; the rotating part controls the left and right rotation of the telescopic part and the cutting part; the displacement sensor includes a first rotary cylinder rod The control device comprises a first displacement sensor of the first rotary cylinder rod, a second displacement sensor of the second rotary cylinder rod, a third displacement sensor of the first pitch cylinder rod, a fourth displacement sensor of the second pitch cylinder rod, a fifth displacement sensor of the first telescopic cylinder rod and a sixth displacement sensor of the second telescopic cylinder rod; the pressure sensor comprises a first pressure sensor arranged on the first rotary cylinder rod, a second pressure sensor of the second rotary cylinder rod, a third pressure sensor of the first pitch cylinder rod, a fourth pressure sensor of the second pitch cylinder rod, a fifth pressure sensor of the first telescopic cylinder rod and a sixth pressure sensor of the second telescopic cylinder rod; the acceleration sensor is installed on the cutting head to detect the acceleration of the cutting head; the current sensor is installed on the driving system of the cantilever tunneling machine to detect the driving current of the cantilever tunneling machine; the control device is used to execute the steps of the method described in the first aspect and any possible implementation method of the first aspect.
[0014] In one possible implementation, the control device includes a memory and a processor, the memory stores a computer program, and the processor is used to call and run the computer program stored in the memory to perform the steps of the method described in the first aspect and any possible implementation of the first aspect.
[0015] In a fourth aspect, an embodiment of the present invention provides a computer-readable storage medium, wherein the computer-readable storage medium stores a computer program, and wherein when the computer program is executed by a processor, the steps of the method described in the first aspect and any possible implementation method of the first aspect are implemented.
[0016] The present invention provides an intelligent cutting control method and system for a cantilevered roadheader. The present invention arranges a plurality of sensors such as a displacement sensor, a pressure sensor, an acceleration sensor and a current sensor on the cutting arm of the cantilevered roadheader to detect the cutting process of the cantilevered roadheader, calculates the angles and posture information of each joint of the cantilevered roadheader, and updates the behavior model of the roadheader, thereby realizing real-time monitoring and control of the cantilevered roadheader, facilitating users to monitor the roadheading process in real time during coal mining, and improving the coal mine roadheading efficiency. BRIEF DESCRIPTION OF THE DRAWINGS
[0017] In order to more clearly illustrate the technical solutions in the embodiments of the present invention, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative labor.
[0018] Figure 1 It is a structural schematic diagram of a cantilever type tunnel boring machine provided by an embodiment of the present invention;
[0019] Figure 2 It is a schematic diagram of the architecture of an intelligent cutting control system provided by an embodiment of the present invention;
[0020] Figure 3 It is a flow chart of an intelligent cutting control method for a cantilever type roadheader provided by an embodiment of the present invention;
[0021] Figure 4 It is a structural schematic diagram of a control device of a cantilever type roadheader intelligent cutting control system provided by an embodiment of the present invention;
[0022] Figure 5 It is a structural schematic diagram of a control device provided by an embodiment of the present invention.
[0023] Among them, 1 is the cutting head, 2 is the telescopic cylinder, 3 is the loading part, 4 is the cantilever, 5 is the pitch cylinder, 6 is the slewing part, 7 is the slewing cylinder, and 8 is the walking part. DETAILED DESCRIPTION
[0024] In the following description, specific details such as specific system structures, technologies, etc. are provided for the purpose of illustration rather than limitation, so as to provide a thorough understanding of the embodiments of the present invention. However, it should be clear to those skilled in the art that the present invention may be implemented in other embodiments without these specific details. In other cases, detailed descriptions of well-known systems, devices, circuits, and methods are omitted to prevent unnecessary details from obstructing the description of the present invention.
[0025] In the description of the present invention, unless otherwise specified, " / " means "or", for example, A / B can mean A or B. "And / or" in this article is only a description of the association relationship of associated objects, indicating that there can be three relationships. For example, A and / or B can mean: A exists alone, A and B exist at the same time, and B exists alone. In addition, "at least one" and "plurality" refer to two or more. The words "first", "second", etc. do not limit the quantity and execution order, and the words "first", "second", etc. do not limit them to be different.
[0026] In the embodiments of the present application, words such as "exemplary" or "for example" are used to indicate examples, illustrations or descriptions. Any embodiment or design described as "exemplary" or "for example" in the embodiments of the present application should not be interpreted as being more preferred or more advantageous than other embodiments or designs. Specifically, the use of words such as "exemplary" or "for example" is intended to present related concepts in a concrete way for easy understanding.
[0027] In addition, the terms "including" and "having" and any variations thereof mentioned in the description of this application are intended to cover non-exclusive inclusions. For example, a process, method, system, product or device that includes a series of steps or modules is not limited to the listed steps or modules, but may optionally include other steps or modules that are not listed, or may optionally include other steps or modules that are inherent to these processes, methods, products or devices.
[0028] In order to make the purpose, technical solutions and advantages of the present invention more clear, the following will be described through specific embodiments in conjunction with the accompanying drawings of the present invention.
[0029] As described in the background technology, the current working status monitoring method of the tunnel boring machine, which is mainly based on two-dimensional reports and configuration monitoring, is gradually unable to support the monitoring of complex mechanical equipment workflows, and there is a technical problem of low coal mine tunneling efficiency.
[0030] To solve the above technical problems, Figure 1 As shown, an embodiment of the present invention provides a cantilever type roadheader. The cantilever type roadheader includes a cutting arm and an intelligent cutting control system, and the intelligent cutting control system includes a displacement sensor, a pressure sensor, an acceleration sensor and a current sensor.
[0031] In some embodiments, the cutting arm includes a cutting part, a telescopic part and a rotating part; the cutting part is installed at one end of the telescopic part, the other end of the telescopic part is installed at one end of the rotating part, and the other end of the rotating part is installed on the cantilever tunneling machine; the cutting part includes a cutting head, a first telescopic cylinder rod and a second telescopic cylinder rod; the first telescopic cylinder rod and the second telescopic cylinder rod control the forward and backward extension of the cutting head; the telescopic part includes a first pitch cylinder rod and a second pitch cylinder rod; the telescopic part controls the up and down pitch of the cutting part; the rotating part includes a first rotary cylinder rod and a second rotary cylinder rod; the rotating part controls the left and right rotation of the telescopic part and the cutting part.
[0032] Exemplarily, the displacement sensor includes a first displacement sensor arranged on the first rotary cylinder rod, a second displacement sensor on the second rotary cylinder rod, a third displacement sensor on the first pitch cylinder rod, a fourth displacement sensor on the second pitch cylinder rod, a fifth displacement sensor on the first telescopic cylinder rod, and a sixth displacement sensor on the second telescopic cylinder rod.
[0033] Exemplarily, the pressure sensors include a first pressure sensor arranged on the first rotary cylinder rod, a second pressure sensor on the second rotary cylinder rod, a third pressure sensor on the first pitch cylinder rod, a fourth pressure sensor on the second pitch cylinder rod, a fifth pressure sensor on the first telescopic cylinder rod, and a sixth pressure sensor on the second telescopic cylinder rod.
[0034] Exemplarily, the acceleration sensor is installed on the cutting head to detect the acceleration of the cutting head.
[0035] Exemplarily, the current sensor is installed in the driving system of the cantilever tunneling machine to detect the driving current of the cantilever tunneling machine.
[0036] In some embodiments, the boom-type tunnel boring machine further includes a traveling portion and a loading portion.
[0037] Exemplarily, the walking part is a crawler-type drive device, which can realize the movement control of the cantilever tunnel boring machine.
[0038] For example, the loading and transporting unit can load and transport the coal cut by the cutting unit, and transport it to the ground through a transmission system.
[0039] like Figure 2 As shown, an embodiment of the present invention provides a schematic diagram of the architecture of an intelligent cutting control system. The intelligent cutting control system can collect and process working condition data, and remotely monitor the cutting process of a cantilevered roadheader.
[0040] In some embodiments, the intelligent cutting control system includes a working condition data acquisition subsystem, a controller subsystem and a remote detection subsystem.
[0041] Exemplarily, the operating condition data acquisition subsystem includes a current sensor, an acceleration sensor, a pressure sensor, a displacement sensor, and an electro-hydraulic proportional valve.
[0042] It should be noted that the present invention uses theories such as robot kinematics to establish a robot kinematic model, and conducts theoretical and simulation research on the tunnel section forming characteristics. Design an intelligent cutting control system, and complete hardware and software design and debugging. The hardware part mainly includes: data acquisition and control quantity output module design, communication interface design, storage module design, JTAG module design, power module design, and complete PCB drawing and other work; the software part mainly includes: completion of the design and program writing of each module of the intelligent control system software, including ADC data acquisition module, communication function module, main control software part design, etc. Perform preliminary debugging and verification of the main functions of the control system. Formulate a test plan, build a real-time monitoring system for the working status of the tunnel boring machine, complete the data communication between the monitoring system and the main controller, and realize the visualization of the motion status of the tunnel boring machine.
[0043] The present invention proposes an intelligent cutting control and monitoring scheme suitable for a cantilevered roadheader by analyzing the current development status of the technologies involved in each part. Then, the control scheme is systematically analyzed and studied. Aiming at the complex working conditions and coal-rock distribution in the underground, a control strategy of an intelligent control system based on coal-rock identification and fuzzy control based on multi-sensor information is proposed. Python and MATLAB software are mainly used to analyze and verify the effectiveness of the control strategy. According to the requirements of the cutting control scheme, the tunnel cross-section forming characteristics are analyzed, the cutting mechanism is kinematically modeled, the relationship between the position of the cutting head and the telescopic amount of each driving cylinder of the cutting arm is analyzed, and MATLAB is used to perform cross-section profile forming simulation analysis to provide a theoretical basis for the research and design. Secondly, according to the control scheme, a suitable main control chip is selected, a hardware circuit that meets the control requirements is designed, a schematic diagram is drawn, and the design of functional modules such as data acquisition is completed. According to the control requirements, each module of the software part of the controller is written, an online monitoring system is built, and the main controller and other functions are verified. The design work is mainly completed using software such as CCS, Unity3D and some debugging tools.
[0044] According to the requirements of the intelligent cutting control of the cantilever tunneling machine, the present invention designs the main hardware of the control system and explains it, completes the production and testing of the PCB; formulates the overall structure of the control system hardware, designs the data acquisition circuit module, the CAN communication circuit module, etc., realizes the functions of data acquisition and control quantity output, inter-chip communication, data storage, etc. of the cantilever tunneling machine control system, and performs basic functional tests. According to the requirements of the intelligent cutting control of the cantilever tunneling machine, the present invention designs the main hardware of the control system and explains it, completes the production and testing of the PCB; formulates the overall structure of the control system hardware, designs the data acquisition circuit module, the CAN communication circuit module, etc., realizes the functions of data acquisition and control quantity output, inter-chip communication, data storage, etc. of the cantilever tunneling machine control system, and performs basic functional tests.
[0045] The present invention analyzes the requirements of the intelligent cutting control system of the tunnel boring machine, and the control system needs a rich I / O interface. Since the cutting control has the characteristics of high real-time performance, the control system is required to have strong data processing capabilities to cope with a large amount of data from multi-sensor signals to ensure the real-time performance and control accuracy of the control system. At the same time, the control system needs to have real-time communication capabilities to transmit the real-time working condition data of the tunnel boring machine to the host computer to meet the real-time monitoring function of the working status of the tunnel boring machine. Based on the DSP+CPLD hardware solution, DSP serves as the main control chip of the control system. The control system includes working condition data acquisition and control quantity output modules, remote communication and monitoring modules, storage modules, etc., and is debugged using the reserved JTAG interface.
[0046] The main controller chip needs to complete functions such as data acquisition, data processing and communication, and the working state has high real-time requirements. Therefore, the system's A / D conversion speed must be fast, the computing power requirements are high, and the realization of some functions of the designed control system requires external expansion. When selecting the controller chip, the main control chip CPU needs to be selected according to the actual requirements of the designed control system. When selecting the chip, the number of I / O ports and the number of analog input ports should be considered first, including the acquisition port for cutting the motor current, the data port and clock port required to connect to the external expansion chip through XINTF communication, the port required for JTAG program download, the control output reserved port, and the port for data transmission between the host computer through CAN communication. In addition to considering the number of ports, the most important consideration is the real-time consideration. High real-time requires fast A / D conversion speed, and the converted data can be transcoded and transmitted to the host computer for online monitoring at the same time as the data conversion. The DSP chip selected in this solution is TMS320F28335 for control occasions. This chip is a microprocessor with a 32-bit floating-point data processing unit and a CPU main frequency of 150MHz.
[0047] The chip has rich on-chip resources and can coordinate with a variety of peripherals to meet the requirements of the design scheme for the speed and accuracy of the main controller to process data. It has the following main features: it has an FPU module (single-precision floating-point operation) and responds quickly to interrupt requests; it has an asynchronous communication bus (XINTF) that can be used for CPLD I / O port expansion communication; it has an enhanced peripheral interface that is easy to control, that is, 18 ports that can output PWM waves; it has rich on-chip resources, with three serial communication modules, DMA function, AD conversion function, and eCAN; in the process of fast transfer of sensor data, it uses the multi-channel DMA transfer technology of the ARM chip, and the entire data transfer is carried out under the DMA function to improve system performance. And the simulator can be used to debug the system in real time, which is convenient for development.
[0048] The CPLD expansion module in the present invention is used as a system data acquisition and control quantity output extension, and the model is EPM3128A. The main controller reads data information from the extended CPLD data acquisition module, calculates the read data information and communicates with the host computer for uploading, and outputs the control quantity and other information through the external expansion module. The external interface used for communication between the expansion module and the main control module is the asynchronous communication bus XINTF of the DSP. XINTF is a non-multiplexed asynchronous bus, and the external interface is mapped to three fixed areas.
[0049] Table 1 shows the address allocation of the main control module DSP in the control system. The addresses of SRAM and CPLD are mapped to the Zonex area. DSP transmits and reads data to the expansion device through XINTF. The main controller allocates the 0x00200000~0x0027FFFF address of area 7 to CPLD. The communication establishment and tracking time has been set to 3, 7, and 3 high-speed clock cycles in the initialization program of the main controller, and different addresses correspond to different data. When in use, as long as the corresponding address is accessed, the corresponding data can be read. The timing of DSP reading and writing SRAM can be divided into three stages: establishment, activation, and tracking.
[0050] Table 1
[0051] equipment Corresponding area Assigning Addresses SRAM XINTF6 0x00100000~0x001FFFFF CPLD Data Acquisition XINTF7 0x00200000~0x0027FFFF
[0052] In the present invention, data acquisition is accomplished by two chips. The digital signal processor contains a 16-channel 12-bit analog-to-digital converter (ADC) module, which can be set as two independent 8-channel modules, which can be cascaded to form a 16-channel module. Although there are multiple input channels and two timing controllers, there is only one converter in the ADC module. The two modules with 8 channels can automatically sequence a series of conversions, and each module has the following characteristics:
[0053] (1) Select any one of the eight channels through the analog multiplexer.
[0054] (2) In cascade mode, the autosequencer operates as a single 16-channel sequencer. Once the conversion is complete, the selected channel value is stored in its respective ADCRESULT register.
[0055] (3) The system can perform multiple conversions on the same channel, allowing the user to implement oversampling algorithms. This oversampling technique provides an improvement in resolution over traditional single-sample conversions.
[0056] The channel allocation of the ADC module is shown in Table 2.
[0057] Table 2
[0058] Channel Interface Corresponding area ADCINA0 Rotary cylinder 1 rodless chamber pressure ADCINA1 Rotary cylinder 1 rod chamber pressure ADCINA2 Lifting cylinder 2 rodless chamber pressure ADCINA3 Lifting cylinder 2 rod chamber pressure ADCINA4 Horizontal cutting arm vibration acceleration ADCINA5 Vertical cutting arm vibration acceleration ADCINA6 Telescopic cylinder rodless chamber pressure ADCINA7 Telescopic cylinder rod chamber pressure ADCINB0 Cutting motor current ADCINB1 Rotary cylinder displacement ADCINB2 Lifting cylinder displacement ADCINB3 Telescopic cylinder
[0059] The analog information is detected by the current monitoring chip ACS724LLCTR, and then the current is converted to voltage through the operational amplifier (AD8028ARZ). The measured data is collected to the chip through the reserved sensor interface for calculation and storage, and sent to the host computer through the CAN bus.
[0060] Intelligent cutting control requires precise control of the swing speed of the cutting arm of the tunnel boring machine. The control quantity output interface is at the I / O port of the CPLD. The DSP sends control information to the CPLD. There are also combinational logic circuits inside the CPLD, such as generating SRAM chip select addresses, etc. The output of the control quantity is the register value inside the CPLD, which is connected to the IO port of the CPLD to realize data output.
[0061] In order to realize the status monitoring function of the cantilever tunnel boring machine, the control system needs to transmit the real-time status information of the tunnel boring machine to the host computer and realize data communication through the CAN bus. The model of the transceiver chip is SN65HVD230. The host computer uses an industrial-grade USB to CAN interface (model USB-CAN-V2) to realize communication with the control system through interrupts to achieve remote monitoring. The CPLD and DSP communicate through the XINTF bus, and a register group is generated inside the CPLD. Different registers correspond to different addresses, and the registers inside the CPLD are accessed through the address. The storage module mainly stores the real-time data and important parameters generated by the cantilever tunnel boring machine during operation, and realizes the query and use of historical data. The memory expansion chip model is IS62WV51216. The storage module uses an extended SRAM module, and uses the combinational logic circuit inside the CPLD to generate the SRAM chip select address. The communication between the extension module and the main control module relies on the XINTF external interface unique to TMS320F28335. JTAG (Joint Test Action Group) is an internationally accepted test protocol standard, mainly used for testing, simulation and debugging in chips. A special test circuit is encapsulated inside the chip, which can test internal nodes and transmit debugging information through a dedicated JTAG test tool, and can debug programs, read or set registers in the chip through a host computer. The specific JTAG pins and functions are shown in Table 3.
[0062] Table 3
[0063]
[0064] The voltages required by the control system of the present invention are 10V, 5V, 3.3V, 1.9V, and ±15V, the external power supply voltage is 5V, and the voltages 1.9V and 3.3V required for the operation of DSP and CPLD are obtained by 5V voltage conversion. The voltage required for D / A conversion is ±15V, the required voltage is provided by an external power supply, and the 10V voltage is obtained by external 15V voltage conversion. In order to ensure the stability of the 1.9V and 3.3V operating voltages, TPS767D301 is used as a voltage conversion chip, and the adjustable voltage in TPS can be adjusted within the range of 1.5-5.5V, and this adjustment is mainly achieved by an external resistor sampling network.
[0065] In order to realize the functions of each part of the intelligent control system of the cantilever tunnel boring machine, the software programs of each module such as data acquisition and communication are written respectively. Based on Unity3D, a cantilever tunnel boring machine monitoring platform with visualization of the working data and structural performance of the tunnel boring machine is built, and a tunnel boring machine model and working scene are established. The data interaction method between the control system and the monitoring platform is studied, and the monitoring of parameters and movements of the tunnel boring machine under working conditions is realized. In order to realize the functions of each part of the intelligent control system of the cantilever tunnel boring machine, the software programs of each module such as data acquisition and communication are written respectively. Based on Unity3D, a cantilever tunnel boring machine monitoring platform with visualization of the working data and structural performance of the tunnel boring machine is built, and a tunnel boring machine model and working scene are established. The data interaction method between the control system and the monitoring platform is studied, and the monitoring of parameters and movements of the tunnel boring machine under working conditions is realized. On this basis, the main functions of the designed intelligent control system such as working status monitoring are experimentally verified.
[0066] CCS (Code Composer Studio) is a software tool for developing DSP systems launched by TI (Texas Instruments). It is used to complete the writing, debugging and analysis of each module program, and provides the function of configuring and establishing programs for system development. Software engineering includes ADC data acquisition module, CAN and other communication modules, etc. When the control system collects data, it executes the interrupt function, communicates through each communication module, and analyzes the required communication information according to the data format of each communication protocol. At the same time, it realizes the storage of real-time data and transmits the data information to the host computer to realize real-time data monitoring.
[0067] According to the requirements of the control system, in order to realize the collection of the working status information of the tunnel boring machine, the cutting motor current I is collected by DSP, and other data collection functions are completed by CPLD, giving full play to the advantages of CPLD with rich I / O ports. When the ADC is initialized, the acquisition module is set to AD cascade mode. First, the clock of the AD module is enabled, and each channel is sampled sequentially. The maximum number of conversion channels is 4, the AD interrupt is enabled, and the startup of the ADC is set to be driven by the EPWM2 module. In order to reduce errors and improve the accuracy of data collection, multi-channel sampling is used to improve accuracy.
[0068] In the CAN bus initialization stage, enable the ECANB module clock, set the CANTXB and CANRXB module pins as CAN send and receive pin functions. ECANB works in normal mode and non-self-test mode. Initialize all master device control areas to 0, and all MCF bits to 0.
[0069] Configure the bit parameter eCANB, the bus bit rate is 500KHz, disable all mailboxes, set mailbox 0 as the sending mailbox, the message ID is 0X200, enable mailbox 0, and the message length is 8 bytes. Set mailbox 1 as the sending mailbox, the message ID is 0X300. Set mailbox 2 as the receiving mailbox, and the mailbox message ID is 0X100. Set the data receiving interrupt service of the CANB bus. Mailbox 2 receives data into the receive array. Clear the interrupt flag to receive the data of the next standard frame. Enable the interrupt.
[0070] The communication between DSP and CPLD chips is realized through XINTF interface. By calling library functions, register groups are generated in CPLD. Different registers correspond to different addresses. The registers inside CPLD are accessed through addresses to realize the communication between the two chips. After the program of each module is completed, the main function is written to complete the coordination of each module.
[0071] In the main function, the following initialization and loop procedures are performed in sequence, initializing the system clock, XINTF interface, GPIO, PIE interrupt management module, ADC module, CAN bus, etc., and enabling ADC interrupt and CAN bus interrupt. After the above initialization is completed, enter the loop body, first determine whether it is currently in the data acquisition or data processing stage, if it is in the data processing stage, the LED flashes, calculate the cutting motor current I, the rotary cylinder pressure P, and the cutting arm vibration acceleration Acc, which are all in millivolts. After completing the above processing, the CAN bus receives the command from the host computer and returns the received data to the host computer to complete the data transmission.
[0072] The tunnel boring machine is mainly composed of cutting part, telescopic part, walking part, loading part and other main parts. Figure 1 As shown. The cutting part consists of a cutting head, a telescopic part, a rotary table and a motion control cylinder. It is the main structure for completing the coal and rock cutting work. The cutting motor controls the rotation of the cutting head to cut the coal and rock. The rotary cylinder, lifting cylinder and telescopic cylinder realize the rotation, lifting and telescopic movement of the cutting arm through the hydraulic system. During the cutting process, the cutting of coal and rock is completed by the rotation of the cutting head and the rotation and telescopic movement of the cutting arm. The coal and rock cut by the cutting part are collected by the planetary gear and bucket of the shipping part.
[0073] The construction of the behavior model of the tunnel boring machine is to describe the working behavior and performance characteristics of the tunnel boring machine during the cutting process by establishing a mathematical model and a simulation model. It is a simulation of the actual behavior of the equipment under certain working conditions. In the overall system of the tunnel boring machine cutting arm motion monitoring, the actual behaviors mainly include the telescopic, rotational, and lifting movements of the cutting arm. Through analysis, the structure of the tunnel boring machine cutting arm is a spatial linkage mechanism, and the cutting arm movement is realized through the xDreamer plug-in. The xDreamer plug-in is an interactive editing software specially designed for the Unity environment, which aims to simplify the Unity development process by providing a visual editing method without programming. The established three-dimensional model is pre-processed and imported into Unity3D, but Unity3D can only import three-dimensional models in a specific format. Therefore, the assembly model needs to be converted into fbx format, and the conversion process is completed in the blender software. After the import is completed, in order to make the constructed model closer to the physical model, the surface features of the model are processed on the Unity3D platform, and various materials such as the tunnel boring machine body, cylinder, and cutting head are designed respectively, and the rendering effect is improved by adding appropriate light and shadow components. Correctly establish the parent-child relationship of the model, define the origin of the components in sequence, disassemble the cutting arm movement, and define each movement separately. Taking the crank rocker mechanism as an example, use the rotation mechanism in the mechanical movement of the xDreamer plug-in to add actions to the parent node, set the crank, connecting rod, connecting rod and rocker joint, rocker and other parameters in the joint configuration, so that the component can complete the corresponding movement.
[0074] After building the behavior model of the cutting arm of the tunnel boring machine, in order to display the joint angles of the cutting arm in real time, in the C# script RotationMechanism that controls the rotation of the crank, the current offset angle is obtained, output to the console through debugging information, and the value is displayed in the text box on the screen. The telescopic part movement is set in the same way to realize the rotation, lifting, and telescopic actions of the cutting arm of the tunnel boring machine and display the joint angles and telescopic amounts of the tunnel boring machine in real time.
[0075] In order to realize real-time data and motion monitoring, an online monitoring system for the tunnel boring machine is built. The platform is built on the Unity3D software platform. Based on the powerful advantages of Unity3D in virtual simulation and augmented reality, the monitoring system realizes functions such as three-dimensional visualization and status monitoring. First of all, the tunnel boring machine monitoring system is designed to be able to reflect the posture changes, sensor information, cutting path and other status information of the tunnel boring machine in real time. The system includes a data acquisition and communication system composed of sensors and controllers of the cantilever tunnel boring machine, which collects data and transmits it to the host computer through data communication. Arrange the tunnel boring machine working scene, build a visual interface of the monitoring system, and realize the visualization of the monitoring action and data monitoring information. The main function realized in the interface is the panoramic three-dimensional display of the cantilever tunnel boring machine entity, which reflects the posture information of the tunnel boring machine in real time, and can be selected according to actual needs. The display window on the left side of the interface shows the cutting path information of the cutting head. The display window on the right shows the data information of various parts of the tunnel boring machine in working state, which can monitor the running state of the tunnel boring machine in real time. When the tunnel boring machine is working, the detection system obtains and processes the real-time data, and displays the state information in the window, including sensor data information, cutting head load and various joint angles, etc., to achieve multi-directional monitoring of the cantilever tunnel boring machine in working state. The display window design chooses a transparent window design to avoid the influence of occlusion on observation, and achieves the ideal effect by continuously correcting the Alpha value of the component.
[0076] In the tunnel boring machine monitoring system, the position of the tunnel boring machine is collected by the inertial navigation system. The tunnel boring machine working data based on the control system, such as the cutting motor current, cylinder pressure, cylinder elongation, system voltage, vibration acceleration, etc., are collected by various sensors to the main controller and transmitted to Unity3D for display through the communication of each part. The vertical slewing joint angle and the horizontal slewing joint angle are calculated based on the elongation of each part of the cylinder through the set model structure relationship. The cutting path is displayed in real time by capturing the cutting head path information.
[0077] Real-time monitoring should be established on the basis of sensor data support. Sensors placed in various parts of the tunnel boring machine collect data, and the main controller calculates the sensor data to obtain various data values. The main controller communicates with the computer through the CAN bus. The computer uses the USB to CAN module to receive data. The C# script for communication is written in Uinty3D, and the received data is uploaded to Unity3D via serial communication. Each receiving data frame and logo are established in the monitoring interface to realize real-time data display.
[0078] After the design and debugging of the software and hardware parts of the main controller and CAN communication are completed, it is necessary to design RS232 serial communication to transmit data information to Unity3D. Serial communication is a low-cost and easy-to-use full-duplex asynchronous communication. The format of transmitted data is: start bit + data frame + check bit + stop bit. The data format is 8 or 9 bits. Here, an 8-bit data format without check bit is used, and the data packet is transmitted in the form of ASCII code. First, create a C# file for serial communication in the software, and configure the basic parameters of serial communication as shown in Table 4.
[0079] Table 4
[0080] parameter property Parameter Value PortName Serial port number COM4 BaudRate Baud rate 9600 Parity Check digit Parity.None StopBits Stop bits StopBits.One
[0081] The data information collected by the sensor is transmitted to Unity3D through serial communication, and after transcoding, it is converted into decimal numbers. Multiple corresponding positions are established in the display window to receive data information, and corresponding codes are written, and corresponding signs are established for display. The real-time parameters of the extension of the rotary cylinder, the extension of the lifting cylinder, and the extension of the telescopic cylinder received in the text box are derived to obtain the instantaneous speed of each part, and the speed data is received through the C# script of xDreamer to complete the drive of the movement of each mechanism, realizing the monitoring of the posture change of the tunnel boring machine model component, cutting speed and other information of the monitoring system.
[0082] According to the requirements of the intelligent monitoring and control system, the present invention compiles and debugs data acquisition, communication, main control and other module programs; builds an online monitoring system platform to realize the visualization of the motion state and structural performance of the tunnel boring machine; designs the data communication between the main controller and the monitoring platform to realize the transmission of the working data information of the tunnel boring machine; develops a monitoring platform to display the real-time data and model movement of the tunnel boring machine, and realizes the real-time monitoring of the motion and data of the tunnel boring machine state. The present invention improves the automation level of the tunnel boring machine cutting control, solves the problems of difficult real-time data collection and poor processing capacity in the current tunnel boring machine control system, and uses Unity to build an online monitoring system for the tunnel boring machine, realizes the real-time monitoring of the motion state and data of the tunnel boring machine, and improves the monitoring efficiency. The data transmission is realized by means of communication, and is designed into a complete control and monitoring system. Compared with the existing control system, this system improves the level of intelligence and integration.
[0083] like Figure 3 As shown, the embodiment of the present invention provides an intelligent cutting control method for a cantilever type tunnel boring machine. The method is applied to Figure 1 The method comprises steps S101-S106.
[0084] S101, acquiring detection data of each sensor of the intelligent cutting control system and scanning data of the tunnel section.
[0085] In some embodiments, the scanning data includes reflection intensity and curvature at each point of the tunnel cross section.
[0086] In some embodiments, the detection data includes the displacement of the oil rod corresponding to each cylinder detected by the displacement sensor, the pressure of each cylinder detected by the pressure sensor, the acceleration of the cutting head detected by the acceleration sensor and the working current of the tunnel boring machine detected by the current sensor.
[0087] S102. Perform coal-rock analysis based on the scanning data of the tunnel section to determine the distribution of coal and rock in the tunnel section.
[0088] In some embodiments, the coal and rock distribution is used to characterize the areas and boundaries of coal and rock areas on the roadway section.
[0089] As a possible implementation manner, step S102 may be specifically implemented as steps S1021 - S1023 .
[0090] S1021. Generate an identification vector based on the reflection intensity and curvature of each point on the tunnel cross section.
[0091] In some embodiments, the identification vector includes the position coordinates, reflection intensity and curvature of each point in the tunnel section.
[0092] S1022. Input the recognition vector into a preset recognition model to obtain the coal and rock properties of each point on the tunnel section.
[0093] In some embodiments, coal rock properties include coal zones and rock zones.
[0094] S1023. Determine the coal and rock distribution of the tunnel section based on the coal and rock properties of each point on the tunnel section.
[0095] S103. Calculate each joint angle of the cantilever roadheader based on the detection data of each sensor.
[0096] In some embodiments, the joint angles of the cantilever tunnel boring machine include a first joint angle between the cutting part and the telescopic part, and a second joint angle between the telescopic part and the rotating part.
[0097] As a possible implementation manner, step S103 may be specifically implemented as steps S1031 - S1033 .
[0098] S1031. Based on the detection data of each pressure sensor and current sensor, determine the oil cylinder that is working normally in the cantilever roadheader.
[0099] S1032. Calculate the cylinder displacement corresponding to each normally working cylinder based on the detection data of each displacement sensor.
[0100] S1033. Determine each joint angle of the cantilever roadheader based on the cylinder displacement corresponding to each normally working cylinder.
[0101] S104: Determine the posture information of the cantilever roadheader based on the joint angles of the cantilever roadheader.
[0102] In some embodiments, the posture information includes the position coordinates of the cutting head, the position coordinates and direction of the cutting portion, the starting point coordinates and direction of the telescopic portion, and the starting point coordinates and direction of the rotating portion.
[0103] As a possible implementation manner, step S104 may be specifically implemented as steps S1041 - S1045 .
[0104] S1041. Based on the position coordinates of the cantilever tunnel boring machine, determine the starting point coordinates and direction of the rotary part.
[0105] S1042. Determine the starting point coordinates and direction of the telescopic part based on the second joint angle between the telescopic part and the rotating part, and the starting point coordinates and direction of the rotating part.
[0106] S1043. Determine the position coordinates and direction of the cutting part based on the first joint angle between the cutting part and the telescopic part, and the starting point coordinates and direction of the telescopic part.
[0107] S1044. Determine the position coordinates of the cutting head based on the position coordinates and direction of the cutting portion and the detection data of the fifth displacement sensor and the sixth displacement sensor.
[0108] S1045. Determine the posture information of the boom tunneling machine based on the position coordinates of the cutting head, the position coordinates and direction of the cutting part, the starting point coordinates and direction of the telescopic part, and the starting point coordinates and direction of the rotating part.
[0109] S105. Based on the posture information of the cantilever type roadheader, a roadheader behavior model is updated.
[0110] In some embodiments, the tunnel boring machine behavior model is a real-time three-dimensional model of the cantilever tunnel boring machine constructed in the host computer, which is used to show the real-time working status of the cantilever tunnel boring machine to the user.
[0111] As a possible implementation manner, step S105 may be specifically implemented as steps S1051 - S1054 .
[0112] S1051. Based on the latest coordinate data of the cantilevered roadheader, the position coordinates of the roadheader behavior model are updated.
[0113] S1052. Based on the starting point coordinates and direction of the rotating part, the rotating part of the tunnel boring machine behavior model after the coordinates are updated is updated.
[0114] S1053. Based on the starting point coordinates and direction of the telescopic part, the telescopic part of the tunnel boring machine behavior model after the rotary part is updated is updated.
[0115] S1054. Based on the position coordinates of the cutting head, the position coordinates and the direction of the cutting part, the cutting part of the roadheader behavior model after the telescopic part is updated is updated to obtain an updated roadheader behavior model.
[0116] S106. Based on the distribution of coal and rock in the tunnel section and the behavior model of the tunnel boring machine, the movement of the cutting arm of the cantilever tunnel boring machine is controlled to achieve cutting of the coal and rock in the tunnel section.
[0117] As a possible implementation manner, step S106 may be specifically implemented as steps S1061 - S1063 .
[0118] S1061. Determine the excavation area at the next moment and the cutting acceleration corresponding to the excavation area based on the distribution of coal and rock in the tunnel section;
[0119] S1062. Generate a tunneling control instruction based on the tunneling area at the next moment and the tunneling machine behavior model.
[0120] In some embodiments, the excavation control instruction is used to instruct the cutting head to move to the excavation area at the next moment.
[0121] Exemplarily, step S1062 may be specifically implemented as steps A1-A3.
[0122] A1. Based on the excavation area at the next moment and the behavior model of the tunnel boring machine, the rotation displacement of the rotating part, the pitch displacement of the telescopic part and the telescopic displacement of the cutting part are determined.
[0123] A2. Based on the rotational displacement of the rotating part, the pitch displacement of the telescopic part and the telescopic displacement of the cutting part, the movement displacement and movement direction of each cylinder rod of the cutting arm are determined.
[0124] A3. Generate excavation control instructions based on the movement displacement and movement direction of each cylinder rod of the cutting arm.
[0125] S1063. Generate a cutting instruction based on the cutting acceleration corresponding to the excavation area. The cutting instruction is used to instruct the cutting head to cut the excavation area at the next moment with the cutting acceleration.
[0126] The present invention provides an intelligent cutting control method for a cantilever roadheader. By arranging a plurality of sensors such as a displacement sensor, a pressure sensor, an acceleration sensor and a current sensor on the cutting arm of the cantilever roadheader, the cutting process of the cantilever roadheader is detected, the angles and posture information of each joint of the cantilever roadheader are calculated, and the behavior model of the roadheader is updated, thereby realizing real-time monitoring and control of the cantilever roadheader, facilitating users to monitor the roadheading process in real time during coal mining, and improving the coal mine roadheading efficiency.
[0127] Optionally, the intelligent cutting control method for a cantilevered roadheader provided in an embodiment of the present invention further includes steps S201-S204 after step S106.
[0128] S201, obtaining the excavation point position of the cutting head at each time in the historical period.
[0129] S202: based on the excavation point position of the cutting head at each moment, draw a cutting path of the cantilever type roadheader.
[0130] S203: Determine a three-dimensional cutting path of the cantilever roadheader based on the cutting path and the tunnel model.
[0131] S204, displaying the three-dimensional cutting path.
[0132] In this way, the embodiment of the present invention can perform three-dimensional drawing of the cutting path of the cantilever tunnel boring machine, so that the user can observe the overall excavation situation of the cantilever tunnel boring machine.
[0133] It should be understood that the order of execution of the steps in the above embodiment does not necessarily mean the order of execution. The execution order of each process should be determined by its function and internal logic, and should not constitute any limitation on the implementation process of the embodiment of the present invention.
[0134] The following is an embodiment of the device of the present invention. For details not described in detail therein, reference may be made to the corresponding method embodiment described above.
[0135] Figure 4 The schematic diagram of the structure of a control device of a cantilever type roadheader intelligent cutting control system provided by an embodiment of the present invention is shown. The control device 300 includes a communication module 301 and a processing module 302 .
[0136] The communication module 301 is used to obtain the detection data of each sensor of the intelligent cutting control system and the scanning data of the tunnel section;
[0137] The data processing module 302 is used to perform coal-rock analysis based on the scanning data of the tunnel section to determine the distribution of coal and rock in the tunnel section; calculate the joint angles of the cantilever tunneling machine based on the detection data of each sensor; determine the posture information of the cantilever tunneling machine based on the joint angles of the cantilever tunneling machine; update the tunneling machine behavior model based on the posture information of the cantilever tunneling machine; control the movement of the cutting arm of the cantilever tunneling machine based on the coal and rock distribution in the tunnel section and the tunneling machine behavior model to achieve cutting of coal and rock in the tunnel section.
[0138] Figure 5 Schematic diagram of a control device provided by an embodiment of the present invention. Figure 5 As shown, the control device 400 includes: a processor 401, a memory 402, and a computer program 403 stored in the memory 402 and executable on the processor 401. When the processor 401 executes the computer program 403, the steps in the above-mentioned method embodiments are implemented, for example Figure 3 Alternatively, when the processor 401 executes the computer program 403, the functions of each module / unit in the above-mentioned device embodiments are realized, for example, Figure 4 The functions of the communication module 301 and the processing module 302 are shown.
[0139] Exemplarily, the computer program 403 may be divided into one or more modules / units, which are stored in the memory 402 and executed by the processor 401 to implement the present invention. The one or more modules / units may be a series of computer program instruction segments capable of implementing specific functions, which are used to describe the execution process of the computer program 403 in the control device 400. For example, the computer program 403 may be divided into Figure 4 The communication module 301 and the processing module 302 are shown.
[0140] The embodiments described above are only used to illustrate the technical solutions of the present invention, rather than to limit the same. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that the technical solutions described in the aforementioned embodiments may still be modified, or some of the technical features may be replaced by equivalents. Such modifications or replacements do not deviate the essence of the corresponding technical solutions from the spirit and scope of the technical solutions of the embodiments of the present invention, and should all be included in the protection scope of the present invention.
Claims
1. A cantilever type roadheader intelligent cutting control method, characterized in that: The cantilever type roadheader comprises a cutting arm and an intelligent cutting control system, wherein the intelligent cutting control system comprises a displacement sensor, a pressure sensor, an acceleration sensor and a current sensor, and the method comprises: Obtain the detection data of each sensor of the intelligent cutting control system and the scanning data of the tunnel section; Conduct coal and rock analysis based on the scanning data of the tunnel section to determine the distribution of coal and rock in the tunnel section; Calculating each joint angle of the cantilever roadheader based on the detection data of each sensor; Determining posture information of the cantilever roadheader based on the joint angles of the cantilever roadheader; Based on the posture information of the cantilever type roadheader, a roadheader behavior model is updated; Based on the distribution of coal and rock in the tunnel section and the behavior model of the tunnel boring machine, the movement of the cutting arm of the cantilever tunnel boring machine is controlled to achieve cutting of coal and rock in the tunnel section.
2. The intelligent cutting control method for a cantilevered roadheader according to claim 1, characterized in that: The scanning data includes the reflection intensity and curvature of each point on the tunnel section; Accordingly, the coal-rock analysis based on the scanning data of the tunnel section to determine the coal-rock distribution of the tunnel section includes: Based on the reflection intensity and curvature of each point in the tunnel section, an identification vector is generated, wherein the identification vector includes the position coordinates, reflection intensity and curvature of each point in the tunnel section; Input the recognition vector into a preset recognition model to obtain coal-rock properties of each point on the tunnel section, wherein the coal-rock properties include coal area and rock area; Based on the coal and rock properties of each point on the roadway section, the coal and rock distribution of the roadway section is determined; the coal and rock distribution is used to characterize the area and boundary of the coal area and rock area on the roadway section.
3. The intelligent cutting control method for a cantilevered roadheader according to claim 1, characterized in that: The cutting arm comprises a cutting part, a telescopic part and a rotating part; the cutting part is mounted on one end of the telescopic part, the other end of the telescopic part is mounted on one end of the rotating part, and the other end of the rotating part is mounted on the cantilever type tunnel boring machine; the cutting part comprises a cutting head, a first telescopic oil cylinder rod and a second telescopic oil cylinder rod; the first telescopic oil cylinder rod and the second telescopic oil cylinder rod control the forward and backward extension of the cutting head; the telescopic part comprises a first pitch oil cylinder rod and a second pitch oil cylinder rod; the telescopic part controls the up and down pitch of the cutting part; the rotating part comprises a first rotating oil cylinder rod and a second rotating oil cylinder rod; the rotating part controls the left and right rotation of the telescopic part and the cutting part; The displacement sensors include a first displacement sensor provided on the first rotary oil cylinder rod, a second displacement sensor provided on the second rotary oil cylinder rod, a third displacement sensor provided on the first pitch oil cylinder rod, a fourth displacement sensor provided on the second pitch oil cylinder rod, a fifth displacement sensor provided on the first telescopic oil cylinder rod, and a sixth displacement sensor provided on the second telescopic oil cylinder rod; The pressure sensors include a first pressure sensor provided on the first rotary oil cylinder rod, a second pressure sensor provided on the second rotary oil cylinder rod, a third pressure sensor provided on the first pitch oil cylinder rod, a fourth pressure sensor provided on the second pitch oil cylinder rod, a fifth pressure sensor provided on the first telescopic oil cylinder rod, and a sixth pressure sensor provided on the second telescopic oil cylinder rod; The acceleration sensor is installed on the cutting head to detect the acceleration of the cutting head; The current sensor is installed in the driving system of the cantilever roadheader to detect the driving current of the cantilever roadheader; The calculating of each joint angle of the cantilever type roadheader based on the detection data of each sensor includes: Based on the detection data of each pressure sensor and current sensor, determine the oil cylinder in the cantilever type roadheader that is working normally; Based on the detection data of each displacement sensor, the cylinder displacement corresponding to each normally working cylinder is calculated; Based on the cylinder displacement corresponding to each normally working cylinder, the joint angles of the cantilever roadheader are determined; the joint angles of the cantilever roadheader include a first joint angle between the cutting part and the telescopic part, and a second joint angle between the telescopic part and the rotating part.
4. The intelligent cutting control method for a cantilever type roadheader according to claim 3 is characterized in that: The determining of the posture information of the cantilever roadheader based on the joint angles of the cantilever roadheader comprises: Based on the position coordinates of the cantilever type roadheader, determining the starting point coordinates and direction of the slewing part; Determine the starting point coordinates and direction of the telescopic portion based on the second joint angle between the telescopic portion and the rotating portion, and the starting point coordinates and direction of the rotating portion; Determine the position coordinates and direction of the cutting portion based on a first joint angle between the cutting portion and the telescopic portion, and the starting point coordinates and direction of the telescopic portion; Determining the position coordinates of the cutting head based on the position coordinates and direction of the cutting portion and the detection data of the fifth displacement sensor and the sixth displacement sensor; The posture information of the boom boring machine is determined based on the position coordinates of the cutting head, the position coordinates and direction of the cutting part, the starting point coordinates and direction of the telescopic part, and the starting point coordinates and direction of the slewing part.
5. The intelligent cutting control method for a cantilever type roadheader according to claim 1, characterized in that: The updating of the roadheader behavior model based on the posture information of the cantilever roadheader comprises: Based on the latest coordinate data of the cantilevered roadheader, the position coordinates of the roadheader behavior model are updated; Based on the starting point coordinates and direction of the rotating part, the rotating part of the roadheader behavior model after the updated coordinates is updated; Based on the starting point coordinates and direction of the telescopic part, the telescopic part of the roadheader behavior model after the rotary part is updated is updated; Based on the position coordinates of the cutting head, the position coordinates and the direction of the cutting part, the cutting part of the roadheader behavior model after the telescopic part is updated is updated to obtain an updated roadheader behavior model.
6. The intelligent cutting control method for a cantilevered roadheader according to claim 1, characterized in that: The controlling the movement of the cutting arm of the cantilever type roadheader based on the distribution of coal and rock in the roadway section and the roadheader behavior model to achieve the cutting of coal and rock in the roadway section includes: Based on the distribution of coal and rock in the tunnel section, determine the excavation area at the next moment and the cutting acceleration corresponding to the excavation area; Based on the excavation area at the next moment and the behavior model of the tunnel boring machine, a tunnel boring control instruction is generated, wherein the tunnel boring control instruction is used to instruct the cutting head to move to the excavation area at the next moment; Based on the cutting acceleration corresponding to the excavation area, a cutting instruction is generated, wherein the cutting instruction is used to instruct the cutting head to cut the excavation area at the next moment at the cutting acceleration.
7. The intelligent cutting control method for a cantilever type roadheader according to claim 6, characterized in that: The generating of the tunneling control instruction based on the tunneling area at the next moment and the tunneling machine behavior model includes: Based on the excavation area at the next moment and the behavior model of the tunnel boring machine, determining the rotation displacement of the rotary part, the pitch displacement of the telescopic part, and the telescopic displacement of the cutting part; Based on the slewing displacement of the slewing part, the pitching displacement of the telescopic part and the telescopic displacement of the cutting part, the movement displacement and movement direction of each cylinder rod of the cutting arm are determined; The excavation control instruction is generated based on the movement displacement and movement direction of each cylinder rod of the cutting arm.
8. The intelligent cutting control method for a cantilevered roadheader according to claim 1, characterized in that: After controlling the movement of the cutting arm of the cantilever type roadheader based on the distribution of coal and rock in the roadway section and the roadheader behavior model to achieve cutting of coal and rock in the roadway section, the method further includes: Obtain the excavation point position of the cutting head at each time in the historical period; Based on the excavation point position of the cutting head at each moment, drawing a cutting path of the cantilever type roadheader; Based on the cutting path and the tunnel model, determining a three-dimensional cutting path of the cantilever roadheader; The three-dimensional cutting path is displayed.
9. A control device for an intelligent cutting control system of a cantilever type roadheader, characterized in that: The cantilever type roadheader comprises a cutting arm and an intelligent cutting control system, wherein the intelligent cutting control system comprises a displacement sensor, a pressure sensor, an acceleration sensor and a current sensor, and the control device comprises: Communication module, used to obtain detection data of each sensor of the intelligent cutting control system and scanning data of the tunnel section; A processing module is used to perform coal-rock analysis based on the scanning data of the tunnel section to determine the distribution of coal and rock in the tunnel section; calculate the joint angles of the cantilever tunneling machine based on the detection data of each sensor; determine the posture information of the cantilever tunneling machine based on the joint angles of the cantilever tunneling machine; update the tunneling machine behavior model based on the posture information of the cantilever tunneling machine; control the movement of the cutting arm of the cantilever tunneling machine based on the coal and rock distribution of the tunnel section and the tunneling machine behavior model to achieve cutting of coal and rock in the tunnel section.
10. An intelligent cutting control system for a cantilevered roadheader, characterized in that: The cantilever type roadheader comprises a cutting arm and an intelligent cutting control system, wherein the intelligent cutting control system comprises a displacement sensor, a pressure sensor, an acceleration sensor, a current sensor and a control device. The cutting arm comprises a cutting part, a telescopic part and a rotating part; the cutting part is mounted on one end of the telescopic part, the other end of the telescopic part is mounted on one end of the rotating part, and the other end of the rotating part is mounted on the cantilever type tunnel boring machine; the cutting part comprises a cutting head, a first telescopic oil cylinder rod and a second telescopic oil cylinder rod; the first telescopic oil cylinder rod and the second telescopic oil cylinder rod control the forward and backward extension of the cutting head; the telescopic part comprises a first pitch oil cylinder rod and a second pitch oil cylinder rod; the telescopic part controls the up and down pitch of the cutting part; the rotating part comprises a first rotating oil cylinder rod and a second rotating oil cylinder rod; the rotating part controls the left and right rotation of the telescopic part and the cutting part; The displacement sensors include a first displacement sensor provided on the first rotary oil cylinder rod, a second displacement sensor provided on the second rotary oil cylinder rod, a third displacement sensor provided on the first pitch oil cylinder rod, a fourth displacement sensor provided on the second pitch oil cylinder rod, a fifth displacement sensor provided on the first telescopic oil cylinder rod, and a sixth displacement sensor provided on the second telescopic oil cylinder rod; The pressure sensors include a first pressure sensor provided on the first rotary oil cylinder rod, a second pressure sensor provided on the second rotary oil cylinder rod, a third pressure sensor provided on the first pitch oil cylinder rod, a fourth pressure sensor provided on the second pitch oil cylinder rod, a fifth pressure sensor provided on the first telescopic oil cylinder rod, and a sixth pressure sensor provided on the second telescopic oil cylinder rod; The acceleration sensor is installed on the cutting head to detect the acceleration of the cutting head; The current sensor is installed in the driving system of the cantilever roadheader to detect the driving current of the cantilever roadheader; The control device is used to execute the steps of the method according to any one of claims 1 to 8.
Citation Information
Cited By
Transverse and longitudinal dual-mode cooperative cutting part, heading machine and control method of heading machine
CN122236469A
A horizontal and vertical dual-mode collaborative cutting section, a tunneling machine and its control method
CN122236469B
