AGV, system and method for detecting underground metal equipment

By designing underground metal equipment for complex terrain environments to detect AGV, combined with three-dimensional scanners and remote control systems, the existing minesweeping technology is solved, and the problem of inappropriate and labor consumption in complex terrain is realized, and efficient and safe metal equipment is achieved Demolition process.

CN113138599BActive Publication Date: 2024-11-29GUANGDONG JATEN ROBOT & AUTOMATION
View PDF 6 Cites 0 Cited by

Patent Information

Application Number
CN202110429639.1
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2021-04-21
Publication Date
2024-11-29
Estimated Expiration
2041-04-21

AI Technical Summary

Technical Problem

Existing minesweepers are not suitable in complex terrain environments, with high labor costs and safety hazards, and robot minesweeping costs and low efficiency.

Method used

Design an underground metal equipment detection AGV equipped with a metal detector, three-dimensional scanner, camera and remote control system. The detection and position confirmation of metal equipment are completed through the AGV, and the position information and walking route are sent to the remote control terminal to assist Manual removal.

Benefits of technology

It improves mine clearance efficiency, reduces manpower risks, ensures accurate location confirmation and safe removal of metal equipment, and reduces robot costs and operational complexity.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN113138599B_ABST
    Figure CN113138599B_ABST
Patent Text Reader

Abstract

The present invention discloses an AGV, a detection system and a method for detecting underground metal equipment. The detection AGV includes a detector swing arm, a metal detector, a three-dimensional scanner, multiple cameras, a control module, a communication module and an antenna. The metal detector is used to detect underground metal equipment; the three-dimensional scanner is used to obtain three-dimensional terrain data; the control module is used to control the working state of the AGV; the camera is used to obtain surrounding images; and the antenna is used to communicate with a remote control terminal. When the AGV detects underground metal equipment, it sends the location information of the AGV, the surrounding three-dimensional terrain data of the underground metal equipment and the image around the AGV to the remote control terminal, so that the remote control terminal can determine the location of the underground metal equipment and re-plan the basic walking route of the AGV. The location confirmation of the underground metal equipment is left to the robot to handle, and on the other hand, the processing process of the underground metal equipment is left to manual processing, which ensures processing efficiency.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of metal detection, and in particular to an AGV, a detection system and a method for detecting underground metal equipment. Background Art

[0002] Metal equipment Taking mines as an example, currently mine-clearing vehicles are mainly divided into mechanical mine-clearing vehicles, blasting mine-clearing vehicles and mechanical blasting combined mine-clearing vehicles. The basic principle is to deliberately detonate mines to clear mines. Moreover, such mine-clearing vehicles are driven by people, so they need to be made relatively strong, with relatively large and heavy overall size. They are not suitable for mountainous and forest environments with complex terrain, and therefore are not suitable for forest minefields in Southeast Asia. Other low-cost mine-clearing methods are based on manual detection, which generally consumes a lot of manpower and poses a great safety hazard to personnel. If mine-clearing is completely handled by robots, there are problems such as greater difficulty in operation, high cost of robots, and low overall operating efficiency. Summary of the invention

[0003] The present invention provides an AGV, a detection system and a method for detecting underground metal equipment to solve one or more technical problems existing in the prior art and at least provide a beneficial choice or create conditions.

[0004] In a first aspect, an embodiment of the present invention provides an AGV for detecting underground metal equipment, including:

[0005] The main body of the vehicle;

[0006] A first drive assembly is disposed at the front end of the vehicle body, and a second drive assembly is disposed at the rear end of the vehicle body;

[0007] The detector swing arm is respectively hinged to the first driving assembly and the metal detector, and is used to adjust the position of the metal detector;

[0008] A metal detector, located in front of the vehicle body, is hinged to the detector swing arm and is used to detect metal equipment in front of the AGV;

[0009] A fixing frame is arranged in the middle of the vehicle body, and is located between the first driving assembly and the second driving assembly. The front side, rear side, left side, rear side and top of the fixing frame respectively have a front plate, a rear plate, a left plate, a right plate and a top plate. The front plate of the fixing frame is fixedly connected to the first driving assembly, and the rear plate panel of the fixing frame is fixedly connected to the second driving assembly.

