Path planning method, device and equipment based on mine car and storage medium

By obtaining the location information of mine cars and excavators and environmental grid maps, and using communication equipment to determine and construct path points, the problem of unmanned mine card path planning in complex and narrow areas of mining area operation environment is solved, and the excavators and mine card paths are improved Collaborative operation safety and efficiency.

CN118960745APending Publication Date: 2024-11-15SINO TRUK JINAN POWER CO LTD
View PDF 0 Cites 1 Cited by

Patent Information

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

AI Technical Summary

Technical Problem

In the mining area with complex and narrow operating environment, it is difficult for the existing technology to realize effective path planning for unmanned mine cards, resulting in low safety and efficiency of synergistic operations between excavators and mine cards.

Method used

By obtaining the location information of the mine car and excavator and the environmental grid map, the target path point is determined using communication equipment, and the path is connected to straight and curved segments according to the path point to avoid obstacles and achieve safe and efficient driving of the mine card.

Benefits of technology

It improves the safety and efficiency of coordinated operations between excavators and mine cards, ensures the safety and adaptability of path planning, and is suitable for unmanned operations in complex and narrow areas.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118960745A_ABST
    Figure CN118960745A_ABST
Patent Text Reader

Abstract

The invention provides a path planning method and device based on a mine car, equipment and a storage medium. The method comprises the steps that a grid map of the environment where a mine car is located, position information of the mine car, orientation information of the mine car and position information of an excavator are obtained; the grid map represents the ground environment of the environment where the mine car is located, the position information of the mine car represents the first path point, the position information of the excavator represents the last path point, the mine car and the excavator are each provided with a communication device, and the communication devices are used for sending the position information of the excavator to the mine car; determining a target path point in the to-be-planned path according to the grid map, the position information of the mine car, the orientation information of the mine car and the position information of the excavator; the to-be-planned path represents a path on which the mine car needs to run; and determining a to-be-planned path according to the position information of the mine car, the position information of the excavator and the target path point. According to the method provided by the invention, the efficiency and safety of path planning are improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of automatic driving of mine carts, and in particular to a path planning method, device, equipment and storage medium based on mine carts. Background Art

[0002] In recent years, with the continuous improvement of automation and intelligence in the mining industry, unmanned autonomous driving in the entire mining process is gradually becoming a development trend. Unmanned mining trucks can reduce waiting and idle time through route planning and improve transportation efficiency.

[0003] At present, due to the harsh mining environment and frequent safety accidents, the safety of mine truck drivers is difficult to guarantee, and the current situation of difficulty in recruiting workers in mining areas needs to be solved urgently. If the path planning of unmanned mining trucks in complex and narrow loading areas can be solved, the excavator and unmanned mining trucks can work together to improve the safety and efficiency of mining operations. Summary of the invention

[0004] The present application provides a mine car-based path planning method, device, equipment and storage medium to solve the problems of low safety and low operating efficiency in mining areas.

[0005] In a first aspect, the present application provides a path planning method based on a mine cart, comprising:

[0006] Obtain a grid map of the environment where the mine car is located, the location information of the mine car, the direction information of the mine car, and the location information of the excavator; the grid map represents the ground environment of the environment where the mine car is located, the location information of the mine car represents the first path point, and the location information of the excavator represents the last path point. Communication equipment is installed on both the mine car and the excavator, and the communication equipment is used to send the location information of the excavator to the mine car;

[0007] Determine a target path point in a path to be planned according to the grid map, the location information of the mine car, the orientation information of the mine car, and the location information of the excavator; wherein the path to be planned represents the path that the mine car needs to travel;

[0008] The path to be planned is determined based on the location information of the mine car, the location information of the excavator, and the target path point.

[0009] In a possible design, determining the path to be planned according to the location information of the mine car, the location information of the excavator, and the target path point includes:

[0010] For each target path point in the path to be planned, if the distance between the target path point and the previous path point of the target path point in the path to be planned is less than a preset first distance threshold, the target path point and the previous path point of the target path point are connected to obtain the path to be planned.

[0011] In a possible design, the step of connecting the target path point and a previous path point of the target path point to obtain a path to be planned includes:

[0012] Determine a straight line segment to be connected and a curve segment to be connected according to the position information and orientation information of a previous path point of the target path point; wherein the straight line segment to be connected and the curve segment to be connected represent a path to be planned between the target path point and the previous path point of the target path point;

[0013] The path to be planned is determined according to the position information and orientation information of the previous path point of the target path point, the position information of the target path point, the straight line segment to be connected, and the curve segment to be connected.

[0014] In a possible design, determining the straight line segment and the curve segment to be connected according to the position information and the orientation information of the previous path point of the target path point includes:

[0015] Determine the extension direction and length of the straight line segment to be connected according to the position information and orientation information of the previous path point of the target path point;

[0016] The length and curvature of the curve segment to be connected are determined according to the position information and orientation information of the previous path point of the target path point.

[0017] In a possible design, determining the path to be planned according to the position information and orientation information of the previous path point of the target path point, the position information of the target path point, the straight line segment to be connected, and the curved line segment to be connected includes:

[0018] According to the extension direction and length of the straight line segment to be connected, the straight line segment to be connected is connected with the previous path point of the target path point to obtain the end point position of the straight line to be connected;

[0019] According to the curve length and curvature of the curve segment to be connected, the end point position of the straight line segment to be connected is connected with the target path point to obtain the path to be planned.

[0020] In a possible design, the grid map includes location information of a plurality of obstacles; determining a target path point in the path to be planned according to the grid map, the location information of the mine car, the orientation information of the mine car, and the location information of the excavator, includes:

[0021] Determine a path point set of a next path point of the first path point according to the position information and the orientation information of the mine car; wherein the path point set includes a plurality of path points to be screened; wherein the path points to be screened correspond to the position information and the orientation information;

[0022] Determine the distance information between the position information of each path point to be screened and the position information of each obstacle;

[0023] According to each distance information, determine the target path point from the path points to be screened;

[0024] If it is determined based on the position information of the excavator that the target path point and the excavator are not in the same grid in the grid map, then the path point set of the next path point of the target path point is determined based on the position information of the target path point and the orientation information of the target path point until the determined target path point and the excavator are in the same grid in the grid map.

[0025] In a possible design, if it is determined according to the position information of the excavator that the target path point and the excavator are not in the same grid in the grid map, then according to the position information of the target path point and the orientation information of the target path point, a path point set of the next path point of the target path point is determined, until the determined target path point and the excavator are in the same grid in the grid map, further comprising:

[0026] For the path to be planned between the target path point and the path point before the target path point, if it is determined that the distance between the tangent of the path to be planned and the obstacle is greater than a preset second distance threshold, the path to be planned is determined based on the position information of the mine car, the position information of the excavator, and the target path point.

[0027] In a possible design, for the to-be-planned path between the target path point and a path point preceding the target path point, if it is determined that the distance between the tangent of the to-be-planned path and the obstacle is greater than a preset second distance threshold, then after determining that the path planning between the target path point and the path point preceding the target path point is completed, the method further includes:

[0028] If it is determined that the distance between the tangent of the path to be planned and the obstacle is less than or equal to a preset second distance threshold, a new target path point is determined from the path points to be screened based on the distance information again.

[0029] In a possible design, after determining the path to be planned according to the location information of the mine car, the location information of the excavator, and the target path point, the method further includes:

[0030] If the communication device receives the loading completion instruction sent by the excavator, it will drive to the first path point in the planned path according to the planned path; wherein the loading completion instruction indicates that the mining car has completed the object loading process at the location of the excavator.

[0031] In a second aspect, the present application provides a path planning device based on a mine car, comprising:

[0032] An acquisition unit is used to acquire a grid map of the environment where the mine car is located, the location information of the mine car, the direction information of the mine car, and the location information of the excavator; wherein the grid map represents the ground environment of the environment where the mine car is located, the location information of the mine car represents the first path point, and the location information of the excavator represents the last path point. Communication equipment is installed on both the mine car and the excavator, and the communication equipment is used to send the location information of the excavator to the mine car;

[0033] A first determining unit is used to determine a target path point in a path to be planned according to the grid map, the location information of the mine car, the orientation information of the mine car, and the location information of the excavator; wherein the path to be planned represents a path that the mine car needs to travel;

[0034] The second determining unit is used to determine the path to be planned according to the position information of the mining vehicle, the position information of the excavator, and the target path point.

[0035] In a third aspect, the present application provides an electronic device, comprising: a processor, and a memory communicatively connected to the processor;

[0036] The memory stores computer-executable instructions;

[0037] The processor executes the computer-executable instructions stored in the memory to implement a mine car-based path planning method.

[0038] In a fourth aspect, the present application provides a computer-readable storage medium, wherein the computer-readable storage medium stores computer-executable instructions, and when the computer-executable instructions are executed by a processor, they are used to implement a mine cart-based path planning method.

[0039] The mine car-based path planning method, device and storage medium provided in the present application obtain a grid map of the mine car's environment, the mine car's location information, the mine car's orientation information, and the excavator's location information, and send the excavator's location information to the mine car through communication equipment installed on the mine car and the excavator. The mine car determines the path points in the path according to the grid map, the mine car's location information, the mine car's orientation information, and the excavator's location information, and determines the path according to the path points, providing the excavator and the mine car with positioning and communication capabilities, so that the excavator and the mine car can work together, making path planning more efficient and the path safer. BRIEF DESCRIPTION OF THE DRAWINGS

[0040] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the following briefly introduces the drawings required for use in the embodiments or the description of the prior art. Obviously, the drawings described below are some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.

[0041] Figure 1 Schematic diagram of the path planning method based on the mine cart Figure 1 ;

[0042] Figure 2 Schematic diagram of the path planning method based on the mine cart Figure 2 ;

[0043] Figure 3 is a schematic diagram of the path to be planned;

[0044] Figure 4 It is a structural diagram of a mine car-based path planning device;

[0045] Figure 5 A schematic diagram of the structure of an electronic device.

