Path planning method, system and equipment and computer readable storage medium

By obtaining the boundary point information of the mine wall and generating the body model, and adjusting the body model in real time, the problem of difficulty in planning the path of the mining area is solved, and the collision-free path planning in complex mine environments is realized and the ability to adapt to real-time traffic changes is achieved.

CN118963341APending Publication Date: 2024-11-15DONGFENG COMML VEHICLE CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411006035.6
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-25
Publication Date
2024-11-15

AI Technical Summary

Technical Problem

It is difficult to plan the path of the mining area, especially in the mine environment, which cannot obtain accurate map information, which makes it difficult for existing path planning sensors to identify the travelable areas and cannot adapt to changes in real-time traffic environments.

Method used

By obtaining the boundary point coordinate information on the mine wall along the mine road direction, the boundary line and body model are generated, and the body model is adjusted in real time to avoid collision with the mine wall, and the final planned path is generated.

Benefits of technology

It realizes collision-free path planning in the mine environment, adapts to complex mine structures and real-time traffic changes, and improves the passing and safety of vehicles.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118963341A_ABST
    Figure CN118963341A_ABST
Patent Text Reader

Abstract

A path planning method, system and device and a computer readable storage medium belong to the technical field of automatic driving, and comprise the following steps: obtaining boundary coordinate information of each boundary point on a mine wall along a mine tunnel direction, and generating a boundary line according to the boundary coordinate information; generating a vehicle body model in real time according to the vehicle body size and the safe distance from the vehicle body to the mine wall; and taking a center point when the vehicle body model and the boundary line are not overlapped as a track point, and generating a final planning path according to all the track points. According to the method, the trafficability of the vehicle in the mine tunnel is analyzed through the boundary line representing the shape of the mine wall and the vehicle body model representing safe passing of the vehicle, and finally the final planned path is formed according to the center point when the vehicle body model and any boundary line are not overlapped, so that it is ensured that the vehicle can pass through the mine tunnel without collision through the final planned path.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of autonomous driving technology, and in particular to a path planning method, system, device and computer-readable storage medium. Background Art

[0002] The map-based path planning method is the most common one. It uses pre-built map information for path planning. First, it is necessary to convert the real-world roads, traffic signals, obstacles and other information into a digital map, and then search for the best path through an algorithm. This method has the advantages of high efficiency and accuracy, and can fully consider road conditions and traffic rules. However, the limitation of this method is that it requires accurate map information and cannot adapt to real-time changes in the traffic environment.

[0003] Regarding the path planning of vehicles operating in mining areas, due to the complex operating environment in mining areas, especially underground mines, it is often impossible to obtain accurate map information. In addition, the bumpy and slippery roads and the complex mine structures make it difficult for existing path planning sensors to identify the drivable area, making it difficult to plan a reasonable route. Summary of the invention

[0004] The present application provides a path planning method, system, device and computer-readable storage medium, which can solve the technical problem of difficulty in path planning in mining environment existing in the prior art.

[0005] In a first aspect, an embodiment of the present application provides a path planning method, the path planning method comprising:

[0006] Obtaining boundary coordinate information of each boundary point on the mine wall along the direction of the mine road, and generating a boundary line according to the boundary coordinate information; the boundary point is the point on the mine wall that extends the longest distance toward the mine road when traveling along the mine road;

[0007] Generate a vehicle body model in real time based on the vehicle body size and the safe distance between the vehicle body and the mine wall;

[0008] When it is determined that the vehicle body model overlaps with the boundary line on one side, and the maximum overlap amount at the overlapped position is less than the maximum relative distance between the vehicle body model and the boundary line on the other side, moving the vehicle body model toward the boundary line on the other side according to the maximum overlap amount;

[0009] When the body model overlaps with one side boundary line and the maximum overlap amount at the overlapped position is not less than the maximum relative distance between the body model and the other side boundary line, or when it is determined that the body model overlaps with both side boundary lines, the body model is reduced according to the maximum overlap amount at the overlapped position;

[0010] The center point where the vehicle body model does not overlap with the boundary line is taken as the trajectory point, and the final planning path is generated based on all trajectory points.