[0010] A three-dimensional scanner is arranged on the top plate of the fixing frame, and the three-dimensional scanner is used to obtain three-dimensional terrain data;

[0011] An electrical box is located at the bottom of the fixing frame and is arranged between the front plate and the rear plate. A control module is arranged inside the electrical box to control the working state of the AGV;

[0012] A camera is respectively arranged on the front plate, the rear plate, the left plate and the right plate of the fixing frame to obtain an image around the AGV;

[0013] The antenna is arranged on any one of the front plate, the rear plate, the left plate and the right plate, and is located at the lower end of the camera, and is used for communicating with the remote control end;

[0014] A communication module is also arranged inside the electrical box, and the communication module is used to be connected to the antenna, and the control module is respectively connected to each camera, the three-dimensional scanner, the metal detector and the communication module.

[0015] Furthermore, the detector swing arm includes a first arm, a second arm, a first motor, a second motor and a third motor; one end of the first arm is hinged to the first drive assembly, the other end of the first arm is hinged to one end of the second arm, the other end of the second arm is hinged to the metal detector, the first motor is arranged at the hinge point between the first arm and the first drive assembly, the second motor is arranged at the hinge point between the first arm and the second arm, and the third motor is arranged at the hinge point between the second arm and the metal detector; the first motor, the second motor and the third motor are respectively connected to the control module.

[0016] Furthermore, the first drive assembly includes a first connecting seat, a first drive motor, a first wheel and a second wheel. The first wheel and the second wheel are respectively arranged at two ends of the first connecting seat. The first drive motor is respectively connected to the first wheel and the second wheel through transmission. The first drive motor is connected to the control module.

[0017] Furthermore, the second drive assembly includes a second connecting seat, a second drive motor, a third wheel and a fourth wheel. The third wheel and the fourth wheel are respectively arranged at both ends of the second connecting seat. The second drive motor is respectively connected to the third wheel and the fourth wheel by transmission, and the second drive motor is connected to the control module.

[0018] Furthermore, the detection AGV also includes a positioning module, which is connected to the control module and is used to obtain the position information of the AGV.

[0019] In a second aspect, an embodiment of the present invention further provides a system for detecting underground metal equipment, comprising a remote control terminal and at least one AGV for detecting underground metal equipment as described in the first aspect.

[0020] In a third aspect, an embodiment of the present invention further provides a method for detecting underground metal equipment, which is applied to the detection system for underground metal equipment according to the second aspect, and the method includes:

[0021] S101, AGV establishes a communication connection with a remote control terminal;

[0022] S102, the remote control terminal obtains the location information of the AGV in real time;

[0023] S103, the remote control terminal plans a basic walking route based on the location information of the AGV, and sends the basic walking route to the corresponding AGV;

[0024] S104, AGV moves along the basic walking route and uses metal detectors for detection;

[0025] S105, the AGV determines whether it has reached the destination, if not, executes step S106; if yes, executes step S111;

[0026] S106, the AGV determines whether a metal device is found, if so, executes step S107, if not, executes step S104;

[0027] S107, the AGV obtains three-dimensional terrain data around the metal equipment through a three-dimensional scanner, obtains an image around the AGV through a camera, and sends the position information of the AGV, the three-dimensional terrain data and the image around the AGV to a remote control terminal;

[0028] S108, the remote control terminal determines the position of the metal equipment according to the position information of the AGV, the three-dimensional terrain data and the image around the AGV, and sends the position of the metal equipment and the basic walking route of the AGV to the terminal device of the metal equipment dismantling personnel, so that the metal equipment dismantling personnel can reach the position of the metal equipment according to the basic walking route of the AGV to dismantle the metal equipment;

[0029] S109, the remote control terminal replans the walking route based on the location information of the metal equipment and the location information of the AGV, and updates the basic walking route to the walking route;

[0030] S110, the remote control terminal sends the updated basic walking route to the corresponding AGV, and goes to step S104;

[0031] S111. AGV ends detection.

[0032] Further, in step S103, the remote control terminal plans the basic walking route based on the location information of the AGV, specifically:

[0033] The remote control terminal obtains the destination location;

[0034] The remote control terminal uses the current position of the AGV as the starting point and the destination position as the end point, wherein there are multiple nodes between the starting point and the end point, and the shortest route between two adjacent nodes is established in a straight line as the basic walking route.

