Autonomous moving control method and control system for heading machine

Through the integrated positioning, display, control and execution systems, the autonomous moving control of the tunneling machine is realized, which solves the problems of inefficiency and safety hazards of traditional tunneling machines, and significantly improves the automation level and safety.

CN118979753APending Publication Date: 2024-11-19TAIYUAN INST OF CHINA COAL TECH & ENG GROUP +1
View PDF 0 Cites 2 Cited by

Patent Information

Application Number
CN202410963204.9
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-18
Publication Date
2024-11-19

AI Technical Summary

Technical Problem

The traditional boring machine moves the machine process relies on manual operation, is inefficient and has safety risks, and cannot adapt to complex on-site environments.

Method used

The integrated positioning system, display system, control system and execution system are adopted to realize the autonomous moving control of the tunneling machine by monitoring the position, attitude and speed of the tunneling machine in real time, automatically plan the moving path and adjust the moving parameters. Specific steps include obtaining the coordinates of the current position, calculating the number of swings and angle information required to the target position, and real-time monitoring and adjustment to ensure accuracy through tracking actions.

Benefits of technology

The automation level of the boring machine is improved, the difficulty of manual intervention and operation is reduced, the work efficiency and safety is improved, and the technical level of coal mine excavation operations is significantly improved.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118979753A_ABST
    Figure CN118979753A_ABST
Patent Text Reader

Abstract

The invention belongs to the technical field of automatic moving control of heading machines, and particularly relates to an automatic moving control method and system of a heading machine. Comprising the following steps: S1, acquiring a current position coordinate (X1, Y1, alpha1) of the heading machine; s2, according to the real-time machine body coordinates (X, Y, alpha) of the heading machine, calculating the swinging times, position information and angle information of the heading machine when the heading machine swings to the target coordinates (Xn, Yn, alpha n); and S3, controlling the crawler action of the heading machine according to the calculation result. By integrating the positioning system, the display system, the control system and the execution system, the automatic moving of the heading machine is realized.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention belongs to the technical field of automatic moving control of a tunnel boring machine, and in particular to an autonomous moving control method and control system for a tunnel boring machine. Background Art

[0002] Roadheaders are the main equipment for tunneling construction in coal mines. With the increasing demand for automation of roadheaders, intelligent control technology is increasingly being used in roadheaders. Autonomous movement control technology of roadheaders is the key to ensuring tunneling operations. In traditional operation methods, drivers usually need to drive the roadheader to the middle of the tunnel for cutting. Although this method is simple and direct, it lacks sufficient flexibility and cannot adapt to complex and changing on-site environments.

[0003] In order to solve the above problems, the present invention proposes a method for controlling the autonomous movement of a tunnel boring machine. The method realizes the monitoring and control of the tunnel boring machine movement process by integrating the positioning system, display system, control system and execution system. Specifically, the positioning system can monitor the position, posture and speed of the tunnel boring machine in real time, and provide the control system with accurate tunnel boring machine operation data. Based on these data, the control system automatically plans the movement path of the tunnel boring machine and adjusts its movement parameters to ensure that the tunnel boring machine can achieve efficient and stable operation. Summary of the invention

[0004] In order to solve the technical problems of reliance on manual operation, low efficiency and great safety hazards in the moving process of a traditional tunnel boring machine, the present invention provides an autonomous moving control method and control system for a tunnel boring machine.

[0005] The present invention adopts the following technical solution: a method for controlling an autonomous moving machine of a roadheader, comprising: S1: Get the current position coordinates of the tunnel boring machine ( X 1, Y 1, α 1); S2: According to the real-time coordinates of the tunnel boring machine ( X , Y , α ), calculate the tunnel boring machine to the target coordinates ( X n , Y n , α n ) when the tunnel boring machine needs to swing, the position information and the angle information; S3: Control the movement of the tunnel boring machine crawler according to the calculation results.