[0011] In combination with the first aspect, in one implementation, the step of obtaining boundary coordinate information of each boundary point on the mine wall along the mine road direction specifically includes the following steps:

[0012] Obtain the position coordinate information of all position points on the mine wall along the mine road direction;

[0013] According to the position coordinate information, extracting position points whose coordinate changes relative to adjacent position points are greater than a maximum threshold and whose distribution density is less than a minimum threshold as noise points;

[0014] After removing the noise points from the position points, the points on the mine wall that extend the longest distance toward the mine road when traveling along the mine road are taken as boundary points, and corresponding boundary point information is obtained.

[0015] In combination with the first aspect, in one implementation, generating a boundary line according to boundary coordinate information specifically includes the following steps:

[0016] When it is determined that the coordinate change of adjacent position points is not greater than the maximum threshold and the distribution density is less than the minimum threshold, position points are filled between the adjacent position points until the distribution density is not less than the minimum threshold;

[0017] The boundary line is generated according to all the position points.

[0018] In combination with the first aspect, in one implementation, generating a vehicle body model according to the vehicle body size and the safe distance between the vehicle body and the mine wall specifically includes the following steps:

[0019] A rectangle is defined as a vehicle body model. The width direction of the rectangle is the width direction of the mine tunnel, and the width of the rectangle is the sum of the width of the vehicle body and the safety distance between the two sides of the vehicle body and the mine wall. The length direction of the rectangle is the direction of travel of the mine tunnel, and the length of the rectangle is not greater than the length of the vehicle body.

[0020] In combination with the first aspect, in an implementation manner, when the vehicle body model overlaps with the boundary line, reducing the vehicle body model according to a maximum overlap amount at the overlapped position specifically includes the following steps:

[0021] When the vehicle body model overlaps with the boundary line, the safety distance is reduced according to the maximum overlap amount at the overlapped position to generate a reduced vehicle body model; the reduced safety distance is not less than the minimum safety value.

[0022] In combination with the first aspect, in one implementation, the method further includes:

[0023] When it is determined that the reduced vehicle body model overlaps with the boundary line, if the vehicle body height at the overlapping point is different from the height of the position point, the final planned path is formed with the center point of the vehicle body model as the trajectory point; if the vehicle body height at the overlapping point is the same as the height of the position point, an alarm message is output.

[0024] In combination with the first aspect, in one implementation, the method further includes:

[0025] According to the maximum relative distance between the body model and the boundary line at the current moment, the length of the body model at the next moment is adjusted, and the maximum relative distance at the current moment is proportional to the length of the body model at the next moment;

[0026] The vehicle body models at two adjacent moments do not overlap.

[0027] In a second aspect, an embodiment of the present application provides a path planning system, the path planning system comprising:

[0028] A data acquisition module, which is used to obtain boundary coordinate information of each boundary point on the mine wall along the mine road direction, and generate a boundary line according to the boundary coordinate information; the boundary point is the point on the mine wall that extends the longest distance to the mine road when traveling along the mine road;

[0029] A model generation module, which is used to generate a vehicle body model in real time according to the vehicle body size and the safe distance between the vehicle body and the mine wall;

[0030] A path planning module is used to move the body model toward the other side boundary line according to the maximum overlap when it is determined that the body model overlaps with the boundary line on one side and the maximum overlap amount at the overlap is less than the maximum relative distance between the body model and the boundary line on the other side; it is also used to reduce the body model according to the maximum overlap amount at the overlap when the body model overlaps with the boundary line on one side and the maximum overlap amount at the overlap is not less than the maximum relative distance between the body model and the boundary line on the other side, or when it is determined that the body model overlaps with the boundary lines on both sides; it is also used to generate a final planned path based on all trajectory points, taking the center point when the body model does not overlap with the boundary line as a trajectory point.

[0031] In a third aspect, an embodiment of the present application provides a path planning device, which includes a processor, a memory, and a path planning program stored in the memory and executable by the processor, wherein when the path planning program is executed by the processor, the steps of the path planning method are implemented.

[0032] In a fourth aspect, an embodiment of the present application provides a computer-readable storage medium, on which a path planning program is stored, wherein when the path planning program is executed by a processor, the steps of the path planning method are implemented.