[0035] Further, when there are multiple AGVs, namely including AGV and other AGVs, the remote control end communicates with the multiple AGVs to obtain the location information of the multiple AGVs in real time. Step S109 includes: the remote control end re-plans the walking route based on the location information of the metal equipment, the location information of the AGV and the location information of other AGVs, and updates the basic walking route to the said walking route.

[0036] Further, the remote control end replans the walking route based on the location information of the metal equipment, the location information of the AGV, and the location information of other AGVs, including: the remote control end determines the movement cost based on the location information of the metal equipment, the location information of the AGV, and the location information of other AGVs, and the route corresponding to the minimum movement cost is the walking route, wherein the cost of passing through the nth node is:

[0037] G(n)=G(n-1)+G run +G stop +G turn +G same +G reverse +G emptyRoute , n>1;

[0038] Where G(1) = 0; n ≤ Z; Z represents the Zth node, i.e., the end point;

[0039] G(n) is the cost of passing through the nth node;

[0040] G(n-1) is the cost of passing through the n-1th node;

[0041] G run is the walking cost when passing through the nth node;

[0042] G stop The cost of avoiding idle AGVs that stop within the safe distance of the path from the n-1th node to the nth node;

[0043] G turn is the turning cost of AGV;

[0044] G same The cost of waiting for other AGVs to pass through the section from the n-1th node to the nth node in the same direction;

[0045] G reverse The cost of avoiding other AGVs passing through the section from the n-1th node to the nth node in the opposite direction;

[0046] G emptyRoute The additional cost of detours to avoid metal equipment.

[0047] An AGV, a detection system, and a method for detecting underground metal equipment according to an embodiment of the present invention have at least the following beneficial effects: the AGV completes the metal equipment detection task, and sends the location information of the metal equipment detected by the AGV, the three-dimensional terrain data around the metal equipment, and the image equipment around the AGV to the remote control terminal, the remote control terminal determines the specific location of the metal equipment, and sends the location of the metal equipment and the basic walking route of the AGV to the personnel who dismantle the metal equipment, so that the personnel who dismantle the metal equipment can dismantle the metal equipment, leaving the location confirmation of the underground metal equipment to the robot to handle, and on the other hand, leaving the processing process of the underground metal equipment to manual processing, thereby ensuring processing efficiency. BRIEF DESCRIPTION OF THE DRAWINGS

[0048] The accompanying drawings are used to provide a further understanding of the technical solution of the present invention and constitute a part of the specification. Together with the embodiments of the present invention, they are used to explain the technical solution of the present invention and do not constitute a limitation on the technical solution of the present invention.

[0049] Figure 1 It is a schematic diagram of the structure of an AGV for detecting underground metal equipment provided by an embodiment of the present invention;

[0050] Figure 2 It is a schematic diagram of a state of a detector swing arm in one posture provided by an embodiment of the present invention;

[0051] Figure 3 is a schematic diagram of another posture of the detector swing arm provided by an embodiment of the present invention;

[0052] Figure 4 is a flow chart of a method for detecting underground metal equipment provided by an embodiment of the present invention;

[0053] Figure 5 It is a path scene graph of a detection area provided by an embodiment of the present invention. DETAILED DESCRIPTION

[0054] In order to make the purpose, technical solution and advantages of the present invention more clearly understood, the present invention is further described in detail below in conjunction with the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are only used to explain the present invention and are not used to limit the present invention.

[0055] It should be noted that, although the functional modules are divided in the system schematic diagram and the logical order is shown in the flowchart, in some cases, the steps shown or described may be performed in a different order than the module division in the system or the order in the flowchart. The terms "first", "second", etc. in the specification, claims and the above drawings are used to distinguish similar objects, and are not necessarily used to describe a specific order or sequence.

[0056] Figure 1 An AGV for detecting underground metal equipment provided by an embodiment of the present invention includes:

[0057] The vehicle body 100;

[0058] A first driving assembly 101 is disposed at the front end of the vehicle body 100, and a second driving assembly 102 is disposed at the rear end of the vehicle body;

[0059] The detector swing arm 103 is respectively hinged to the first driving assembly 101 and the metal detector 200, and is used to adjust the position of the metal detector 200;