[0046] The above drawings have shown clear embodiments of the present application, which will be described in more detail later. These drawings and text descriptions are not intended to limit the scope of the present application in any way, but to illustrate the concept of the present application to those skilled in the art by referring to specific embodiments. DETAILED DESCRIPTION

[0047] Exemplary embodiments will be described in detail herein, examples of which are shown in the accompanying drawings. When the following description refers to the drawings, unless otherwise indicated, the same numbers in different drawings represent the same or similar elements. The implementation methods described in the following exemplary embodiments do not represent all implementation methods consistent with the present application. On the contrary, they are merely examples of devices and methods consistent with some aspects of the present application as detailed in the attached claims, rather than all embodiments. Based on the embodiments in 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.

[0048] First, the relevant concepts or nouns involved in this application are explained:

[0049] Grid map: A gridded map with real physical size. The grid has three states: occupied, idle, and initialized.

[0050] A* algorithm: It is an algorithm that finds the path with the lowest cost on multiple nodes on a graph plane.

[0051] Hybrid A*: A path planning algorithm that is particularly suitable for robot path planning with motion constraints, such as unmanned vehicles. It combines the A* algorithm with the vehicle kinematic model to solve the path planning problem of the A* algorithm when the vehicle kinematic conditions are not met.

[0052] RS curve: Reeds-Shepp curve, used in autonomous driving paths, consists of a circular arc with a fixed radius and a straight line segment, and includes 48 curve types.

[0053] OBU: On board Unit, that is, a microwave device that uses DSRC (Dedicated Short Range Communication) technology to communicate with RSU (Road Side Unit).

[0054] Vehicle-mounted LiDAR: detects objects by emitting and receiving lasers reflected by the surface of objects.

[0055] Maximum turning radius: refers to the maximum turning radius that a vehicle can make without skidding.

[0056] With the continuous improvement of the automation level of the mine working environment, unmanned automatic driving in the entire mining process has become an important part of the construction of smart mines. Among them, the difficulty of unmanned operation in the entire process lies in the collaborative operation at both ends of loading and unloading, that is, the collaborative operation between the excavator and the unmanned mining vehicle.

[0057] At present, the loading areas of most mining areas are relatively complex and may be relatively narrow. Conventional collaborative operations and path planning solutions are not suitable for such complex loading scenarios. The proposed shoveling area operation system based on vehicle-to-vehicle collaboration can achieve truly unmanned operation.

[0058] The specific application scenarios of this application include open-pit mines and unmanned mining vehicles and excavators in open-pit mines. By adding on-board units and introducing curve construction methods and risk assessment functions, it can be used to improve the efficiency of path planning and make path planning safer.

[0059] The mine car-based path planning method, device, equipment and storage medium provided in this application are intended to solve the above technical problems in the prior art.

[0060] The technical solution of the present application and how the technical solution of the present application solves the above-mentioned technical problems are described in detail below with specific embodiments. The following specific embodiments can be combined with each other, and the same or similar concepts or processes may not be repeated in some embodiments. The embodiments of the present application will be described below in conjunction with the accompanying drawings.

[0061] Embodiment 1

[0062] Figure 1 Schematic diagram of the path planning method based on the mine car provided in the embodiment of the present disclosure Figure 1 .like Figure 1 As shown, the method includes:

[0063] S101, obtaining a grid map of the environment where the mine car is located, the location information of the mine car, the orientation information of the mine car, and the location information of the excavator; the grid map represents the ground environment of the environment where the mine car is located, the location information of the mine car represents the first path point, and the location information of the excavator represents the last path point. Communication equipment is installed on both the mine car and the excavator, and the communication equipment is used to send the location information of the excavator to the mine car.

[0064] Specifically, the mine car is equipped with a vehicle-mounted laser radar. Before the operation, the vehicle-mounted laser radar is used to collect point cloud data in the mine car loading area, and the point cloud data is processed to determine the point cloud map of the loading area. The point clouds above the preset height in the point cloud map are filtered out, and the remaining part is downsampled according to the preset multiple, and the point cloud map after the downsampling is used as the first intermediate map. The first intermediate map is noise filtered, and the first intermediate map after noise filtering is used as the second intermediate map. Based on the projection algorithm, the second intermediate map is processed, and the three-dimensional second intermediate map is projected into a two-dimensional grid map. The grid map can display the boundary of the loading area.

[0065] According to the intelligent vehicle-mounted device OBU installed on the mine car, the location information and orientation information of the mine car are obtained. According to the intelligent vehicle-mounted device OBU installed on the excavator cab and the position relationship between the excavator shovel arm and the excavator cab, the position of the excavator shovel arm is determined, and the position of the excavator shovel arm is sent to the mine car through the OBU. The location information of the mine car is set to the position of the first path point in the path, and the position of the excavator shovel arm is set to the position of the last path point in the path.

[0066] S102, determining a target path point in a path to be planned according to the grid map, the location information of the mine car, the orientation information of the mine car, and the location information of the excavator; wherein the path to be planned represents the path that the mine car needs to travel.