[0033] The beneficial effects brought by the technical solution provided in the embodiments of the present application include:

[0034] The passability of the vehicle in the mine tunnel is analyzed by using the boundary line that represents the shape of the mine wall and the body model that represents the safe passage of the vehicle. When the body model overlaps with the mine wall on one side, if there is enough distance margin with the boundary line on the other side, the body model is moved to the other side. When the body model overlaps with the mine wall on one side and there is not enough distance margin with the boundary line on the other side, or when the body model overlaps with the mine walls on both sides, the body model is reduced according to the overlap with the boundary line to judge the passability again. Finally, the final planned path is formed according to the center point when the body model does not overlap with any boundary line, thereby ensuring that the final planned path can enable the vehicle to pass through the mine tunnel without collision. BRIEF DESCRIPTION OF THE DRAWINGS

[0035] Figure 1 This is a flow chart of an embodiment of a path planning method of the present application;

[0036] Figure 2 This is a schematic diagram of the application of the path planning method in the embodiment of the present application;

[0037] Figure 3 A schematic diagram of functional modules of an embodiment of a path planning device;

[0038] Figure 4 This is a schematic diagram of the hardware structure of the path planning device involved in the embodiment of the present application. DETAILED DESCRIPTION

[0039] In order to enable those skilled in the art to better understand the solution of the present application, the technical solution in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application. Obviously, the described embodiments are only part of the embodiments of the present application, not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of this application.

[0040] In order to make the objectives, technical solutions and advantages of the present application clearer, the implementation methods of the present application will be further described in detail below in conjunction with the accompanying drawings.

[0041] In a first aspect, an embodiment of the present application provides a path planning method.

[0042] In one embodiment, the path planning method includes:

[0043] The boundary coordinate information of each boundary point on the mine wall along the mine road direction is obtained, and the boundary line is generated according to the boundary coordinate information. The above boundary point is the point on the mine wall that extends the longest distance to the mine road when traveling along the mine road.

[0044] The vehicle body model is generated in real time based on the vehicle body size and the safe distance between the vehicle body and the mine wall.

[0045] When it is determined that the vehicle body model overlaps with one side boundary line and the maximum overlap amount at the overlapped position is smaller than the maximum relative distance between the vehicle body model and the other side boundary line, the vehicle body model is moved toward the other side boundary line according to the maximum overlap amount.

[0046] When the vehicle body model overlaps with one side boundary line and the maximum overlap amount at the overlap is not less than the maximum relative distance between the vehicle body model and the other side boundary line, or when it is determined that the vehicle body model overlaps with both side boundary lines, the vehicle body model is reduced according to the maximum overlap amount at the overlap.

[0047] The center point where the vehicle body model does not overlap with the boundary line is taken as the trajectory point, and the final planning path is generated based on all trajectory points.

[0048] In this embodiment, the passability of the vehicle in the mine tunnel is analyzed by using the boundary line that represents the shape of the mine wall and the body model that represents the safe passage of the vehicle. When the body model overlaps with the mine wall on one side, if there is enough distance margin with the boundary line on the other side, the body model is moved to the other side. When the body model overlaps with the mine wall on one side and there is not enough distance margin with the boundary line on the other side, or when the body model overlaps with the mine walls on both sides, the body model is reduced according to the overlap amount with the boundary line to judge the passability again. Finally, the final planned path is formed according to the center point when the body model does not overlap with any boundary line, thereby ensuring that the final planned path enables the vehicle to pass through the mine tunnel without collision.

[0049] In one specific implementation, referring to Figure 1 , Figure 1 This is a flow chart of the first embodiment of the path planning method of this application. Figure 1 As shown, the path planning method includes:

[0050] Step S1, obtaining boundary coordinate information of each boundary point on the mine wall along the mine road direction, and generating a boundary line according to the boundary coordinate information. The boundary point is the point on the mine wall that extends the longest distance to the mine road when traveling along the mine road.

[0051] Step S2: Generate a vehicle body model in real time according to the vehicle body size and the safe distance between the vehicle body and the mine wall.

[0052] Step S3: Determine whether the vehicle body model overlaps with the boundary line:

[0053] If there is overlap with the boundary line on one side, go to step S4.

[0054] If there is overlap with the boundary lines on both sides, go to step S6.

[0055] If there is no overlap with the boundary line, go to step S7.

[0056] Step S4: determine whether the maximum overlap amount at the overlapped position is less than the maximum relative distance between the vehicle body model and the boundary line on the other side:

[0057] If yes, go to step S5.

[0058] If not, go to step S6.

[0059] Step S5, moving the vehicle body model toward the other side boundary line according to the maximum overlap amount, and then going to step S7.

[0060] Step S6: reducing the vehicle body model according to the maximum overlap amount at the overlapped position.

[0061] Step S7: taking the center point where the vehicle body model does not overlap with the boundary line as the trajectory point, and generating a final planned path according to all trajectory points.

[0062] In this embodiment, in a scenario where an actual vehicle is traveling in a mine tunnel, boundary coordinate information of each boundary point of the mine wall outside the mine tunnel is collected by radar or other detection devices.

[0063] The direction of travel in the mine tunnel is the X-axis, and the direction from one mine wall to the other mine wall or from one door of a vehicle to the other door is the Y-axis. The Y-axis must be perpendicular to the X-axis, and the vertical direction is the Z-axis. The same mine wall can have one or more boundary lines.

[0064] The same mine wall has corresponding boundary lines at different Z-axis heights. If multiple boundary lines are set on the same mine wall, when judging whether the body model overlaps with the mine wall, it is necessary to judge the overlap between the body model and each boundary line. At this time, the body model is preferably a three-dimensional cuboid. By judging the overlap between the body model and each boundary line, it is possible to know whether the body model has a collision risk with the mine wall, as well as information such as the height of the collision point. At this time, the judgment accuracy will be improved, but the data processing volume is large, which will lead to an increase in the time for path planning and a shortened reaction time reserved for the vehicle.

[0065] If it is assumed that there is a boundary line on the same mine wall, all the aforementioned boundary lines can be fused to obtain a boundary line. When merging, the Y coordinates corresponding to each height under the same X coordinate are taken, and the maximum value is taken, that is, the value with the largest extension distance to the mine tunnel under the same X coordinate is taken as the Y value, and the boundary points and boundary lines are reconstructed. When it is determined that the vehicle body model overlaps with the mine wall, it is necessary to make a coincidence judgment between the vehicle body model and a boundary line. At this time, the vehicle body model is preferably a two-dimensional rectangle. By judging the coincidence between the vehicle body model and a single boundary line, it can be known whether the vehicle body model has a collision risk with the mine wall, but the height of the collision point cannot be judged. It is necessary to further judge whether the actual height of the vehicle body at the overlapping point is consistent with the actual height of the boundary point in order to further confirm whether there will be a collision and the height of the collision point. The accuracy of judgment based on a boundary line will be reduced, but the amount of data processing is small, and the collision risk in front of the mine tunnel can be quickly identified. When there is a collision risk, the planned path can be quickly adjusted, and the reaction time reserved for the vehicle will also increase.

[0066] Further, in one embodiment, the above-mentioned obtaining of boundary coordinate information of each boundary point on the mine wall along the mine road direction specifically includes the following steps:

[0067] Obtain the position coordinate information of all position points on the mine wall along the mine tunnel direction.

[0068] According to the above position coordinate information, position points whose coordinate changes relative to adjacent position points are greater than a maximum threshold and whose distribution density is less than a minimum threshold are extracted as noise points.

[0069] After removing the above noise points from the above position points, the point on the mine wall that extends the longest distance toward the mine road when traveling along the mine road is taken as the boundary point, and the corresponding boundary point information is obtained.

[0070] In this embodiment, abnormal points are removed from the initially acquired mine wall position points, for example, points with too large jump distances among the boundary points are removed, and points with jump distances exceeding 1m in the Y-axis direction are set as too large. The distribution density of these points is significantly smaller than the distribution density of other position points at adjacent positions. These points may not be points on the mine wall but noise points mistakenly collected by the vehicle perception end due to dust, water mist or optical factors. The accuracy of the boundary points is improved by eliminating noise points.