[0060] The metal detector 200 is located in front of the vehicle body 100 and is hinged to the detector swing arm 103, and is used to detect metal equipment in front of the AGV;

[0061] A fixing frame 104 is provided in the middle of the vehicle body 100, and is located between the first driving assembly 101 and the second driving assembly 102. The front side, rear side, left side, rear side, and top of the fixing frame 104 respectively have a front plate, a rear plate, a left plate, a right plate, and a top plate. The front plate of the fixing frame 104 is fixedly connected to the first driving assembly 101, and the rear plate of the fixing frame 104 is fixedly connected to the second driving assembly 102.

[0062] A three-dimensional scanner 300 is disposed on the top plate of the fixing frame 104, and the three-dimensional scanner 300 is used to obtain three-dimensional terrain data;

[0063] The electrical box 400 is located at the bottom of the fixing frame 104 and is disposed between the front plate and the rear plate of the fixing frame 104. A control module (not shown in the figure) is disposed inside the electrical box 400 to control the working state of the AGV;

[0064] A camera 500 is respectively provided on the front plate, the rear plate, the left plate and the right plate of the fixing frame 104 for acquiring images around the AGV;

[0065] The antenna 600 is disposed on any one of the front plate, the rear plate, the left plate and the right plate, and is located at the lower end of the camera 500, and is used for communicating with the remote control terminal;

[0066] A communication module (not shown in the figure) is also provided inside the electrical box 400, and the communication module is used to connect with the antenna 600, and the control module is respectively connected with each camera 500, the three-dimensional scanner 300, the metal detector 200 and the communication module.

[0067] When the AGV detects underground metal equipment, it sends the location information of the AGV, the surrounding three-dimensional terrain data of the underground metal equipment and the image around the AGV to the remote control end so that the remote control end can determine the location of the underground metal equipment and re-plan the basic walking route of the AGV.

[0068] Controlling the working status of the AGV means controlling the AGV to move or stop moving, controlling the AGV to detect metal equipment, controlling the AGV to capture surrounding images, controlling the AGV to communicate with a remote control terminal, etc.

[0069] The communication module adopts the existing baseband chip and radio frequency chip, and the control module adopts the existing processor.

[0070] like Figure 1-Figure 3 As shown, the detector swing arm 103 includes a first arm 1031, a second arm 1032, a first motor 1033, a second motor 1034 and a third motor 1035; one end of the first arm 1031 is hinged to the first drive assembly 101, the other end of the first arm 1031 is hinged to one end of the second arm 1032, the other end of the second arm 1032 is hinged to the metal detector 200, the first motor 1033 is arranged at the hinge point of the first arm 1031 and the first drive assembly 101, the second motor 1034 is arranged at the hinge point of the first arm 1031 and the second arm 1032, and the third motor 1035 is arranged at the hinge point of the second arm 1032 and the metal detector; the first motor 1033, the second motor 1034, and the third motor 1034 are respectively connected to the control module. Figure 2 and Figure 3 The detector swing arm 103 is in different posture states, and the metal detector 200 can pass through complex terrain by controlling the posture of the detector swing arm 103.

[0071] In one embodiment, the first drive component 101 includes a first connecting seat 1011, a first drive motor (not shown in the figure), a first wheel 1012 and a second wheel (not shown in the figure), the first wheel 1012 and the second wheel are respectively arranged at two ends of the first connecting seat 1011, the first drive motor is respectively connected to the first wheel 1012 and the second wheel, and the first drive motor is connected to the control module.

[0072] The second drive assembly 102 includes a second connecting seat 1021, a second drive motor (not shown in the figure), a third wheel 1022 and a fourth wheel 1023. The third wheel 1022 and the fourth wheel 1023 are respectively arranged at two ends of the second connecting seat 1021, and the second drive motor is respectively connected to the third wheel 1022 and the fourth wheel 1023 through transmission, and the second drive motor is connected to the control module.

[0073] Those skilled in the art should note that the first drive assembly and the second drive assembly also include other components.

[0074] In one embodiment, the front plate and the rear plate have the same height, the left plate and the right plate have the same height, and the height of the front plate is greater than the height of the left plate, so that the lower ends of the left plate and the right plate are at a certain distance from the top of the electrical box 400 to allow the electrical box 400 to dissipate heat.