[0067] Specifically, a path point expansion rule is pre-set, and the path point expansion rule is used to determine a target path point from multiple path points. According to the position information and orientation information of the mine car, and the preset step length of the mine car, multiple path points that the mine car can travel at the current position are determined, and the multiple path points are used as a path point set. Among them, the preset step length of the mine car is a fixed driving distance for a single movement of the mine car. According to the preset path point expansion rule, the target path point is determined from the path point set. If the target path point and the excavator shovel arm position are not in the same grid of the grid map, the next path point set of the target path point is determined according to the position information of the target path point and the orientation information of the mine car, until the determined target path point and the excavator shovel arm position are in the same grid. The pre-set path point expansion rule can be to calculate the sum of the distance from each path point to the first path point and the distance from each path point to the last path point, and compare the sum of the distances of each path point, and determine the target path point according to the comparison result. For example, the point with the smallest sum of the path point distances is used as the target path point. The target path point is a path point in the path to be planned. The mine car needs to travel to the location of the excavator's shovel arm according to the path point to be planned.

[0068] S103, determining a path to be planned according to the location information of the mining vehicle, the location information of the excavator, and the target path point.

[0069] Specifically, after obtaining the target path point in the same grid as the excavator arm position, the adjacent path points are connected according to the preset path point connection rule to obtain the path to be planned. The preset path point connection rule is used to connect each target path point with the next target path point of the target path point. The preset path point connection rule can be to connect the path points using the RS curve.

[0070] The mine car-based path planning method, device and storage medium provided in the present application obtain a grid map of the mine car's environment, the mine car's location information, the mine car's orientation information, and the excavator's location information, and send the excavator's location information to the mine car through communication equipment installed on the mine car and the excavator. The mine car determines the path points in the path according to the grid map, the mine car's location information, the mine car's orientation information, and the excavator's location information, and determines the path according to the path points, providing the excavator and the mine car with positioning and communication capabilities, so that the excavator and the mine car can work together, making path planning more efficient and the path safer.

[0071] The following uses a specific embodiment to explain in detail the mine car-based path planning method of the present application.

[0072] Embodiment 2

[0073] Figure 2Schematic diagram of the path planning method based on the mine car provided in this embodiment Figure 2 .like Figure 2 As shown, the method includes:

[0074] S201, obtaining a grid map of the environment where the mine car is located, the location information of the mine car, the orientation information of the mine car, and the location information of the excavator; the grid map represents the ground environment of the environment where the mine car is located, the location information of the mine car represents the first path point, and the location information of the excavator represents the last path point. Communication equipment is installed on both the mine car and the excavator, and the communication equipment is used to send the location information of the excavator to the mine car.

[0075] Specifically, this step can refer to the above step S101 and will not be described in detail.

[0076] S202, determining a path point set of a next path point of the first path point according to the position information and the orientation information of the mine car; wherein the path point set includes a plurality of path points to be screened; and the path points to be screened correspond to the position information and the orientation information;

[0077] Specifically, the first path point refers to the current position of the minecart. When planning the path, starting from the first path point, the subsequent path points are determined in sequence. For the first path point, the path point set of the second path point after the first path point is determined first.

[0078] Based on the maximum turning radius of the mine car, the orientation information of the mine car, and the preset step length of the mine car, multiple path points to be screened that the mine car can reach are determined according to the current orientation of the mine car and the motion trajectory of the preset step length, and these multiple path points to be screened are regarded as a path point set. Among them, the path point to be screened corresponds to the position information of the path point to be screened and the orientation information of the mine car at the path point to be screened. The path point to be screened can be the position that the mine car can reach after traveling a preset step length, determined based on the maximum turning radius of the mine car and the orientation of the mine car at the first path point, as well as the preset step length of the mine car.

[0079] S203, determining the distance information between the position information of each to-be-screened path point and the position information of each obstacle;

[0080] Specifically, the grids in the grid map that are represented as occupied are taken as obstacle grids, that is, the positions where obstacles exist are obtained. According to the position information of each path point in the path point set, the straight-line distance between each path point and each obstacle within the preset range is determined as distance information. The preset range can be a circle with the path point to be screened as the center and the preset safety distance as the radius.

[0081] S204, determining a target path point from the path points to be screened according to each distance information;

[0082] Specifically, a risk assessment function d(k) is pre-set to determine whether the distance between the path point to be screened and the obstacle is safe, which can be expressed as where d 0 is the distance between the path point to be screened and the obstacle, d max is a safe distance. A cost function F(n)=G(n)+H(n) is pre-set to determine the distance the mine car needs to travel to reach the end point after passing through the path point to be screened, where G(n) represents the distance from the first path point, that is, the position of the mine car, to the path point to be screened, and H(n) represents the distance from the target path point to the last path point, that is, the position of the shovel arm. According to the acquired distance information, the preset risk assessment function, and the preset cost function, the path point to be screened with the smallest risk assessment function d(k) is selected from the path points to be screened as the target path point. If the risk assessment function d(k) of different path points to be screened is the same, the target path point to be screened with the smallest F(n) is selected.

