Automatic driving path planning method and device, equipment and storage medium
By using the path of the previous cycle as the basis for the next cycle before the pre-sight time point, adjusting and splicing new paths, the inter-frame smoothing and pre-sighting point continuity problems in the autonomous driving system are solved, and a smoother path is achieved Planning and a better driving experience.
Patent Information
- Application Number
- CN202411211368.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-30
- Publication Date
- 2024-12-06
AI Technical Summary
The existing autonomous driving path planning method cannot ensure inter-frame smoothness and inter-frame continuity of pre-sight points under the perspective of the controller module, resulting in large angle direction problems at the path splicing points of the vehicle, affecting the driving experience.
Use the partially planned path of the previous cycle as the first part of the next cycle before the pre-targeting point, adjust and splice new paths to ensure that the vehicle is traveling in the original direction at the initial stage and adjust the route after a distance , realize smooth path update.
The problem of direction from a large angle is avoided, ensuring that the vehicle is driving in the original direction in the initial stage, and the route is adjusted when appropriate, improving the smoothness of the path and driving experience.
Smart Images

Figure CN119085677A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of autonomous driving technology, and specifically to an autonomous driving path planning method, device, equipment and storage medium. Background Art
[0002] The methods for generating smooth paths in the planning module of the autonomous driving system mainly include curve interpolation-based methods, search-based methods, optimization-based methods, learning-based methods, and various combined applications. These methods can achieve smooth paths in a single frame, but cannot guarantee smoothness between frames from the perspective of the controller module, let alone continuity between frames of the preview points of the controller module.
[0003] In view of the above problems, the existing technology mainly realizes the inter-frame smoothing function from the perspective of the controller module through the path splicing function. Figure 2 In the process of path splicing, the path (L2) of the next cycle is often calculated by using the position of the vehicle, and it is spliced on the path (L1) planned in this cycle. When the vehicle is driving along these spliced paths, the vehicle will jump to the new planned path at the path splicing point. However, before the jump, it still controls the direction angle of the driving process with the preview point position at a certain distance from the vehicle (located by the preview time). When the path jump occurs, the controller preview point jump will cause a large-angle steering problem at the current position, affecting the driving experience. Summary of the invention
[0004] The present application provides an autonomous driving path planning method, device, equipment and storage medium, which can solve related technical problems existing in the prior art.
[0005] In a first aspect, the present application provides a method for planning an autonomous driving path, which adopts the following technical solution:
[0006] A method for planning an autonomous driving path, the method comprising:
[0007] Obtain the preview time point of the vehicle and the planned path determined in the previous path planning cycle;
[0008] Determining a path planning point on the planned path after the preview time point;
[0009] Acquire a path before the path planning point in the planned path that has not been traveled as a first path;
[0010] Acquire a second path planned with the path planning point as a starting point;
[0011] The planned path is updated according to the first path and the second path.
[0012] In combination with the first aspect, in one implementation, determining a path planning point on the planned path after the preview time point comprises the following steps:
[0013] Determining the planned position time point according to the preview time point and the set time interval;
[0014] Determine a path planning point on the planned path according to the planned position time point.
[0015] In combination with the first aspect, in one implementation, updating the planned path according to the first path and the second path includes the following steps:
[0016] adjusting the first path according to the distance between the last coordinate point of the first path and the first coordinate point of the second path;
[0017] The first path and the second path are spliced together, and the planned path is updated with the splicing result.
[0018] In combination with the first aspect, in one implementation, before determining the path planning point on the planned path after the preview time point, the following steps are included:
[0019] Obtaining a risk path in the planned path predicted by a driving risk module;
[0020] Determining whether the time information corresponding to the risk path is before the preview time point;
[0021] If so, taking a point on the planned path between the current position of the vehicle and the risk path as a path planning point;
[0022] If not, executing the step of determining a path planning point on the planned path after the preview time.
[0023] In combination with the first aspect, in one implementation, taking a point on the planned path between the current position of the vehicle and the risk path as a path planning point comprises the following steps:
[0024] Acquire safe operation time, and determine the distance between the path planning point and the starting point of the risk path according to the safe operation time;
[0025] The path planning point is determined according to the distance between the path planning point and the starting point of the risk path.
[0026] In combination with the first aspect, in one implementation, before determining the path planning point on the planned path after the preview time point, the following steps are included:
[0027] According to one or more preset judgment conditions, determining whether the vehicle currently has conditions for traveling along the planned path;
[0028] If it does not exist, determine the position of the vehicle in the next path planning cycle based on the current vehicle position and driving state parameters, and establish a new path that replaces the planned path with the position of the vehicle in the next path planning cycle as the starting point;
[0029] If it exists, execute the subsequent update steps of the planned path.
[0030] In combination with the first aspect, in one embodiment, the judgment condition includes whether the distance between the current position of the vehicle and the nearest coordinate point of the planned path exceeds a preset first threshold and / or whether the closest lateral distance between the current position of the vehicle and the planned path exceeds a preset second threshold.
[0031] In a second aspect, the embodiment of the present application provides a device for planning an autonomous driving path, which adopts the following technical solution:
[0032] A device for planning an automatic driving path, the device comprising:
[0033] An acquisition module, configured to acquire a preview time point of the vehicle and a planned path determined in a previous path planning cycle;
[0034] A planning point determination module, configured to determine a path planning point on the planned path after the preview time point;
[0035] A path planning module is configured to obtain a path before the path planning point in the planned path that has not been traveled as a first path; obtain a second path planned with the path planning point as a starting point; and update the planned path based on the first path and the second path.
[0036] In a third aspect, the embodiment of the present application provides an automatic driving path planning device, which adopts the following technical solution:
[0037] A device for planning an autonomous driving path, comprising a processor, a memory, and an autonomous driving path planning program stored in the memory and executable by the processor, wherein when the autonomous driving path planning program is executed by the processor, the steps of the autonomous driving path planning method as described above are implemented.
[0038] In a fourth aspect, an embodiment of the present application provides a storage medium, which adopts the following technical solution:
[0039] A storage medium stores an autonomous driving path planning program, wherein when the autonomous driving path planning program is executed by a processor, the steps of the autonomous driving path planning method as described above are implemented.
[0040] The beneficial effects brought by the technical solution provided in the embodiments of the present application include:
[0041] By using part of the planned path of the previous cycle as the first part of the planned path of the next cycle before the preview time point, that is, the first path, the vehicle can drive according to the previously planned route in the initial stage when driving according to the planned path. In this stage, the vehicle will still drive according to the previous automatic driving direction, thereby avoiding the problem of large-angle steering in the first time. At the same time, after driving a certain distance, the newly planned second path can be used to adjust the route to meet driving needs. Finally, the route planning can be smoother while the route planning is carried out according to the driving task. BRIEF DESCRIPTION OF THE DRAWINGS
[0042] Figure 1 This is a flow chart of an embodiment of a method for planning an autonomous driving path of the present application;
[0043] Figure 2 A schematic diagram of the path splicing result obtained by the prior art of this application;
[0044] Figure 3 A schematic diagram of the path splicing result obtained by the method provided in this application;
[0045] Figure 4 This is a schematic diagram of the functional modules of an embodiment of an automatic driving path planning device of the present application;
[0046] Figure 5 This is a schematic diagram of the hardware structure of the autonomous driving path planning device involved in the embodiment of the present application. DETAILED DESCRIPTION
[0047] 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.
[0048] The methods for generating smooth paths in the planning module of the autonomous driving system mainly include curve interpolation-based methods, search-based methods, optimization-based methods, learning-based methods, and various combined applications. These methods can achieve smooth paths in a single frame, but cannot guarantee smoothness between frames from the perspective of the controller module, let alone continuity between frames of the preview points of the controller module.
[0049] In view of the above problems, the existing technology mainly realizes the inter-frame smoothing function from the perspective of the controller module through the path splicing function. However, in the process of path splicing, the path of the next cycle is often calculated by using the position of the vehicle and spliced onto the path planned in the current cycle, resulting in the vehicle driving along these spliced paths. Figure 2 The vehicle will jump to the new planned path at the path joint point, but before the jump it still uses the preview point position (located by the preview time) at a certain distance from the vehicle to control the direction and angle of the driving process. When the path jump occurs, the controller preview point jump will cause a large-angle steering problem at the current position, affecting the driving experience.
[0050] Based on the above-mentioned problems in the prior art, the present invention provides a method, device, equipment and storage medium for planning an automatic driving path. The key point of the invention is that, by using part of the planned path of the previous cycle as the first part of the planned path of the next cycle before the preview time point, that is, the first path, when the vehicle is driving according to the planned path, it can drive according to the previously planned route in the initial stage. In this stage, the vehicle will still drive according to the previous automatic driving direction, thereby avoiding the problem of large-angle steering in the first time. At the same time, after driving a certain distance, the newly planned second path can be used to adjust the route to meet driving needs, thereby finally achieving route planning according to the driving task while the planned route can be smoother.
[0051] 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 with reference to the accompanying drawings.
[0052] In a first aspect, an embodiment of the present application provides a method for planning an autonomous driving path.
[0053] In one embodiment, referring to Figure 1 , Figure 1 This is a flow chart of the first embodiment of the automatic driving path planning method of this application. Figure 1 As shown in the figure, the planning method of the autonomous driving path includes:
[0054] S100, obtaining the preview time point of the vehicle and the planned path determined in the previous path planning cycle;
[0055] Among them, the preview time point of the vehicle is specifically measured by the lateral preview time t_preveiw of the controller module. For the two preview time situations currently existing in the controller module, this application provides different acquisition schemes. For the case where the controller preview time is fixed, the preview time is obtained offline and written into the path splicing module in a hard-coded form; for the case where the controller preview time is dynamically adjusted, the controller sends the preview time to the planning module that executes this scheme using the relevant communication protocol.
[0056] For the planned path determined in the previous path planning cycle, since the path point coordinates generated by the planning module are in two types: vehicle coordinate system and global coordinate system, and the global coordinates need to be converted to the vehicle coordinate system with the rear axle center as the origin and the vehicle's forward direction as the x-axis through coordinate transformation during the planning module cycle, the position of the origin of the vehicle coordinate system in the global coordinate system changes when the vehicle is in motion. Therefore, the vehicle coordinate system path points of the previous cycle planning results cannot be used directly during the current cycle planning, but the global coordinate system path needs to be used for coordinate conversion.
[0057] S200, determining a path planning point on the planned path after the preview time point;
[0058] Specifically, in this embodiment, the following steps are included:
[0059] S210, determining a planned position time point according to the preview time point and a set time interval;
[0060] S220: Determine a path planning point on the planned path according to the planned position time point.
[0061] In this embodiment, the set time interval is preferably the duration of the path planning cycle, and the planned position time point is the time point corresponding to the preview time point after the set time interval. In this way, the vehicle's travel distance can be taken into account during the calculation process of this cycle, so that a path planning point that is more in line with the actual driving situation of the vehicle can be obtained in subsequent calculations.
[0062] S300, obtaining a path before the path planning point in the planned path that has not been traveled as a first path;
[0063] This setting enables the vehicle to travel according to the previously planned route in the initial stage when traveling along the planned path. During this stage, the vehicle will still travel in the previous automatic driving direction, thereby avoiding the problem of large-angle steering in the first place.
[0064] S400, obtaining a second path planned with the path planning point as a starting point;
[0065] Specifically, the calculation and planning process of the second path is still performed by the path planning algorithm involved in the vehicle's automatic driving related programs according to the driving task, and this application does not make further adjustments and restrictions on this.
[0066] S500: Update the planned path according to the first path and the second path.
[0067] Specifically, step S500 includes the following steps:
[0068] S510, adjusting the first path according to the distance between the last coordinate point of the first path and the first coordinate point of the second path;
[0069] In this embodiment, whether to adjust the first path is determined based on whether the distance between the first point of the second path and the last point of the first path is less than a certain threshold. Specifically, when the distance is less than the threshold, the first path is adjusted by deleting the last point in the first path. This setting ensures that the spacing between the coordinate points in the final planned path is more reasonable during subsequent splicing, which is convenient for executing the autonomous driving task.
[0070] S520: Splice the first path and the second path, and update the planned path with the splicing result.
[0071] Finally, refer to Figure 3 By using part of the planned path of the previous cycle as the first part of the planned path of the next cycle before the preview time point, that is, the first path, the vehicle can drive according to the previously planned route in the initial stage when driving along the planned path. In this stage, the vehicle will still drive according to the previous automatic driving direction, thereby avoiding the problem of large-angle steering at the first time. At the same time, after driving a certain distance, the newly planned second path can be used to adjust the route to meet driving needs. Finally, while planning the route according to the driving task, the planned route can be smoother.
[0072] In addition, when the vehicle is driven in the current path planning cycle according to the above method, it will always first drive a path planned in the previous path planning cycle, which results in that the path does not take into account the external situation at the current moment, that is, the path may have external risks for the current moment, such as lane change cancellation scenarios, temporary meeting scenarios, etc. Therefore, in order to reduce the possibility of risks, further, in some embodiments provided in the present application, the step 200, before determining the path planning point on the planned path after the preview time point, includes the following steps:
[0073] S110, obtaining a risk path in the planned path predicted by a driving risk module;
[0074] S120, determining whether the time information corresponding to the risk path is before the preview time point;
[0075] S130: If yes, taking a point on the planned path between the current position of the vehicle and the risk path as a path planning point;
[0076] S140: If not, executing the step of determining a path planning point on the planned path after the preview time.
[0077] This arrangement can realize the use of the vehicle's driving risk module to analyze whether there is a risk path in the planned path according to the current vehicle driving environment and driving status. For the case of a risk-free path, the planned path obtained in the previous planning cycle is driven according to the method described above; for the existing risk path, it is further determined whether it is before the preview time point, that is, whether the first path obtained in the previous path planning cycle involves a risk path. If so, it is impossible to continue to select the path planning point according to the method described above. In this case, it is preferred to use a point on the planned path between the current position of the vehicle and the risk path as the path planning point, thereby avoiding the vehicle from driving on the risk path. As for how to determine the risk path, it is another technical solution for driving risk assessment in this field, but not the main technical solution of this solution. This application only needs to use the assessment results of the risk path, and does not limit the specific method of how to obtain the risk path, so it will not be introduced in detail here.
[0078] Furthermore, the step S130, taking a point on the planned path between the current position of the vehicle and the risk path as a path planning point, includes the following steps:
[0079] S131, obtaining a safe operation time, and determining a distance between the path planning point and a starting point of a risk path according to the safe operation time;
[0080] S132: Determine the path planning point according to the distance between the path planning point and the starting point of the risk path.
[0081] In this embodiment, the nearest turning point before driving to the risky path is grasped through the preset safety operation time. At this time, it is also the farthest distance that the vehicle can travel along the first path under normal circumstances. While reducing the driving risk, it can ensure that the vehicle arrives at the turning point as late as possible, thereby maximizing the smoothness of the vehicle's driving process.
[0082] On the other hand, the execution of the above method may not meet its execution conditions in some situations in practice. For example, for a vehicle that has just started, since there is no planned path in the previous path planning cycle, it is impossible to use the planned path for planning in this cycle. For example, when the planned path obtained in the previous cycle does not meet the current automatic driving expectations at all, the above method cannot be used for path planning. Therefore, in response to these possible situations, the present application, in some embodiments, further adopts the following technical solutions:
[0083] In step S200, before determining the path planning point on the planned path after the preview time point, the following steps are included:
[0084] S101, judging whether the vehicle currently has conditions for traveling along the planned path according to one or more preset judgment conditions;
[0085] S102, if it does not exist, determine the position of the vehicle in the next path planning cycle based on the current vehicle position and driving state parameters, and establish a new path that replaces the planned path with the position of the vehicle in the next path planning cycle as the starting point;
[0086] S103: If yes, execute the subsequent update steps of the planned path.
[0087] Specifically, in this embodiment, the judgment condition at least includes whether the distance between the current position of the vehicle and the nearest coordinate point of the planned path exceeds a preset first threshold and / or whether the nearest lateral distance between the current position of the vehicle and the planned path exceeds a preset second threshold. In this way, when the vehicle is not currently traveling along the planned path but has obviously deviated from the planned path, it means that an abnormal situation has occurred and it is impossible to continue traveling along the planned path of the previous cycle. At this time, step S102 can be executed to re-plan a new path according to the planning module based on the current position of the vehicle and the driving state parameters to replace the planned path. In addition, in other embodiments, the judgment condition also includes but is not limited to:
[0088] When the vehicle enters the automatic driving mode for the first time, even if the planning module has the path of the previous cycle stored in it, it is considered that there is no condition to drive along the planned path because it cannot confirm whether the path of the previous cycle meets the expectation, and thus a new path is replanned;
[0089] When the current lane length is less than a certain threshold, the lane width is in a shrinking state, and the vehicle speed is low, it means that the lane is continuously shrinking and there may be a risk of collision if the vehicle travels along the first path. Therefore, it is considered that there are no conditions for traveling along the planned path, and a new path is replanned.
[0090] At the same time, since the vehicle may be in motion when replanning a new path, the driving control module needs to receive the planning result after a path planning cycle time dt, so the planning starting point needs to be recursively pushed forward by a planning cycle time dt through vehicle kinematics. Therefore, it is necessary to determine the vehicle position in the next path planning cycle in step S102 based on the current vehicle position and driving state parameters. Specifically:
[0091] x k+1 =vcosθ k ·dt+x k
[0092] y k+1 =vsinθ k ·dt+y t
[0093]
[0094] In the formula,
[0095] x k ,y k are the x and y coordinates of the vehicle at time k; θ is the vehicle heading angle in the vehicle coordinate system; k is the curvature corresponding to the vehicle's driving path point; δ f is the front wheel turning angle; L is the wheelbase;
[0096] On the second aspect, an embodiment of the present application also provides a planning device for an autonomous driving path.
[0097] In one embodiment, referring to Figure 4 , Figure 4 This is a functional module diagram of an embodiment of an automatic driving path planning device of the present application. Figure 4 As shown, the planning device of the automatic driving path includes:
[0098] An acquisition module, configured to acquire a preview time point of the vehicle and a planned path determined in a previous path planning cycle;
[0099] A planning point determination module, configured to determine a path planning point on the planned path after the preview time point;
[0100] A path planning module is configured to obtain a path before the path planning point in the planned path that has not been traveled as a first path; obtain a second path planned with the path planning point as a starting point; and update the planned path based on the first path and the second path.
[0101] Furthermore, in one embodiment, the planning point determination module is further used to:
[0102] Determining the planned position time point according to the preview time point and the set time interval;
[0103] Determine a path planning point on the planned path according to the planned position time point.
[0104] Furthermore, in one embodiment, the path planning module is also used to:
[0105] adjusting the first path according to the distance between the last coordinate point of the first path and the first coordinate point of the second path;
[0106] The first path and the second path are spliced together, and the planned path is updated with the splicing result.
[0107] Furthermore, in one embodiment, the device further includes a risk avoidance module, which is used to:
[0108] Before determining a path planning point on the planned path after the preview time point, performing the following steps:
[0109] Obtaining a risk path in the planned path predicted by a driving risk module;
[0110] Determining whether the time information corresponding to the risk path is before the preview time point;
[0111] If so, taking a point on the planned path between the current position of the vehicle and the risk path as a path planning point;
[0112] If not, executing the step of determining a path planning point on the planned path after the preview time.
[0113] Furthermore, in one embodiment, the risk avoidance module is also used to:
[0114] Acquire safe operation time, and determine the distance between the path planning point and the starting point of the risk path according to the safe operation time;
[0115] The path planning point is determined according to the distance between the path planning point and the starting point of the risk path.
[0116] Furthermore, in one embodiment, the device further includes a determination module, which is configured to:
[0117] Before determining a path planning point on the planned path after the preview time point, performing the following steps:
[0118] According to one or more preset judgment conditions, determining whether the vehicle currently has conditions for traveling along the planned path;
[0119] If it does not exist, determine the position of the vehicle in the next path planning cycle based on the current vehicle position and driving state parameters, and establish a new path that replaces the planned path with the position of the vehicle in the next path planning cycle as the starting point;
[0120] If it exists, execute the subsequent update steps of the planned path.
[0121] Among them, the functional implementation of each module in the above-mentioned autonomous driving path planning device corresponds to the various steps in the above-mentioned autonomous driving path planning method embodiment, and its functions and implementation processes will not be repeated here one by one.
[0122] On the third aspect, an embodiment of the present application provides an autonomous driving path planning device, which may be a personal computer (PC), a laptop computer, a server, or other device with data processing capabilities.
[0123] Reference Figure 5 , Figure 5 The hardware structure diagram of the autonomous driving path planning device involved in the embodiment of the present application is shown in FIG. In the embodiment of the present application, the autonomous driving path planning device may include a processor, a memory, a communication interface, and a communication bus.
[0124] The communication bus may be of any type and is used to interconnect the processor, the memory, and the communication interface.
[0125] The communication interface includes input / output (I / O) interfaces, physical interfaces, and logical interfaces, which are used to interconnect devices within the autonomous driving path planning device, and interfaces used to interconnect the autonomous driving path planning device with 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.
[0126] 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.
[0127] The processor may be a general-purpose processor, which may call the autonomous driving path planning program stored in the memory and execute the autonomous driving path planning method provided in the embodiment of the present application. For example, the general-purpose processor may be a central processing unit (CPU). The method executed when the autonomous driving path planning program is called may refer to the various embodiments of the autonomous driving path planning method of the present application, which will not be described in detail here.
[0128] Those skilled in the art will understand that Figure 5 The hardware structure shown in the figure does not constitute a limitation on the present application, and may include more or less components than shown in the figure, or combine certain components, or arrange the components differently.
[0129] In a fourth aspect, an embodiment of the present application also provides a storage medium.
[0130] The storage medium of the present application stores an autonomous driving path planning program, wherein when the autonomous driving path planning program is executed by a processor, the steps of the autonomous driving path planning method as described above are implemented.
[0131] Among them, the method implemented when the autonomous driving path planning program is executed can refer to the various embodiments of the autonomous driving path planning method of the present application, and will not be repeated here.
[0132] 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.
[0133] 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.
[0134] 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.
[0135] 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.
[0136] 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.
[0137] 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.
[0138] 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 method for planning an automatic driving path, characterized in that: The method comprises: Obtain the preview time point of the vehicle and the planned path determined in the previous path planning cycle; Determining a path planning point on the planned path after the preview time point; Acquire a path before the path planning point in the planned path that has not been traveled as a first path; Acquire a second path planned with the path planning point as a starting point; The planned path is updated according to the first path and the second path.
2. The method for planning an automatic driving path according to claim 1, wherein: Determining a path planning point on the planned path after the preview time point comprises the following steps: Determining the planned position time point according to the preview time point and the set time interval; Determine a path planning point on the planned path according to the planned position time point.
3. The method for planning an automatic driving path according to claim 1, wherein: The updating of the planned path according to the first path and the second path comprises the following steps: adjusting the first path according to the distance between the last coordinate point of the first path and the first coordinate point of the second path; The first path and the second path are spliced together, and the planned path is updated with the splicing result.
4. The method for planning an automatic driving path according to claim 1, wherein: Before determining the path planning point on the planned path after the preview time point, the following steps are included: Obtaining a risk path in the planned path predicted by a driving risk module; Determining whether the time information corresponding to the risk path is before the preview time point; If so, taking a point on the planned path between the current position of the vehicle and the risk path as a path planning point; If not, executing the step of determining a path planning point on the planned path after the preview time.
5. The method for planning an automatic driving path according to claim 4, wherein: The step of taking a point on the planned path between the current position of the vehicle and the risk path as a path planning point comprises the following steps: Acquire safe operation time, and determine the distance between the path planning point and the starting point of the risk path according to the safe operation time; The path planning point is determined according to the distance between the path planning point and the starting point of the risk path.
6. The method for planning an automatic driving path according to claim 1, wherein: Before determining the path planning point on the planned path after the preview time point, the following steps are included: According to one or more preset judgment conditions, determining whether the vehicle currently has conditions for traveling along the planned path; If it does not exist, determine the position of the vehicle in the next path planning cycle based on the current vehicle position and driving state parameters, and establish a new path that replaces the planned path with the position of the vehicle in the next path planning cycle as the starting point; If it exists, execute the subsequent update steps of the planned path.
7. The method for planning an automatic driving path according to claim 6, wherein: The judgment condition includes whether the distance between the current position of the vehicle and the nearest coordinate point of the planned path exceeds a preset first threshold and / or whether the closest lateral distance between the current position of the vehicle and the planned path exceeds a preset second threshold.
8. An automatic driving path planning device, characterized in that: The device comprises: An acquisition module, configured to acquire a preview time point of the vehicle and a planned path determined in a previous path planning cycle; A planning point determination module, configured to determine a path planning point on the planned path after the preview time point; A path planning module is configured to obtain a path before the path planning point in the planned path that has not been traveled as a first path; obtain a second path planned with the path planning point as a starting point; and update the planned path based on the first path and the second path.
9. An automatic driving path planning device, characterized in that: The autonomous driving path planning device includes a processor, a memory, and an autonomous driving path planning program stored in the memory and executable by the processor, wherein when the autonomous driving path planning program is executed by the processor, the steps of the autonomous driving path planning method as described in any one of claims 1 to 7 are implemented.
10. A storage medium, characterized in that: The storage medium stores an autonomous driving path planning program, wherein when the autonomous driving path planning program is executed by a processor, the steps of the autonomous driving path planning method as described in any one of claims 1 to 7 are implemented.