[0075] In one embodiment, the underground metal equipment detection AGV also includes a positioning module (not shown in the figure), which is used to obtain the location information of the AGV. The positioning module can be a GPS module or a Beidou module, and the positioning module is connected to the control module.

[0076] In one embodiment, the underground metal equipment detection AGV further includes a power module, which is disposed inside the electrical box 400 and is used to supply power to the AGV.

[0077] The embodiment of the present invention also provides a detection system for underground metal equipment, including a remote control terminal and at least one Figure 1 The underground metal equipment detection AGV described above uses 5G for communication between the remote control terminal and the AGV. The high-speed communication of 5G can not only quickly transmit the 3D terrain data and image information of the AGV, but also accurately provide the location information of the AGV.

[0078] The embodiment of the present invention further provides a method for detecting underground metal equipment, which is applied to the above-mentioned detection system for underground metal equipment. Figure 4 As shown, the method comprises the following steps:

[0079] S101, AGV establishes a communication connection with a remote control terminal;

[0080] S102, the remote control terminal obtains the location information of the AGV in real time;

[0081] S103, the remote control terminal plans a basic walking route based on the location information of the AGV, and sends the basic walking route to the corresponding AGV;

[0082] S104, AGV moves along the basic walking route and uses metal detectors for detection;

[0083] S105, the AGV determines whether it has reached the destination, if not, executes step S106; if yes, executes step S111;

[0084] S106, the AGV determines whether a metal device is found, if so, executes step S107, if not, executes step S104;

[0085] S107, the AGV obtains three-dimensional terrain data around the metal equipment through a three-dimensional scanner, obtains an image around the AGV through a camera, and sends the position information of the AGV, the three-dimensional terrain data and the image around the AGV to a remote control terminal;

[0086] S108, the remote control terminal determines the position of the metal equipment according to the position information of the AGV, the three-dimensional terrain data and the image around the AGV, and sends the position of the metal equipment and the basic walking route of the AGV to the terminal device of the metal equipment dismantling personnel, so that the metal equipment dismantling personnel can reach the position of the metal equipment according to the basic walking route of the AGV to dismantle the metal equipment;

[0087] S109, the remote control terminal replans the walking route based on the location information of the metal equipment and the location information of the AGV, and updates the basic walking route to the walking route;

[0088] S110, the remote control terminal sends the updated basic walking route to the corresponding AGV, and goes to step S104;

[0089] S111. AGV ends detection.

[0090] In one embodiment, step S103, the remote control terminal plans the basic walking route based on the location information of the AGV as follows:

[0091] The remote control terminal obtains the destination location;

[0092] The remote control terminal uses the current position of the AGV as the starting point and the destination position as the end point, wherein there are multiple nodes between the starting point and the end point, and the shortest route between two adjacent nodes is established in a straight line as the basic walking route.

[0093] In one embodiment, the three-dimensional terrain data provided by the three-dimensional scanner not only helps the AGV avoid obstacles during actual movement and ensures that it moves forward along the basic walking route planned by the remote control terminal, but also provides the specific location of underground metal equipment, providing great convenience for personnel dismantling the metal equipment.

[0094] The camera can provide real-time surrounding conditions of the AGV. At the same time, by taking pictures near the metal equipment and transmitting relevant photos back to the remote control end for analysis, it also provides a basis for the terminal equipment of the metal dismantling personnel to locate the metal equipment.

[0095] In one embodiment, the remote control terminal sends the location of the metal equipment and the basic walking route of the AGV to the terminal device of the metal equipment removal personnel. The terminal device of the metal removal personnel is AR glasses. After receiving the specific location of the metal equipment and the basic walking route of the AGV, the AR glasses mark the location of the metal equipment and the basic walking route of the AGV with different marks. For example, the location of the metal equipment is marked with a red arrow, and the basic walking route of the AGV is marked with a green line. After the metal removal personnel put on the AR glasses, they can see a red arrow and the basic walking route of the AGV above the location of the metal equipment.

[0096] In one embodiment, the metal equipment is a mine, and the mine sweeper uses AR glasses to clearly identify the location of the mine and the basic route of the AGV, ensuring that the mine sweeper will not accidentally trigger other mines while walking along the basic route of the AGV, greatly reducing the false triggering of mines. At the same time, since the mine clearance work has nothing to do with the AGV, the AGV can continue to work directly after determining the location of the mine, ensuring work efficiency.