[0006] In some embodiments, step S2 includes: S21: Obtain the current precise position coordinates of the tunnel boring machine through the positioning system ( X 1,Y 1) and yaw angle α 1; S22: According to the operation requirements, the target position coordinates of the tunnel boring machine are set in the tunnel coordinate system ( X n , Y n ) and the target yaw angle α n ; S23: The control system is based on the current position ( X 1, Y 1, α 1) and target location ( X n , Y n , α n ), calculate the number of swings the tunnel boring machine needs to make, the position information and angle information of each swing, so as to ensure that the tunnel boring machine can move to the target position in the most efficient way; S24: According to the result of the path planning, the crawler of the tunnel boring machine is controlled to perform corresponding actions to realize the gradual movement of the tunnel boring machine; S25: Real-time monitoring and adjustment of the tunnel boring machine; S26: When the tunnel boring machine reaches the target position ( X n , Y n ) and adjust the yaw angle α n After that, the control system will send a stop command and the tunnel boring machine will stop moving.

[0007] In some embodiments, step S23 includes: S231: Population initialization, initial population O i ={( x i,1 , y i,1 , α i,1 ), ( x i,2 , y i,2 , α i,2 ),…,( x i,D , y i,D , α i,D )}, i =(1, 2,…, NP ),in NPis the population size, D is the dimension, ( x i,j , y i,j , α i,j ) are the position coordinates of the center of gravity of the roadheader and the yaw angle in the tunnel; S232: Setting fitness function; S233: Entering the evolution cycle, setting the maximum number of iterations or termination conditions of the evolutionary algorithm, performing mutation, crossover and selection operations on each individual in the population, and generating new test individuals; S234: Mutation operation, which specifically refers to selecting three different individuals in each generation of the population , and , two of the individuals and Differencing and scaling factor F , 0< F <1, after scaling, with the third individual Add together to get the mutation vector ; Where g is the evolutionary generation number, and i =(1, 2, ..., NP ), F is the scaling factor; S235: crossover operation, performing a crossover operation on the mutation vector and the target vector to generate a test vector; S236: Selection operation to generate the next generation target vector , according to the target vector and the test vector The fitness value To select the best individual, if the fitness value of the test vector is better, the target vector is replaced by the test vector, otherwise the target vector is retained; S237: Iterative update, repeating steps S233 to S236 until the maximum number of iterations is reached or other termination conditions are met; S238: After the iteration is completed, the individual with the best fitness is selected as the final moving path, and the number of times the tunnel boring machine needs to swing, the position information and the angle information of each swing are output.

[0008] In some embodiments, in step S231, the possible value range of each individual in the initial population is determined according to the tunnel size and the tunnel boring machine size; Lane size: Lane length KH, width LH Tunnel boring machine size: Tunnel boring machine length KJ, width LJ The value range of each individual in the initial population is within the effective value range where the tunnel boring machine body does not collide with the tunnel, as follows: Xi takes values ​​in [-(LH-LJ) / 2,(LH-LJ) / 2]; yi takes values ​​in [0, KH]; αi takes values ​​within [-ATAN(KJ / 2LH), ATAN(KJ / 2LH)]; An initial population is randomly generated, in which each individual represents a possible movement path.

[0009] In some embodiments, in step S232, the fitness function is set based on the goal of minimizing the total distance moved by the tunnel boring machine, specifically as follows: In the above formula, f Represents the shortest collision-free path for the tunnel boring machine; a penalty function is used for collisions between the machine body and the tunnel deal with; is a penalty factor that can make the collision path longer.

[0010] A control system, comprising: Positioning system: used to monitor the yaw angle of the tunnel boring machine, the coordinate value of the machine body and the distance from the two sides of the tunnel; Display system: used to display the operation data and movement track of the roadheader; Control system: used to collect operation data of the tunnel boring machine, perform path planning and output control instructions according to the tunnel boring machine autonomous moving control method as described in any one of claims 1 to 5; Execution system: used to perform real-time actions according to the action instructions output by the control system.