[0071] Furthermore, in one embodiment, the step of generating a boundary line according to the boundary coordinate information specifically includes the following steps:

[0072] When it is determined that the coordinate change of adjacent position points is not greater than the maximum threshold and the distribution density is less than the minimum threshold, position points are filled between the adjacent position points until the distribution density is not less than the minimum threshold.

[0073] Based on all the above position points, the above boundary line is generated.

[0074] In this embodiment, the vehicle perception terminal may miss collecting boundary points due to dust, water mist, optical factors or short-term communication terminals. In this case, there will be a gap between two adjacent boundary points. The coordinates of the two adjacent boundary points do not change much, but the distribution density is less than the distribution density of other boundary points before and after them. When it is determined that there is a missed collection, a new boundary point is filled between the two adjacent boundary points to avoid a lack of comparison basis at the missed boundary points when comparing the boundary points with the vehicle model in the later stage, thereby affecting the final path planning accuracy.

[0075] Further, in one embodiment, the above-mentioned generating the vehicle body model according to the vehicle body size and the safe distance between the vehicle body and the mine wall specifically includes the following steps:

[0076] A rectangle is defined as a vehicle body model. The width direction of the rectangle is the width direction of the mine tunnel, and the width of the rectangle is the sum of the width of the vehicle body and the safety distance between the two sides of the vehicle body and the mine wall. The length direction of the rectangle is the direction of travel of the mine tunnel, and the length of the rectangle is not greater than the length of the vehicle body.

[0077] In this embodiment, since the main collision risk comes from both sides of the vehicle body, when designing the vehicle body model, a safety distance is reserved on both sides of the vehicle body, that is, the width of the vehicle body model is greater than the width of the vehicle body, and the length of the vehicle body model is not greater than the length of the vehicle body. When the vehicle is driving, the vehicle body model is located in front of the front of the vehicle in a virtual form. Each time the vehicle body model moves forward, the bottom edge of the vehicle body model at the next moment coincides with or is closely adjacent to the top edge of the vehicle body model at the previous moment. The smaller the length of the vehicle body model, the higher the frequency of collision risk judgment.

[0078] The front of the vehicle at the current position is used as the middle point of the width of the bottom side of the rectangle, and so on. The center of the rectangle is the predicted trajectory point.

[0079] Furthermore, in one embodiment, when the vehicle body model overlaps with the boundary line, the vehicle body model is reduced according to the maximum overlap amount at the overlapped position, which specifically includes the following steps:

[0080] When the vehicle body model overlaps with the boundary line, the safety distance is reduced according to the maximum overlap amount at the overlapped position to generate a reduced vehicle body model. The reduced safety distance is not less than the minimum safety value.

[0081] In this embodiment, the rectangle is relatively to the right and intersects with the boundary line of the right mine wall. It is determined that the rightmost point of the rectangle exceeds the right boundary line by S meters, so the rectangle needs to be moved parallel to the left by S meters.

[0082] After moving the rectangle, determine whether the vehicle intersects with the left boundary line. If so, the mine road is narrow, reduce the width of the rectangle (not less than the smallest length of the rectangle), and compare again. If they finally intersect, then this path is not feasible. If not, then the center point of the rectangle is the appropriate prediction point.

[0083] The judgment that the rectangle is closer to the left is consistent with the judgment that it is closer to the right.

[0084] If you encounter an intersection while driving, the boundary point of the mine wall on one side of the intersection will disappear. When we determine that the boundary point on one side disappears, the rectangle is predicted forward along the mine wall on the other side. Therefore, the disappearance of the boundary point of the mine wall on one side does not affect the overall planning.

[0085] Furthermore, in one embodiment, the above method further includes:

[0086] When it is determined that the reduced vehicle body model overlaps with the boundary line, if the height of the vehicle body at the overlapped position is different from the height of the position point, the final planned path is formed with the center point of the vehicle body model as the trajectory point. If the height of the vehicle body at the overlapped position is the same as the height of the position point, an alarm message is output.

[0087] In this embodiment, assuming that the vehicle body model is a rectangle and the boundary line of the single-side mine wall is one, after determining that the two overlap, it is necessary to further confirm whether the intersection position that overlaps in the Y-axis direction will actually cause contact and collision problems, thereby improving the accuracy of the overlap judgment and further improving the rationality of the planned path.