[0097] After determining the exact location of the metal equipment, the remote control end replans the basic walking route; for example, it needs to turn to avoid a mine.

[0098] In one embodiment, when there are multiple AGVs, namely, including AGV and other AGVs, the remote control end communicates with the multiple AGVs to obtain the location information of the multiple AGVs in real time. Step S109 includes: the remote control end re-plans the walking route based on the location information of the metal equipment, the location information of the AGV and the location information of other AGVs, and updates the basic walking route to the said walking route.

[0099] The remote control end replans the walking route based on the location information of the metal equipment, the location information of the AGV and the location information of other AGVs, including: the remote control end determines the movement cost based on the location information of the metal equipment, the location information of the AGV and the location information of other AGVs, and the route corresponding to the minimum movement cost is the walking route, wherein the cost of passing through the nth node is:

[0100] G(n)=G(n-1)+G run +G stop +G turn +G same +G reverse +G emptyRoute , n>1;

[0101] Where G(1) = 0; n ≤ Z; Z represents the Zth node, which is the end point;

[0102] G(n) is the cost of passing through the nth node;

[0103] G(n-1) is the cost of passing through the n-1th node;

[0104] G(n) is the cost of passing through the nth node;

[0105] G(n-1) is the cost of passing through the n-1th node;

[0106] G run is the walking cost when passing through the nth node;

[0107] G stop The cost of avoiding idle AGVs that stop within the safe distance of the path from the n-1th node to the nth node;

[0108] G turn is the turning cost of AGV;

[0109] G same The cost of waiting for other AGVs to pass through the section from the n-1th node to the nth node in the same direction;

[0110] G reverse To avoid the cost of other AGVs passing through the section from the n-1th node to the nth node in the opposite direction;

[0111] G emptyRoute The additional cost of detours to avoid metal equipment.

[0112] In order to minimize the cost of movement, congestion, waiting time, and additional costs of detours or turns should be minimized.

[0113] like Figure 5 As shown in the figure, suppose that there is an AGV going from point A to point S, and there is an idle AGV on path AB. The paths are all of equal length, 1m. If only the walking cost and distance cost are considered, the cost of path ABGS or path ACFS is the same. However, if the idle AGV is considered, the cost of avoiding the idle AGV is added to path AB, so the cost of path ACFS is less than the cost of path ABGS, so taking path ACFS is better than taking path ABGS; if B is an open space, but there are other AGVs passing through CA, the cost weight can be set according to the system situation, so as to calculate the better path selection under different circumstances. Assuming that the AGV takes path ACFS, from point A to point C, and detects a mine on the path from point C to point F, and the mine cannot be bypassed, the route is replanned. The replanned route is for the AGV to return from point C to point A and walk along path ABGS.

[0114] The present invention uses AGV to complete the metal equipment detection task, and sends the location information of the metal equipment detected by the AGV, the three-dimensional terrain data around the metal equipment, and the image equipment around the AGV to the remote control end. The remote control end determines the specific location of the metal equipment, and sends the location of the metal equipment and the basic walking route of the AGV to the metal equipment dismantling personnel, so that the metal equipment dismantling personnel can dismantle the metal equipment. The present invention is applied to mine detection, and the confirmation of the mine position in the mine sweeping process is left to the robot to handle, and the mine handling process is left to manual handling, which ensures the processing efficiency.

[0115] It will be appreciated by those skilled in the art that all or some of the steps and systems in the disclosed method above may be implemented as software, firmware, hardware and appropriate combinations thereof. Some physical components or all physical components may be implemented as software executed by a processor, such as a central processing unit, a digital signal processor or a microprocessor, or may be implemented as hardware, or may be implemented as an integrated circuit, such as an application specific integrated circuit. Such software may be distributed on a computer-readable medium, which may include a computer storage medium (or a non-transitory medium) and a communication medium (or a temporary medium). As known to those skilled in the art, the term computer storage medium includes volatile and non-volatile, removable and non-removable media implemented in any method or technology for storing information (such as computer-readable instructions, data structures, program modules or other data). Computer storage media include, but are not limited to, RAM, ROM, EEPROM, flash memory or other memory technologies, CD-ROM, digital versatile disks (DVD) or other optical disk storage, magnetic cassettes, magnetic tapes, disk storage or other magnetic storage devices, or any other medium that may be used to store desired information and may be accessed by a computer. Furthermore, it is well known to those skilled in the art that communication media typically embodies computer readable instructions, data structures, program modules, or other data in a modulated data signal such as a carrier wave or other transport mechanism, and may include any information delivery media.