[0011] In some embodiments, the positioning system includes a navigation device, a multi-channel sensor, and a camera; The navigation device is used to collect the heading angle, pitch angle and roll angle of the tunnel boring machine; The multi-channel sensor is used to collect the distance between the tunnel boring machine and the two sides and the front; The camera is used to collect video images of the tunnel boring machine and locate the position of the tunnel boring machine in the tunnel.

[0012] In some embodiments, the control system includes a data acquisition module and a control module; The data acquisition module is used to collect various sensor information and receive the crawler motion signal of the tunnel boring machine in real time; The control module is used for controlling signal storage, judgment and output.

[0013] In some embodiments, the multi-channel sensor includes a distance sensor and a lidar sensor; the sensor is used to monitor the distance status between the tunnel boring machine and the tunnel section.

[0014] Compared with the prior art, the present invention has the following beneficial effects: The present invention realizes the automatic movement of the tunnel boring machine by integrating the positioning system, display system, control system and execution system. The positioning system accurately monitors the yaw angle and center of gravity coordinates of the tunnel boring machine to ensure the accuracy of the movement process. The display system displays the positioning data and movement trajectory in real time, which improves the visualization of the operation. The control system captures sensor information and crawler action signals in real time through the data acquisition module, and the control module intelligently stores, judges and outputs these signals, realizing rapid response and accurate control of the tunnel boring machine's actions. The solenoid valve in the execution system operates in real time according to the control signal, ensuring the smoothness and coordination of the tunnel boring machine's actions. Overall, this method significantly improves the automation level of tunnel boring machine movement, reduces manual intervention and operation difficulty, improves work efficiency and safety, and plays an important technical role in promoting coal mine excavation operations. BRIEF DESCRIPTION OF THE DRAWINGS

[0015] Figure 1 is a control system diagram of the present invention; Figure 2 The present invention is a flow chart of the autonomous moving control method of the tunnel boring machine. DETAILED DESCRIPTION

[0016] In order to make the purpose, technical solutions and advantages of the embodiments of the present invention clearer, the technical solutions in the embodiments of the present invention will be clearly and completely described below. Obviously, the described embodiments are part of the embodiments of the present invention, rather than all the embodiments; based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without making creative work are within the scope of protection of the present invention.

[0017] like Figure 1 As shown, a control system comprises: Positioning system: used to monitor the yaw angle of the tunnel boring machine, the coordinate value of the machine body and the distance from the two sides of the tunnel; Display system: used to display the operation data and movement track of the roadheader; Control system: used to collect data of tunnel boring machine operation, implement path planning and output control instructions for autonomous movement control of tunnel boring machine; Execution system: used to perform real-time actions according to the action instructions output by the control system.

[0018] The positioning system includes a navigation device, multi-channel sensors and a camera; The navigation device is used to collect the heading angle, pitch angle and roll angle of the tunnel boring machine; The multi-channel sensor is used to collect the distance between the tunnel boring machine and the two sides and the front; The camera is used to collect video images of the tunnel boring machine and locate the position of the tunnel boring machine in the tunnel.

[0019] The control system includes a data acquisition module and a control module; The data acquisition module is used to collect various sensor information and receive the crawler motion signal of the tunnel boring machine in real time; The control module is used for controlling signal storage, judgment and output.

[0020] The multi-channel sensor includes a distance sensor and a laser radar sensor; the sensor is used to monitor the distance status between the tunnel boring machine and the tunnel section.

[0021] like Figure 2 As shown, a method for controlling an autonomous moving machine of a tunnel boring machine comprises: S1: Get the current position coordinates of the tunnel boring machine ( X 1, Y 1, α 1).