[0088] Furthermore, in one embodiment, the above method further includes:

[0089] According to the maximum relative distance between the body model and the boundary line at the current moment, the length of the body model at the next moment is adjusted, and the maximum relative distance at the current moment is proportional to the length of the body model at the next moment.

[0090] The vehicle body models at two adjacent moments do not overlap.

[0091] In this embodiment, refer to Figure 2 , Figure 2 This is an application diagram of the path planning method in the embodiment of the present application. The body model is located in a virtual form in front of the front of the vehicle. At time t1, assuming that the width of the body model is 5m and the length is 7m, the actual width of the vehicle is 4m and the actual length is 8m. If it is judged that the distance between the body model and the boundary lines on both sides is 2m, then at time t2, the length of the body model becomes 8m. If the distance between the body model and the boundary lines on both sides is 1m at time t2, then at time t3, the length of the body model becomes 6m.

[0092] In summary, when the mine tunnel is judged to be wider, the length of the vehicle body model at the next moment can be adjusted to increase the frequency of collision judgment. When the mine tunnel is judged to be narrow, the length of the vehicle body model at the next moment can be adjusted to increase the frequency of collision judgment. According to the actual situation of the mine tunnel, the frequency of collision judgment can be flexibly adjusted, taking into account both judgment efficiency and safety.

[0093] In a second aspect, an embodiment of the present application also provides a path planning device.

[0094] In one embodiment, referring to Figure 3 , Figure 3 This is a functional module diagram of an embodiment of the path planning device of the present application. Figure 3 As shown, the path planning device includes:

[0095] The data acquisition module 1 is used to acquire the boundary coordinate information of each boundary point on the mine wall along the mine road direction, and generate a boundary line according to the boundary coordinate information. The above boundary point is the point on the mine wall that extends the longest distance to the mine road when traveling along the mine road.

[0096] The model generation module 2 is used to generate a vehicle body model in real time according to the size of the vehicle body and the safe distance between the vehicle body and the mine wall.

[0097] The path planning module 3 is used to move the body model toward the boundary line on the other side according to the maximum overlap when it is determined that the body model overlaps with the boundary line on one side and the maximum overlap amount at the overlap is less than the maximum relative distance between the body model and the boundary line on the other side. It is also used to reduce the body model according to the maximum overlap amount at the overlap when the body model overlaps with the boundary line on one side and the maximum overlap amount at the overlap is not less than the maximum relative distance between the body model and the boundary line on the other side, or when it is determined that the body model overlaps with the boundary lines on both sides. It is also used to generate the final planning path according to all trajectory points, taking the center point when the body model does not overlap with the boundary line as the trajectory point.

[0098] Among them, the functional implementation of each module in the above-mentioned path planning device corresponds to the various steps in the above-mentioned path planning method embodiment, and its functions and implementation processes will not be repeated here one by one.

[0099] In a third aspect, an embodiment of the present application provides a path planning device, which may be a personal computer (PC), a laptop computer, a server, or other device with data processing capabilities.

[0100] Reference Figure 4 , Figure 4 Schematic diagram of the hardware structure of the path planning device involved in the embodiment of the present application. In the embodiment of the present application, the path planning device may include a processor, a memory, a communication interface and a communication bus.

[0101] The communication bus may be of any type and is used to interconnect the processor, the memory, and the communication interface.

[0102] The communication interface includes input / output (I / O) interface, physical interface and logical interface, etc., which are used to realize the interconnection of devices inside the path planning device, and the interface used to realize the interconnection between the path planning device and other devices (such as other computing devices or user devices). The physical interface can be an Ethernet interface, a fiber optic interface, an ATM interface, etc. The user device can be a display, a keyboard, etc.

[0103] The memory can be various types of storage media, such as random access memory (RAM), read-only memory (ROM), non-volatile RAM (NVRAM), flash memory, optical storage, hard disk, programmable ROM (PROM), erasable PROM (EPROM), electrically erasable PROM (EEPROM), etc.