[0116] The above is a specific description of the preferred implementation of the present invention, but the present invention is not limited to the above-mentioned implementation mode. Technical personnel familiar with the field can also make various equivalent deformations or substitutions without violating the spirit of the present invention. These equivalent deformations or substitutions are all included in the scope defined by the claims of the present invention.

Claims

1. A method for detecting underground metal equipment, characterized in that: The method comprises: S101, AGV establishes a communication connection with a remote control terminal; S102, the remote control terminal obtains the location information of the AGV in real time; S103, the remote control terminal plans a basic walking route based on the location information of the AGV, and sends the basic walking route to the corresponding AGV; S104, AGV moves along the basic walking route and uses metal detectors for detection; S105, the AGV determines whether it has reached the destination, if not, executes step S106; if yes, executes step S111; S106, the AGV determines whether a metal device is found, if so, executes step S107, if not, executes step S104; S107, the AGV obtains three-dimensional terrain data around the metal equipment through a three-dimensional scanner, obtains an image around the AGV through a camera, and sends the position information of the AGV, the three-dimensional terrain data and the image around the AGV to a remote control terminal; S108, the remote control terminal determines the position of the metal equipment according to the position information of the AGV, the three-dimensional terrain data and the image around the AGV, and sends the position of the metal equipment and the basic walking route of the AGV to the terminal device of the metal equipment dismantling personnel, so that the metal equipment dismantling personnel can reach the position of the metal equipment according to the basic walking route of the AGV to dismantle the metal equipment; S109, the remote control terminal replans the walking route based on the location information of the metal equipment and the location information of the AGV, and updates the basic walking route to the walking route; S110, the remote control terminal sends the updated basic walking route to the corresponding AGV, and goes to step S104; S111. AGV ends detection.

2. The method for detecting metal equipment according to claim 1, characterized in that: Step S103: The remote control terminal plans the basic walking route based on the location information of the AGV: The remote control terminal obtains the destination location; The remote control terminal uses the current position of the AGV as the starting point and the destination position as the end point, wherein there are multiple nodes between the starting point and the end point, and the shortest route between two adjacent nodes is established in a straight line as the basic walking route.

3. The method for detecting metal equipment according to claim 1, characterized in that: When there are multiple AGVs, including AGV and other AGVs, the remote control end communicates with the multiple AGVs and obtains the location information of the multiple AGVs in real time. Step S109 includes: the remote control end re-plans the walking route based on the location information of the metal equipment, the location information of the AGV and the location information of other AGVs, and updates the basic walking route to the said walking route.

4. The method for detecting metal equipment according to claim 3, characterized in that: The remote control end replans the walking route based on the location information of the metal equipment, the location information of the AGV and the location information of other AGVs, including: the remote control end determines the movement cost based on the location information of the metal equipment, the location information of the AGV and the location information of other AGVs, and the route corresponding to the minimum movement cost is the walking route, where the cost of passing the nth node is: ; in ; ; Z represents the Zth node, i.e. the end point; is the cost of passing through the nth node; is the cost of passing through the n-1th node; is the walking cost when passing through the nth node; The cost of avoiding idle AGVs that stop within the safe distance of the path from the n-1th node to the nth node; is the turning cost of AGV; The cost of waiting for other AGVs to pass through the section from the n-1th node to the nth node in the same direction; The cost of avoiding other AGVs passing through the section from the n-1th node to the nth node in the opposite direction; The additional cost of detours to avoid metal equipment.

Citation Information

Patent Citations

  • Autonomous type mine detection robot system and mine detection method

    CN107328308A

  • Robot for simulating Mars exploration

    CN211319585U

  • Landmine identification and detection system

    CN211528715U

  • Detection AGV and detection system for underground metal equipment

    CN214586558U

  • Mine sweeping vehicle

    US20190242678A1