[0022] S2: According to the real-time coordinates of the tunnel boring machine ( X , Y , α ), calculate the tunnel boring machine to the target coordinates ( X n , Y n , α n ) when the tunnel boring machine needs to swing, the position information and the angle information; Calculate the tunnel boring machine to the target coordinates ( X n , Y n , α n ), the number of times the tunnel boring machine needs to swing, the position information and the angle information, characterized in that it includes the following steps; Step 1: Initialization, ensure that all system components (such as positioning system, control system, etc.) are in normal working condition.

[0023] Step 2: Get the current position and obtain the current precise coordinates of the tunnel boring machine through the positioning system ( X 1, Y 1) and yaw angle ( α 1).

[0024] Step 3: Set the target position. According to the operation requirements, set the target position coordinates of the tunnel boring machine in the tunnel coordinate system (X n , Y n ) and the target yaw angle ( α n ).

[0025] Step 4: Path planning, the control system is based on the current position ( X 1, Y 1, α 1) and target location ( X n , Y n , α n ), calculates the number of times the tunnel boring machine needs to swing, the position information and angle information of each swing, to ensure that the tunnel boring machine can move to the target position in the most efficient way.

[0026] Step 5: Action execution: According to the results of path planning, the control system sends instructions to the execution system to control the crawler of the tunnel boring machine to perform corresponding actions. These actions include forward, backward, left turn, right turn, etc., to achieve the step-by-step movement of the tunnel boring machine.

[0027] Step 6: Real-time monitoring and adjustment. During the movement of the tunnel boring machine, the positioning system continuously monitors its actual position ( X , Y ) and yaw angle ( α ), and compares it with the target position. If deviation is found, the control system will make real-time adjustments to ensure that the tunnel boring machine can move accurately along the planned path.

[0028] Step 7: Arrival at the target location. When the tunnel boring machine reaches the target location ( X n , Y n ) and adjust the yaw angle ( α n ), the control system will send a stop command, the tunnel boring machine will stop moving, and the autonomous moving process will be completed.

[0029] Step 8: System display and recording. During the entire machine moving process, the control system will record all key data (such as position, angle, moving speed, etc.) for subsequent analysis and optimization. At the same time, this information is also displayed synchronously on the real system and can be fed back to the operator in real time to improve the transparency and safety of the operation.

[0030] Using differential evolution algorithm for path planning includes the following steps: Step 1: Population initialization, initial population O i ={( xi,1 , y i,1 , α i,1 ), ( x i,2 , y i,2 , α i,2 ),…,( x i,D , y i,D , α i,D )}, i =(1, 2,…, NP ),in NP is the population size, D is the dimension, ( x i,j , y i,j , α i,j ) are the coordinates of the center of gravity of the tunnel boring machine and the yaw angle in the tunnel. According to the tunnel size and the tunnel boring machine size, the possible value range of each individual in the initial population is determined, and an initial population is randomly generated, in which each individual represents a possible movement path.

[0031] According to the size of the tunnel and the size of the tunnel boring machine, determine the possible value range of each individual in the initial population; Lane size: Lane length KH, width LH Tunnel boring machine size: Tunnel boring machine length KJ, width LJ The value range of each individual in the initial population is within the effective value range where the tunnel boring machine body does not collide with the tunnel, as follows: Xi takes values ​​in [-(LH-LJ) / 2,(LH-LJ) / 2]; yi takes values ​​in [0, KH]; αi takes values ​​within [-ATAN(KJ / 2LH), ATAN(KJ / 2LH)]; An initial population is randomly generated, in which each individual represents a possible movement path.

[0032] Step 2: Set the fitness function. For the roadheader path planning problem, design a path model that takes the roadheader from the starting point to the target point to evaluate the quality of each individual (i.e., moving path). The fitness function is set based on the goal of minimizing the total distance moved by the roadheader, as shown in the following formula: (1) (2) In the above formula,f Represents the shortest collision-free path for the tunnel boring machine; a penalty function is used for collisions between the machine body and the tunnel deal with. is a penalty factor that can make the collision path longer.