[0104] The processor may be a general-purpose processor, and the general-purpose processor may call the path planning program stored in the memory and execute the path planning method provided by the embodiment of the present application. For example, the general-purpose processor may be a central processing unit (CPU). The method executed when the path planning program is called may refer to the various embodiments of the path planning method of the present application, which will not be repeated here.

[0105] Those skilled in the art will understand that Figure 4 The hardware structure shown in the figure does not constitute a limitation on the present application, and may include more or fewer components than shown in the figure, or combine certain components, or arrange the components differently.

[0106] In a fourth aspect, an embodiment of the present application also provides a computer-readable storage medium.

[0107] A path planning program is stored on the computer-readable storage medium of the present application, wherein when the path planning program is executed by a processor, the steps of the path planning method as described above are implemented.

[0108] Among them, the method implemented when the path planning program is executed can refer to the various embodiments of the path planning method of the present application, and will not be repeated here.

[0109] It should be noted that the serial numbers of the above-mentioned embodiments of the present application are only for description and do not represent the advantages or disadvantages of the embodiments.

[0110] The terms "including" and "having" and any variations thereof in the specification and claims of this application and the above-mentioned drawings are intended to cover non-exclusive inclusions. For example, a process, method, system, product or device that includes a series of steps or units is not limited to the listed steps or units, but optionally includes steps or units that are not listed, or optionally includes other steps or units inherent to these processes, methods, products or devices. The terms "first", "second" and "third" are used to distinguish different objects, etc., and do not represent a sequence, nor do they limit "first", "second" and "third" to different types.

[0111] In the description of the embodiments of the present application, "exemplary", "for example" or "for example" are used to indicate examples, illustrations or descriptions. Any embodiment or design described as "exemplary", "for example" 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", "for example" or "for example" is intended to present related concepts in a specific way.

[0112] In the description of the embodiments of the present application, unless otherwise specified, “ / ” means or. For example, A / B can mean A or B. The “and / or” in the text is merely a description of the association relationship of associated objects, indicating that three relationships may exist. 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, in the description of the embodiments of the present application, “multiple” refers to two or more than two.

[0113] In some processes described in the embodiments of the present application, multiple operations or steps that appear in a specific order are included, but it should be understood that these operations or steps may not be executed in the order in which they appear in the embodiments of the present application or in parallel, and the sequence number of the operation is only used to distinguish the different operations, and the sequence number itself does not represent any execution order. In addition, these processes may include more or fewer operations, and these operations or steps may be executed in sequence or in parallel, and these operations or steps may be combined.

[0114] Through the description of the above implementation methods, those skilled in the art can clearly understand that the above-mentioned embodiment methods can be implemented by means of software plus a necessary general hardware platform, and of course by hardware, but in many cases the former is a better implementation method. Based on such an understanding, the technical solution of the present application is essentially or the part that contributes to the prior art can be embodied in the form of a software product, which is stored in a storage medium (such as ROM / RAM, disk, CD) as described above, and includes a number of instructions for a terminal device to execute the methods described in each embodiment of the present application.

[0115] The above are only preferred embodiments of the present application, and are not intended to limit the patent scope of the present application. Any equivalent structure or equivalent process transformation made using the contents of the present application specification and drawings, or directly or indirectly applied in other related technical fields, are also included in the patent protection scope of the present application.

Claims

1. A path planning method, characterized in that: The path planning method comprises: Obtaining boundary coordinate information of each boundary point on the mine wall along the direction of the mine road, and generating a boundary line according to the boundary coordinate information; the boundary point is the point on the mine wall that extends the longest distance toward the mine road when traveling along the mine road; Generate a vehicle body model in real time based on the vehicle body size and the safe distance between the vehicle body and the mine wall; When it is determined that the vehicle body model overlaps with the boundary line on one side, and the maximum overlap amount at the overlapped position is less than the maximum relative distance between the vehicle body model and the boundary line on the other side, moving the vehicle body model toward the boundary line on the other side according to the maximum overlap amount; When the body model overlaps with one side boundary line and the maximum overlap amount at the overlapped position is not less than the maximum relative distance between the body model and the other side boundary line, or when it is determined that the body model overlaps with both side boundary lines, the body model is reduced according to the maximum overlap amount at the overlapped position; The center point where the vehicle body model does not overlap with the boundary line is taken as the trajectory point, and the final planning path is generated based on all trajectory points.