[0083] If after obtaining the target path point, it is determined that the target path point and the excavator shovel arm are not in the same grid according to the position information of the excavator shovel arm, then the next path point set of the target path point is determined according to the position information of the target path point and the orientation information of the mine car under the target path point, and the next path point set of the target path point includes multiple path points to be screened corresponding to the target path point. That is, for each determined path point, the path point to be screened of the path point can be determined. And from the path point set, according to the preset risk assessment function and the preset cost function, the next path point of the target path point is determined, until the determined target path point and the position of the excavator shovel arm are located in the same grid of the grid map.

[0084] S205. For each target path point in the path to be planned, if the distance between the target path point and the previous path point of the target path point in the path to be planned is less than a preset first distance threshold, determine the extension direction and straight line length of the straight line segment to be connected according to the position information and orientation information of the previous path point of the target path point.

[0085] Specifically, a first distance threshold is pre-set, and the first distance threshold is a fixed distance for a single movement of the mine car, that is, a preset step length. For each target path point in the path to be planned, if the distance between the target path point and the previous path point of the target path point in the path to be planned is less than the preset first distance threshold, the target path point and the previous path point of the target path point are placed in a plane rectangular coordinate system. Among them, the origin of the plane rectangular coordinate system is the target path point, and the coordinate point of the previous path point of the target path point is k (x, y, θ). The coordinate point is used as the coordinate to be resolved, x is the horizontal coordinate of the coordinate point, corresponding to the east-west direction in the grid map; y is the vertical coordinate of the coordinate point, corresponding to the south-north direction of the grid map; θ is the angle of the coordinate point relative to the coordinate origin, corresponding to the orientation information of the target path point and the previous path point of the target path point.

[0086] The formula for determining the length of a straight line segment is preset. The formula for determining the length of a straight line segment is: Among them l 0 Represents the length of the straight line segment, x is the horizontal coordinate value of the coordinate to be resolved, y is the vertical coordinate value of the coordinate to be resolved, and θ is the angle information of the coordinate to be resolved. Input the coordinate value of the previous path point of the target path point into the formula for analysis to obtain the length of the straight line segment l 0 The extension direction of the straight line is determined according to the orientation information of the minecart at the target path point and the path point before the target path point. For example, the extension direction is the orientation of the minecart at the path point before the target path point.

[0087] If the distance between the target path point and the previous path point of the target path point in the path to be planned is equal to a preset first distance threshold, the mine car connects the target path point and the previous path point of the target path point through a straight line along the direction of the previous path point of the target path point.

[0088] S206: Determine the length and curvature of the curve segment to be connected according to the position information and orientation information of the previous path point of the target path point.

[0089] Specifically, the formula for determining the length of the curve is preset, and the formula for determining the length of the curve is: Among them l 1 Characterize the length of the curve segment. Input the coordinate value of the previous path point of the target path point into the formula for analysis to obtain the curve segment length l 1 .

[0090] The curvature determination formula is preset, and the curvature determination formula is: in Characterizes the curvature of the curve, y is the vertical coordinate value of the coordinate to be analyzed, and θ is the angle information of the coordinate to be analyzed. The coordinate value of the previous path point of the target path point is input into the formula for analysis to obtain the curvature of the curve The curvature of the curve is Less than the maximum curvature allowed for the path.

[0091] S207. Connect the straight line segment to be connected with the previous path point of the target path point according to the extension direction and the length of the straight line segment to be connected to obtain the end point position of the straight line to be connected; connect the end point position of the straight line segment to be connected with the target path point according to the curve length and curvature of the curve segment to be connected to obtain the path to be planned.

[0092] Specifically, starting from the previous path point of the target path point, along the extension direction of the straight line to be connected, the previous path point of the target path point is connected with the straight line to be connected to obtain the end point position of the straight line to be connected. According to the length and curvature of the curve segment to be connected, a complete curve segment to be connected is obtained, and starting from the end point position of the straight line to be connected, the end point position of the straight line to be connected and the target path point are connected through the complete curve to be connected to obtain the path to be planned.

[0093] Figure 3 This is a schematic diagram of the path to be planned provided in this embodiment.

[0094] like Figure 3 As shown, point a represents the previous path point of the target path point, point b represents the end point of the straight line to be connected, point c represents the target path point, the straight line segment between point a and point b represents the straight line to be connected, and the curve segment between point b and point c represents the curve to be connected.

[0095] S208: Determine whether the distance between the tangent of the path to be planned and the obstacle is greater than a preset second distance threshold. If so, execute S209; if not, execute S204.

[0096] Specifically, a second distance threshold is pre-set, and the second distance threshold is the minimum distance allowed between the mine car and the obstacle. For example, the second distance threshold can be the radius of the circumscribed circle of the mine car. The path to be planned is the mine car driving trajectory between the target path point and the path point before the target path point. If it is determined that the distance between any tangent line of the path to be planned and the obstacle is greater than the preset second distance threshold, it is determined that the mine car and the obstacle will not collide, and S209 is executed; if it is determined that any tangent line of the path to be planned is less than or equal to the second distance threshold, it is determined that a collision may occur, and S204 is executed to reselect the target path point.