[0033] Step 3: Enter the evolution cycle and set the maximum number of iterations or termination condition of the evolutionary algorithm to times, performing mutation, crossover, and selection operations on each individual in the population to generate new experimental individuals.

[0034] Step 4: Mutation operation. The mutation method used is DE / rand / 1. The mutation operation specifically refers to selecting three different individuals in each generation of the population. , and , two of the individuals and Differencing and scaling factor F , 0< F <1, after scaling, with the third individual Add together to get the mutation vector ; As shown in formula (3); (3) Where g is the evolutionary generation, and i =(1, 2, ..., NP ), F is the scaling factor.

[0035] Step 5: Crossover operation, cross the mutation vector with the target vector to generate a test vector. The crossover operation can be a simple binomial crossover or an exponential crossover, as shown in formula (4); (4) Where j=1,2,…,D, CR∈(0,1) is the crossover rate, is a randomly selected integer in [1,D]; through the crossover operation, the test vector incorporates the information of the target vector and the mutation vector.

[0036] Step 6: Select an operation to generate the next generation of target vectors , according to the target vector and the test vector The fitness value To select the best individual, if the fitness value of the test vector is better, the target vector is replaced by the test vector, otherwise the target vector is retained, as shown in formula (5); (5) Step 7: Iterate and update, repeating steps 3 to 6 until the maximum number of iterations is reached or other termination conditions are met.

[0037] Step 8: Result output. After the iteration is completed, the individual with the best fitness is selected as the final moving path, and the number of times the tunnel boring machine needs to swing, the position information and angle information of each swing are output.

[0038] S3: Control the movement of the tunnel boring machine crawler according to the calculation results.

[0039] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit it. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned embodiments, or replace some or all of the technical features therein with equivalents. However, these modifications or replacements do not cause the essence of the corresponding technical solutions to deviate from the scope of the technical solutions of the embodiments of the present invention.

Claims

1. A method for controlling the autonomous movement of a tunnel boring machine, characterized in that: include: S1: Get the current position coordinates of the tunnel boring machine ( X 1, Y 1, α 1); S2: According to the real-time coordinates of the tunnel boring machine ( X , Y , α ), calculate the tunnel boring machine to the target coordinates ( X n , Y n , α n ) when the tunnel boring machine needs to swing, the position information and the angle information; S3: Control the movement of the tunnel boring machine crawler according to the calculation results.

2. The method for controlling the autonomous movement of a tunnel boring machine according to claim 1, characterized in that: The step S2 comprises: S21: Obtain the current precise position coordinates of the tunnel boring machine through the positioning system ( X 1, Y 1) and yaw angle α 1; S22: According to the operation requirements, the target position coordinates of the tunnel boring machine are set in the tunnel coordinate system ( X n , Y n ) and the target yaw angle α n ; S23: The control system is based on the current position ( X 1, Y 1, α 1) and the target location ( X n , Y n , α n ), calculate the number of swings the tunnel boring machine needs to make, the position information and angle information of each swing, so as to ensure that the tunnel boring machine can move to the target position in the most efficient way; S24: According to the result of the path planning, the crawler of the tunnel boring machine is controlled to perform corresponding actions to realize the gradual movement of the tunnel boring machine; S25: Real-time monitoring and adjustment of the tunnel boring machine; S26: When the tunnel boring machine reaches the target position ( X n , Y n ) and adjust the yaw angle α n After that, the control system will send a stop command and the tunnel boring machine will stop moving.