2. The path planning method according to claim 1, characterized in that: The step of obtaining the boundary coordinate information of each boundary point on the mine wall along the mine road direction specifically includes the following steps: Obtain the position coordinate information of all position points on the mine wall along the mine road direction; According to the position coordinate information, extracting position points whose coordinate changes relative to adjacent position points are greater than a maximum threshold and whose distribution density is less than a minimum threshold as noise points; After removing the noise points from the position points, the points on the mine wall that extend the longest distance toward the mine road when traveling along the mine road are taken as boundary points, and corresponding boundary point information is obtained.

3. The path planning method according to claim 1, characterized in that: The step of generating a boundary line according to the boundary coordinate information specifically includes the following steps: When it is determined that the coordinate change of adjacent position points is not greater than the maximum threshold and the distribution density is less than the minimum threshold, position points are filled between the adjacent position points until the distribution density is not less than the minimum threshold; The boundary line is generated according to all the position points.

4. The path planning method according to claim 1, characterized in that: The step of generating a vehicle body model according to the vehicle body size and the safe distance between the vehicle body and the mine wall specifically includes the following steps: A rectangle is defined as a vehicle body model. The width direction of the rectangle is the width direction of the mine tunnel, and the width of the rectangle is the sum of the width of the vehicle body and the safety distance between the two sides of the vehicle body and the mine wall. The length direction of the rectangle is the direction of travel of the mine tunnel, and the length of the rectangle is not greater than the length of the vehicle body.

5. The path planning method according to claim 1, characterized in that: When the vehicle body model overlaps with the boundary line, reducing the vehicle body model according to the maximum overlap amount at the overlapped position specifically includes the following steps: When the vehicle body model overlaps with the boundary line, the safety distance is reduced according to the maximum overlap amount at the overlapped position to generate a reduced vehicle body model; the reduced safety distance is not less than the minimum safety value.

6. The path planning method according to claim 1, characterized in that: The method further comprises: When it is determined that the reduced vehicle body model overlaps with the boundary line, if the vehicle body height at the overlapping point is different from the height of the position point, the final planned path is formed with the center point of the vehicle body model as the trajectory point; if the vehicle body height at the overlapping point is the same as the height of the position point, an alarm message is output.

7. The path planning method according to claim 1, characterized in that: The method further comprises: According to the maximum relative distance between the body model and the boundary line at the current moment, the length of the body model at the next moment is adjusted, and the maximum relative distance at the current moment is proportional to the length of the body model at the next moment; The vehicle body models at two adjacent moments do not overlap.

8. A path planning system, characterized in that: The path planning system comprises: A data acquisition module, which is used to obtain boundary coordinate information of each boundary point on the mine wall along the mine road direction, and generate a boundary line according to the boundary coordinate information; the boundary point is the point on the mine wall that extends the longest distance to the mine road when traveling along the mine road; A model generation module, which is used to generate a vehicle body model in real time according to the vehicle body size and the safe distance between the vehicle body and the mine wall; A path planning module is used to move the body model toward the other side boundary line according to the maximum overlap when it is determined that the body model overlaps with the boundary line on one side and the maximum overlap amount at the overlap is less than the maximum relative distance between the body model and the boundary line on the other side; it is also used to reduce the body model according to the maximum overlap amount at the overlap when the body model overlaps with the boundary line on one side and the maximum overlap amount at the overlap is not less than the maximum relative distance between the body model and the boundary line on the other side, or when it is determined that the body model overlaps with the boundary lines on both sides; it is also used to generate a final planned path based on all trajectory points, taking the center point when the body model does not overlap with the boundary line as a trajectory point.

9. A path planning device, characterized in that: The path planning device includes a processor, a memory, and a path planning program stored in the memory and executable by the processor, wherein when the path planning program is executed by the processor, the steps of the path planning method as described in any one of claims 1 to 7 are implemented.

10. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a path planning program, wherein when the path planning program is executed by a processor, the steps of the path planning method according to any one of claims 1 to 7 are implemented.