[0097] S209. If the communication device receives a loading completion instruction sent by the excavator, the communication device drives to the first path point in the planned path according to the planned path; wherein the loading completion instruction indicates that the mining vehicle completes the object loading process at the location of the excavator.

[0098] Specifically, after the mine car completes the loading operation at the excavator shovel arm position, the excavator sends the loading completion instruction to the mine car through the intelligent on-board device OBU. After receiving the instruction, the mine car drives to the first path point in the planned path according to the trajectory of the planned path.

[0099] The mine car-based path planning method, device and storage medium provided in the present application obtain a grid map of the mine car's environment, the mine car's location information, the mine car's orientation information, and the excavator's location information, and send the excavator's location information to the mine car through communication equipment installed on the mine car and the excavator. The mine car determines the path points in the path according to the grid map, the mine car's location information, the mine car's orientation information, and the excavator's location information, and determines the path according to the path points, providing positioning and communication capabilities for the excavator and the mine car, so that the excavator and the mine car can work together, making the path planning more efficient, the path safer and not hindering the planning, and making the planned path more suitable for the mine car to travel in narrow areas.

[0100] The embodiment of the present invention can divide the electronic device or the main control device into functional modules according to the above method example. For example, each functional module can be divided according to each function, or two or more functions can be integrated into one processing unit. The above integrated unit can be implemented in the form of hardware or in the form of software functional modules. It should be noted that the division of modules in the embodiment of the present invention is schematic and is only a logical function division. There may be other division methods in actual implementation.

[0101] Figure 4 This is a schematic diagram of the structure of a mine car-based path planning device provided in an embodiment of the present application. Figure 4 As shown, the device 40 includes:

[0102] The acquisition unit 401 is used to acquire a grid map of the environment where the mine car is located, the location information of the mine car, the orientation information of the mine car, and the location information of the excavator; wherein the grid map represents the ground environment of the environment where the mine car is located, the location information of the mine car represents the first path point, and the location information of the excavator represents the last path point. The mine car and the excavator are both equipped with communication equipment, and the communication equipment is used to send the location information of the excavator to the mine car;

[0103] A first determining unit 402 is used to determine a target path point in a path to be planned according to the grid map, the location information of the mine car, the orientation information of the mine car, and the location information of the excavator; wherein the path to be planned represents a path that the mine car needs to travel;

[0104] The second determining unit 403 is used to determine the path to be planned according to the location information of the mine car, the location information of the excavator, and the target path point.

[0105] Furthermore, the first determining unit 402 is specifically configured to:

[0106] Determine a path point set of a next path point of the first path point according to the position information of the mine car and the orientation information of the mine car; wherein the path point set includes a plurality of path points to be screened; wherein the path points to be screened correspond to the position information and the orientation information;

[0107] Determine the distance information between the position information of each path point to be screened and the position information of each obstacle;

[0108] Determine the target path point from the path points to be screened according to each of the distance information;

[0109] If it is determined based on the position information of the excavator that the target path point and the excavator are not in the same grid in the grid map, then a path point set for the next path point of the target path point is determined based on the position information of the target path point and the orientation information of the target path point until the determined target path point and the excavator are in the same grid in the grid map.

[0110] Furthermore, the first determining unit 402 is further configured to:

[0111] For the path to be planned between the target path point and the path point before the target path point, if it is determined that the distance between the tangent of the path to be planned and the obstacle is greater than a preset second distance threshold, it is determined that the path planning between the target path point and the path point before the target path point is completed.

[0112] Furthermore, the first determining unit 402 is further configured to:

[0113] If it is determined that the distance between the tangent of the path to be planned and the obstacle is less than or equal to a preset second distance threshold, a new target path point is determined from the path points to be screened again based on each of the distance information.

[0114] Further, the second determining unit 403 is specifically configured to:

[0115] For each target path point in the path to be planned, if the distance between the target path point and the previous path point of the target path point in the path to be planned is less than a preset first distance threshold, the target path point and the previous path point of the target path point are connected to obtain the path to be planned.

[0116] Further, the second determining unit 403 is specifically configured to:

[0117] Determine a straight line segment to be connected and a curve segment to be connected according to the position information and orientation information of a previous path point of the target path point; wherein the straight line segment to be connected and the curve segment to be connected represent a path to be planned between the target path point and the previous path point of the target path point;

[0118] The path to be planned is determined according to the position information and orientation information of the previous path point of the target path point, the position information of the target path point, the straight line segment to be connected, and the curved line segment to be connected.

[0119] Further, the second determining unit 403 is specifically configured to:

[0120] Determine the extension direction and the length of the straight line segment to be connected according to the position information and orientation information of the previous path point of the target path point;

[0121] The curve length and curvature of the curve segment to be connected are determined according to the position information and orientation information of the previous path point of the target path point.

[0122] Further, the second determining unit 403 is specifically configured to:

[0123] According to the extension direction and the length of the straight line segment to be connected, the straight line segment to be connected is connected with the previous path point of the target path point to obtain the end point position of the straight line to be connected;

[0124] According to the curve length and curvature of the curve segment to be connected, the end point position of the straight line segment to be connected is connected with the target path point to obtain the path to be planned.

[0125] The mine cart-based path planning device provided in this embodiment can execute the mine cart-based path planning method of the above embodiment, and its implementation principle and technical effect are similar, which will not be described in detail in this embodiment.

[0126] In the specific implementation of the aforementioned gear control device based on a heavy-load vehicle, each module can be implemented as a processor, and the processor can execute computer-executable instructions stored in the memory, so that the processor executes the aforementioned gear control method based on a heavy-load vehicle.

[0127] Figure 5 This is a schematic diagram of the structure of an electronic device provided in an embodiment of the present application. Figure 5As shown, the electronic device 50 includes: at least one processor 501 and a memory 502. The electronic device 50 also includes a communication component 503. The processor 501, the memory 502 and the communication component 503 are connected via a bus 505.

[0128] In a specific implementation process, at least one processor 501 executes the computer-executable instructions stored in the memory 502, so that at least one processor 501 executes the mine car-based path planning method executed by the electronic device side as above.

[0129] The specific implementation process of the processor 501 can be found in the above method embodiment, and its implementation principle and technical effect are similar, so this embodiment will not be repeated here.

[0130] In the above embodiments, it should be understood that the processor may be a central processing unit (CPU), or other general-purpose processors, digital signal processors (DSP), application-specific integrated circuits (ASIC), etc. A general-purpose processor may be a microprocessor or any conventional processor. The steps of the method disclosed in the invention may be directly implemented as being executed by a hardware processor, or may be executed by a combination of hardware and software modules in the processor.

[0131] The memory may include a high-speed RAM memory, and may also include a non-volatile storage NVM, such as at least one disk storage.

[0132] The bus may be an Industry Standard Architecture (ISA) bus, a Peripheral Component Interconnect (PCI) bus, or an Extended Industry Standard Architecture (EISA) bus, etc. The bus may be divided into an address bus, a data bus, a control bus, etc. For ease of representation, the bus in the drawings of the present application is not limited to only one bus or one type of bus.

[0133] The above-mentioned functions implemented by the electronic device and the main control device introduce the scheme provided by the embodiment of the present invention. It can be understood that in order to implement the above-mentioned functions, the electronic device or the main control device includes a hardware structure and / or software module corresponding to the execution of each function. In combination with the units and algorithm steps of each example described in the embodiment disclosed in the embodiment of the present invention, the embodiment of the present invention can be implemented in the form of hardware or a combination of hardware and computer software. Whether a function is executed in the form of hardware or computer software driving hardware depends on the specific application and design constraints of the technical solution. Those skilled in the art can use different methods to implement the described functions for each specific application, but such implementation should not be considered to exceed the scope of the technical solution of the embodiment of the present invention.

[0134] The present application also provides a computer-readable storage medium, in which computer-executable instructions are stored. When a processor executes the computer-executable instructions, the above-mentioned mine car-based path planning method is implemented.

[0135] The computer-readable storage medium mentioned above can be implemented by any type of volatile or non-volatile storage device or a combination thereof, such as static random access memory (SRAM), electrically erasable programmable read-only memory (EEPROM), erasable programmable read-only memory (EPROM), programmable read-only memory (PROM), read-only memory (ROM), magnetic memory, flash memory, magnetic disk or optical disk. The readable storage medium can be any available medium that can be accessed by a general or special-purpose computer.

[0136] An exemplary readable storage medium is coupled to a processor so that the processor can read information from the readable storage medium and write information to the readable storage medium. Of course, the readable storage medium can also be a component of the processor. The processor and the readable storage medium can be located in an application specific integrated circuit (Application Specific Integrated Circuits, referred to as: ASIC). Of course, the processor and the readable storage medium can also exist as discrete components in an electronic device or a main control device.

[0137] The present application also provides a computer program product, which includes: a computer program, which is stored in a readable storage medium. At least one processor of an electronic device can read the computer program from the readable storage medium, and at least one processor executes the computer program so that the electronic device executes the solution provided by any of the above embodiments.

[0138] Those skilled in the art can understand that all or part of the steps of implementing the above-mentioned method embodiments can be completed by hardware related to program instructions. The aforementioned program can be stored in a computer-readable storage medium. When the program is executed, the steps of the above-mentioned method embodiments are executed; and the aforementioned storage medium includes: ROM, RAM, disk or optical disk and other media that can store program codes.

[0139] 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 mine car-based path planning method, characterized in that: The method is applied to a mine car, comprising: Obtaining a grid map of the environment where the mine car is located, the location information of the mine car, the orientation information of the mine car, and the location information of the excavator; wherein the grid map represents the ground environment of the environment where the mine car is located, the location information of the mine car represents the first path point, and the location information of the excavator represents the last path point, and the mine car and the excavator are both equipped with communication equipment, and the communication equipment is used to send the location information of the excavator to the mine car; Determine a target path point in a path to be planned according to the grid map, the location information of the mine car, the orientation information of the mine car, and the location information of the excavator; wherein the path to be planned represents a path that the mine car needs to travel; The path to be planned is determined according to the position information of the mining car, the position information of the excavator, and the target path point.