3. The method for controlling the autonomous movement of a tunnel boring machine according to claim 2, characterized in that: The step S23 comprises: S231: Population initialization, initial population O i ={( x i,1 , y i,1 , α i,1 ), ( x i,2 , y i,2 , α i,2 ),…,( x i,D , y i,D , α i,D )}, i =(1, 2,…, NP ),in NP is the population size, D is the dimension, ( x i,j , y i,j , α i,j ) are the position coordinates of the center of gravity of the roadheader and the yaw angle in the tunnel; S232: Setting fitness function; S233: Entering the evolution cycle, setting the maximum number of iterations or termination conditions of the evolutionary algorithm, performing mutation, crossover and selection operations on each individual in the population, and generating new test individuals; S234: Mutation operation, which specifically refers to selecting three different individuals in each generation of the population , and , two of the individuals and Differencing and scaling factor F , 0< F <1, after scaling, with the third individual Add together to get the mutation vector ; Where g is the evolutionary generation number, and i =(1, 2, ..., NP ), F is the scaling factor; S235: crossover operation, performing a crossover operation on the mutation vector and the target vector to generate a test vector; S236: Selection operation to generate the next generation target vector , according to the target vector and the test vector The fitness value To select the best individual, if the fitness value of the test vector is better, the target vector is replaced by the test vector, otherwise the target vector is retained; S237: Iterative update, repeating steps S233 to S236 until the maximum number of iterations is reached or other termination conditions are met; S238: After the iteration is completed, the individual with the best fitness is selected as the final moving path, and the number of times the tunnel boring machine needs to swing, the position information and the angle information of each swing are output.

4. The method for controlling the autonomous movement of a tunnel boring machine according to claim 2, characterized in that: In the step S231, the possible value range of each individual in the initial population is determined according to the tunnel size and the tunnel boring machine size; Lane size: Lane length KH, width LH Tunnel boring machine size: Tunnel boring machine length KJ, width LJ The value range of each individual in the initial population is within the effective value range where the tunnel boring machine body does not collide with the tunnel, as follows: Xi takes values ​​in [-(LH-LJ) / 2,(LH-LJ) / 2]; yi takes values ​​in [0, KH]; αi takes values ​​within [-ATAN(KJ / 2LH), ATAN(KJ / 2LH)]; An initial population is randomly generated, in which each individual represents a possible movement path.

5. The method for controlling the autonomous movement of a tunnel boring machine according to claim 2, characterized in that: Said In step S232, the fitness function is set based on the goal of minimizing the total distance moved by the tunnel boring machine, as shown in the following formula: In the above formula, f Represents the shortest collision-free path for the tunnel boring machine; a penalty function is used for collisions between the machine body and the tunnel deal with; is a penalty factor that can make the collision path longer.

6. A control system, characterized in that: include: Positioning system: used to monitor the yaw angle of the tunnel boring machine, the coordinate value of the machine body and the distance from the two sides of the tunnel; Display system: used to display the operation data and movement track of the roadheader; Control system: used to collect operation data of the tunnel boring machine, perform path planning and output control instructions according to the tunnel boring machine autonomous moving control method as described in any one of claims 1 to 5; Execution system: used to perform real-time actions according to the action instructions output by the control system.

7. The control system according to claim 6, characterized in that: The positioning system includes a navigation device, a multi-channel sensor and a camera; The navigation device is used to collect the heading angle, pitch angle and roll angle of the tunnel boring machine; The multi-channel sensor is used to collect the distance between the tunnel boring machine and the two sides and the front; The camera is used to collect video images of the tunnel boring machine and locate the position of the tunnel boring machine in the tunnel.

8. The control system according to claim 6, characterized in that: The control system includes a data acquisition module and a control module; The data acquisition module is used to collect various sensor information and receive the crawler motion signal of the tunnel boring machine in real time; The control module is used for controlling signal storage, judgment and output.

9. The control system according to claim 7, characterized in that: The multi-channel sensor includes a distance measuring sensor and a laser radar sensor; the sensor is used to monitor the distance status between the tunnel boring machine and the tunnel section.

Citation Information

Cited By

  • Intelligent control method and control system for tunneling path of tunneling machine

    CN120233727A

  • Tunneling machine propelling deviation rectification control method and medium

    CN121088415A