2. The method according to claim 1, characterized in that Determining the path to be planned according to the location information of the mine car, the location information of the excavator, and the target path point includes: For each target path point in the path to be planned, if the distance between the target path point and the previous path point of the target path point in the path to be planned is less than a preset first distance threshold, the target path point and the previous path point of the target path point are connected to obtain the path to be planned.

3. The method according to claim 2, characterized in that Each of the target path points has corresponding position information and orientation information, and the orientation information represents the orientation of the mine car when it travels to the target path point; Connecting the target path point and a previous path point of the target path point to obtain a path to be planned, including: Determine a straight line segment to be connected and a curve segment to be connected according to the position information and orientation information of a previous path point of the target path point; wherein the straight line segment to be connected and the curve segment to be connected represent a path to be planned between the target path point and the previous path point of the target path point; The path to be planned is determined according to the position information and orientation information of the previous path point of the target path point, the position information of the target path point, the straight line segment to be connected, and the curved line segment to be connected.

4. The method according to claim 3, characterized in that Determining the straight line segments to be connected and the curve segments to be connected according to the position information and the orientation information of the previous path point of the target path point includes: Determine the extension direction and the length of the straight line segment to be connected according to the position information and orientation information of the previous path point of the target path point; The curve length and curvature of the curve segment to be connected are determined according to the position information and orientation information of the previous path point of the target path point.

5. The method according to claim 3, characterized in that: Determining the path to be planned according to the position information and orientation information of the previous path point of the target path point, the position information of the target path point, the straight line segment to be connected, and the curved line segment to be connected, including: According to the extension direction and the length of the straight line segment to be connected, the straight line segment to be connected is connected with the previous path point of the target path point to obtain the end point position of the straight line to be connected; According to the curve length and curvature of the curve segment to be connected, the end point position of the straight line segment to be connected is connected with the target path point to obtain the path to be planned.

6. The method according to claim 1, characterized in that The grid map includes location information of a plurality of obstacles; determining a target path point in a path to be planned according to the grid map, the location information of the mine car, the orientation information of the mine car, and the location information of the excavator, including: Determine a path point set of a next path point of a first path point according to the position information of the mine car and the orientation information of the mine car; wherein the path point set includes a plurality of path points to be screened; wherein the path points to be screened correspond to the position information and the orientation information; Determine the distance information between the position information of each path point to be screened and the position information of each obstacle; Determine the target path point from the path points to be screened according to each of the distance information; If it is determined based on the position information of the excavator that the target path point and the excavator are not in the same grid in the grid map, then a path point set for the next path point of the target path point is determined based on the position information of the target path point and the orientation information of the target path point until the determined target path point and the excavator are in the same grid in the grid map.

7. The method according to claim 6, characterized in that Also includes: For the path to be planned between the target path point and the path point before the target path point, if it is determined that the distance between the tangent of the path to be planned and the obstacle is greater than a preset second distance threshold, it is determined that the path planning between the target path point and the path point before the target path point is completed.

8. The method according to claim 6, characterized in that Also includes: If it is determined that the distance between the tangent of the path to be planned and the obstacle is less than or equal to a preset second distance threshold, a new target path point is determined again from the path points to be screened based on each of the distance information.

9. The method according to claim 1, characterized in that: Also includes: If the communication device receives a loading completion instruction sent by the excavator, it will travel to the first path point in the path to be planned according to the path to be planned; wherein the loading completion instruction represents the process of the mining car completing the object loading process at the location of the excavator.

10. A path planning device based on a mine car, comprising: an acquisition unit, configured to acquire a grid map of the environment where the mine car is located, location information of the mine car, orientation information of the mine car, and location information of the excavator; wherein the grid map represents the ground environment of the environment where the mine car is located, the location information of the mine car represents the first path point, and the location information of the excavator represents the last path point; the mine car and the excavator are both equipped with communication equipment, and the communication equipment is used to send the location information of the excavator to the mine car; A first determining unit is used to determine a target path point in a path to be planned according to the grid map, the location information of the mine car, the orientation information of the mine car, and the location information of the excavator; wherein the path to be planned represents a path that the mine car needs to travel; The second determining unit is used to determine the path to be planned according to the position information of the mining car, the position information of the excavator, and the target path point.

11. An electronic device, characterized in that: include: A processor, and a memory communicatively connected to the processor; The memory stores computer-executable instructions; The processor executes the computer-executable instructions stored in the memory to implement the method according to any one of claims 1 to 9.

12. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores computer-executable instructions, which are used to implement the method according to any one of claims 1 to 9 when executed by a processor.

Citation Information

Cited By

  • Path planning method, system and equipment for automatic driving mine car in loading area of mining area and medium

    CN121632193A