Path planning method, computer equipment and program product
By obtaining the current position and lane centerline information in real time, judging the driving scene and generating reference lines, the resource consumption and dependence problems of high-precision maps in autonomous driving path planning is solved, and the accuracy and safety of path planning is improved.
Patent Information
- Application Number
- CN202411514805.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-10-28
- Publication Date
- 2024-11-29
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
High-precision maps consume high storage and computing resources in the path planning of autonomous vehicles, have high maintenance costs, and are highly dependent. Inaccurate data or untimely updates may lead to path planning errors and affect driving safety.
By obtaining the current position information of the vehicle and the lane center line information, determine the current reference trajectory, judge the current driving scene based on the reference trajectory and the lane center line, generate matching reference lines to plan the driving path, avoid building high-precision maps, and directly obtain the lane center line in real time information.
Improve the accuracy and security of path planning, reduce the cost of building and maintaining high-precision maps, and reduce the dependence on data accuracy and update frequency.
Smart Images

Figure CN119043366A_ABST
Abstract
Description
Technical Field
[0001] The present disclosure relates to the field of autonomous driving technology, and in particular to a path planning method, a computer device, and a program product. Background Art
[0002] With the development of science and technology, vehicles are becoming more and more intelligent, and are equipped with more and more functions. Among them, vehicle driving functions such as assisted driving and automatic driving have become one of the common functions of vehicles, and the realization of automatic driving functions depends on the planning of driving routes.
[0003] Generally, vehicles can drive autonomously within specific routes or areas that they have learned and are familiar with, that is, they can use the data of specific routes or areas collected during historical driving to build high-precision maps, and plan driving paths for autonomous vehicles based on high-precision maps. However, high-precision maps require more storage and computing resources, and their construction and maintenance costs are high; and high-precision maps are highly dependent. Once the data of high-precision maps is inaccurate or not updated in time, it may cause errors in path planning and affect driving safety. Summary of the invention
[0004] The embodiments of the present disclosure at least provide a path planning method, a computer device, and a program product.
[0005] In a first aspect, an embodiment of the present disclosure provides a path planning method, including: Obtain the vehicle's current position information and the center line of the lane it is currently in; Determining a first reference trajectory at the current moment from the historical driving trajectory of the vehicle according to the position information at the current moment; Determining a current driving scene of the vehicle based on the first reference trajectory; A reference line matching the current driving scene is determined based on the trajectory line of the first reference trajectory and the lane center line, and a driving path planned for the vehicle is generated based on information of the reference line.
[0006] In a possible implementation manner, determining the first reference trajectory at the current moment from the historical driving trajectory of the vehicle according to the position information at the current moment includes: Acquire a second reference trajectory determined at a previous moment; Determine, from the second reference trajectory, a target trajectory point closest to the vehicle position according to the current position information; The first reference trajectory is determined from the historical driving trajectory according to the information of the target trajectory point and a set reference distance or the number of reference trajectory points.
[0007] Here, according to the current position information, the target trajectory point closest to the vehicle position is determined from the second reference trajectory. Compared with the method of determining the target trajectory point from the historical driving trajectory, the index range is smaller and the determination efficiency and accuracy are higher.
[0008] In a possible implementation manner, determining the current driving scene of the vehicle based on the first reference trajectory includes: If it is determined that no lane line is currently detected, or the deviation between the orientation of the target trajectory point and the orientation of the end trajectory point of the first reference trajectory is greater than a first angle threshold, determining whether there is a trajectory point located at a stop line among the trajectory points of the first reference trajectory; If not, it is determined that the current driving scene belongs to an intersection scene.
[0009] Through the above process, it is possible to more accurately determine whether the current driving scene belongs to an intersection scene, so that a driving path can be more accurately planned for the vehicle later.
[0010] In a possible implementation manner, determining the current driving scene of the vehicle based on the first reference trajectory includes: Determine first distances between a plurality of lane points on the lane centerline and a trajectory line of the first reference trajectory respectively; Determining a first number of lane points corresponding to the first distance being greater than a first distance threshold; When the first number is greater than or equal to a first number threshold, it is determined that the current driving scene belongs to a lane change scene.
[0011] In a possible implementation manner, the method further includes: When the first number is less than the first number threshold, determining a target lane area indicated by lane lines on both sides of the vehicle; Determining a second number of trajectory points in the first reference trajectory that are not located in the target lane area; When the second number is greater than a second number threshold, it is determined that the current driving scene belongs to a lane change scene.
[0012] Through the above, it can be more accurately determined whether the current driving scene belongs to a lane change scene, so that the driving path can be more accurately planned for the vehicle later.
[0013] In a possible implementation manner, determining the current driving scene of the vehicle based on the first reference trajectory includes: When it is determined based on the first reference trajectory that the current driving scene of the vehicle does not belong to the intersection scene and the lane change scene, the current driving scene of the vehicle is determined to be a cruising scene.
[0014] The method of determining the cruise scene by the elimination method is relatively simple and efficient.
[0015] In a possible implementation manner, determining a reference line matching the current driving scene according to the trajectory line of the first reference trajectory and the lane center line includes: When the current driving scene is an intersection scene, determining the first reference trajectory as a reference line matching the current driving scene; When the current driving scene is a lane change scene, determining the first reference trajectory as a reference line matching the current driving scene; When the current driving scene is a cruising scene, the lane center line is determined as a reference line matching the current driving scene.
[0016] Through the above process, matching reference lines can be determined for different driving scenarios, so that a driving trajectory matching the current driving scenario can be generated more accurately later.
[0017] In a possible implementation manner, the method further includes: When the current driving scene is a cruising scene and the deviation between the orientation of the target trajectory point corresponding to the vehicle and the orientation of the end trajectory point of the first reference trajectory is greater than a second angle threshold, determining the distance between the vehicle position and the stop line based on the position information of the vehicle; When the distance between the vehicle position and the stop line is less than a second distance threshold, the reference line of the vehicle is switched from the lane center line to the first reference trajectory.
[0018] In a possible implementation manner, the method further includes: When the previous driving scene is an intersection scene and the current driving scene is a cruise scene, determining the position of the vehicle when a lane line is first detected in the current driving scene; Determine a first travel distance between the position of the vehicle at a current moment and the position of the vehicle when the lane line is first detected; When the first driving distance is greater than a third distance threshold, the reference line of the vehicle is switched from the reference trajectory to the lane center line.
[0019] Through the above settings, the accuracy and stability of the reference line can be guaranteed after switching from the intersection scene to the cruise scene.
[0020] In a possible implementation manner, the method further includes: When the previous driving scene is a lane-changing scene and the current driving scene is a cruising scene, determining a starting position of the vehicle when entering the current driving scene; Determining a second travel distance between the vehicle's current position and the starting position; When the second driving distance is greater than a fourth distance threshold, the reference line of the vehicle is switched from the reference trajectory to the lane center line.
[0021] Through the above settings, the continuity and stability of the reference line after switching from the lane changing scene to the cruising scene can be guaranteed.
[0022] In a possible implementation manner, the method further includes: During the process of the vehicle traveling along the driving path, determining whether there is a trajectory point located at a stop line in the first reference trajectory according to the first reference trajectory corresponding to the position of the vehicle at a current moment; If it exists, determine the current color of the traffic light; The vehicle is controlled to travel according to the current color of the traffic light.
[0023] The above process can ensure the safety of the vehicle's automatic driving process.
[0024] In a second aspect, an embodiment of the present disclosure further provides a computer device, comprising: a processor and a memory, wherein the memory stores machine-readable instructions executable by the processor, and when the computer device is running, the machine-readable instructions are executed by the processor to perform the steps of the above-mentioned first aspect, or any possible implementation of the first aspect.
[0025] In a third aspect, an embodiment of the present disclosure further provides a computer program product, including a computer program, which, when executed, implements the method described in the above-mentioned first aspect, or any possible implementation manner of the first aspect.
[0026] The present disclosure provides a path planning method, computer equipment and program product, which obtains the position information of the vehicle at the current moment, and the information of the center line of the lane where it is currently located; and according to the position information at the current moment, determines the first reference trajectory at the current moment from the historical driving trajectory of the vehicle; based on the first reference trajectory, determines the current driving scene of the vehicle; according to the trajectory line of the first reference trajectory and the center line of the lane, more accurately determines the reference line that matches the current driving scene, different driving scenes can correspond to different reference lines, and then according to the information of the reference line, can more accurately generate the driving path planned for the vehicle, so as to more accurately control the driving of the vehicle according to the driving path, and improve the driving safety of the vehicle. This solution is to directly obtain the information of the center line of the lane where the vehicle is currently located in real time, for example, it can be obtained by visual perception, without the need to build a high-precision map, which alleviates the problems caused by building and maintaining a high-precision map.
[0027] In order to make the above-mentioned objectives, features and advantages of the present disclosure more obvious and easy to understand, preferred embodiments are specifically cited below and described in detail with reference to the attached drawings. BRIEF DESCRIPTION OF THE DRAWINGS
[0028] In order to more clearly illustrate the technical solutions of the embodiments of the present disclosure, the following is a brief introduction to the drawings required for use in the embodiments. The drawings herein are incorporated into the specification and constitute a part of the specification. These drawings illustrate embodiments consistent with the present disclosure and are used together with the specification to illustrate the technical solutions of the present disclosure. It should be understood that the following drawings only illustrate certain embodiments of the present disclosure and should not be regarded as limiting the scope. For ordinary technicians in this field, other relevant drawings can also be obtained based on these drawings without creative work.
[0029] Figure 1 A flow chart of a path planning method provided by an embodiment of the present disclosure is shown; Figure 2a A schematic diagram of an intersection scene in a path planning method provided by an embodiment of the present disclosure is shown; Figure 2b A schematic diagram showing an intersection scene in the path planning method provided by an embodiment of the present disclosure Figure 3 A flowchart showing a specific process of determining the current driving scene in the path planning method provided in an embodiment of the present disclosure; Figure 4 A schematic diagram of the architecture of a path planning device provided by an embodiment of the present disclosure is shown; Figure 5 A schematic diagram of the structure of a computer device provided by an embodiment of the present disclosure is shown. DETAILED DESCRIPTION
[0030] In order to make the purpose, technical solutions and advantages of the embodiments of the present disclosure clearer, the technical solutions in the embodiments of the present disclosure will be clearly and completely described below in conjunction with the drawings in the embodiments of the present disclosure. Obviously, the described embodiments are only part of the embodiments of the present disclosure, rather than all the embodiments. The components of the embodiments of the present disclosure generally described and shown in the drawings here can be arranged and designed in various different configurations. Therefore, the following detailed description of the embodiments of the present disclosure provided in the drawings is not intended to limit the scope of the present disclosure claimed for protection, but merely represents selected embodiments of the present disclosure.
[0031] It should be noted that similar reference numerals and letters denote similar items in the following drawings, and therefore, once an item is defined in one drawing, further definition and explanation thereof is not required in subsequent drawings.
[0032] The term "and / or" herein only describes an association relationship, indicating that three relationships may exist. For example, A and / or B may represent the following three situations: A exists alone, A and B exist at the same time, and B exists alone. In addition, the term "at least one" herein represents any combination of at least two of any one or more of a plurality of. For example, including at least one of A, B, and C may represent including any one or more elements selected from the set consisting of A, B, and C.
[0033] Today, vehicles can drive autonomously in specific routes or areas that have been learned and are familiar with. Specifically, data on specific routes or areas collected during the vehicle's historical driving process can be used to build high-precision maps, and the vehicle's driving path can be planned based on the high-precision map, and then the vehicle's autonomous driving can be controlled based on the planned driving path. Studies have found that high-precision maps require more storage and computing resources, and their construction and maintenance costs are high; and high-precision maps are highly dependent. Once the data of high-precision maps is inaccurate or not updated in a timely manner, it may cause errors in path planning and affect driving safety.
[0034] Based on the above research, the present disclosure provides a path planning method, computer equipment and program product, which obtains the position information of the vehicle at the current moment, and the information of the center line of the lane where it is currently located; and according to the position information at the current moment, determines the first reference trajectory at the current moment from the historical driving trajectory of the vehicle; based on the first reference trajectory, determines the current driving scene of the vehicle; according to the trajectory line of the first reference trajectory and the center line of the lane, more accurately determines the reference line that matches the current driving scene, different driving scenes can correspond to different reference lines, and then according to the information of the reference line, can more accurately generate the driving path planned for the vehicle, so as to more accurately control the driving of the vehicle according to the driving path, and improve the driving safety of the vehicle. This solution is to directly obtain the information of the center line of the lane where the vehicle is currently located in real time, for example, it can be obtained by visual perception, without the need to build a high-precision map, which alleviates the problems caused by the construction and maintenance of high-precision maps.
[0035] To facilitate understanding of this embodiment, a path planning method disclosed in the embodiment of the present disclosure is first introduced in detail. The execution subject of the path planning method provided in the embodiment of the present disclosure is generally a computer device with certain computing capabilities, such as a vehicle-mounted device. In some possible implementations, the path planning method can be implemented by a processor calling a computer-readable instruction stored in a memory.
[0036] See also Figure 1 FIG. 1 is a flow chart of a path planning method provided by an embodiment of the present disclosure, wherein the method includes S101 to S104, wherein: S101: Obtaining the vehicle's current position information and the center line information of the lane it is currently in; S102: determining a first reference trajectory at the current moment from the historical driving trajectory of the vehicle according to the position information at the current moment; S103: Determining a current driving scene of the vehicle based on the first reference trajectory; S104: Determine a reference line that matches the current driving scene based on the trajectory line of the first reference trajectory and the lane center line, and generate a driving path planned for the vehicle based on information of the reference line.
[0037] S101 to S104 are described in detail below.
[0038] For S101 and S102: For example, the driver can first control the vehicle to drive on a preset route according to the driving rules, record the vehicle's driving trajectory, and form the vehicle's historical driving trajectory. The subsequent vehicle can achieve automatic driving on the preset route based on the historical driving trajectory. The historical driving trajectory includes multiple historical trajectory points, each of which corresponds to position information and identification information for identifying whether the historical trajectory point belongs to a stop line. The stop line is a lane line on the road where the vehicle needs to stop, such as the stop line including the lane line at the end of the lane before the intersection.
[0039] During the automatic driving process of the vehicle, the position information of the vehicle at the current moment is obtained. For example, the position information of the vehicle can be determined based on the positioning device installed on the vehicle. The position information can be the coordinate position in the constructed global coordinate system. The global coordinate system can be a coordinate system constructed with a specific position of the real scene as the origin.
[0040] It is also possible to obtain information about the center line of the lane in which the vehicle is currently located, where the information about the center line of the lane can be determined in real time by the vehicle's perception module using visual perception. For example, the perception module can collect the current scene image and use a neural network algorithm to detect the current scene image to determine the information about the center line of the lane in which the vehicle is currently located.
[0041] Then, the first reference trajectory at the current moment can be determined from the historical driving trajectory of the vehicle based on the current position information. For example, the distance between the current vehicle position and each historical trajectory point in the historical driving trajectory can be calculated, and the historical trajectory point with the closest distance can be selected as the matching point; the first reference trajectory can be determined from the historical driving trajectory based on the matching point and the set search range. For example, if the search range is set to 50 trajectory points forward and 20 trajectory points backward, then based on the matching point, 50 historical trajectory points are selected according to the driving direction and 20 historical trajectory points are selected in the opposite direction of the driving direction to obtain the first reference trajectory, that is, the first reference trajectory is composed of 71 determined historical trajectory points.
[0042] In an optional implementation manner, determining the first reference trajectory at the current moment from the historical driving trajectory of the vehicle according to the position information at the current moment includes: Step a1, obtaining a second reference trajectory determined at a previous moment; Step a2, determining the target track point closest to the vehicle position from the second reference track according to the current position information; Step a3: determining the first reference trajectory from the historical driving trajectory according to the information of the target trajectory point and the set reference distance or the number of reference trajectory points.
[0043] Since the second reference trajectory is a partial trajectory in the historical driving trajectory and the vehicle driving is continuous, the second reference trajectory at the previous moment can cover the position information at the current moment. Therefore, in order to improve the efficiency of determining the first reference trajectory, the second reference trajectory at the previous moment can be used to determine the first reference trajectory at the current moment.
[0044] Specifically, the distance between the vehicle position at the current moment and each historical trajectory point in the second reference trajectory can be calculated based on the position information at the current moment, and the historical trajectory point with the closest distance can be selected as the target trajectory point; then, based on the information of the target trajectory point and the set reference distance or number of reference trajectory points, the first reference trajectory can be determined from the historical driving trajectory. For example, if the set reference distance is 5 meters, the farthest trajectory point with a distance of 5 meters from the target trajectory point can be determined, and the trajectory between the target trajectory point and the farthest trajectory point in the historical driving trajectory can be determined as the first reference trajectory. Alternatively, if the number of reference trajectory points is set to 50, then 50 trajectory points can be selected from the historical driving trajectory according to the driving direction based on the target trajectory point, and the trajectory formed by the selected trajectory points can be determined as the first reference trajectory.
[0045] Here, according to the current position information, the target trajectory point closest to the vehicle position is determined from the second reference trajectory. Compared with the method of determining the target trajectory point from the historical driving trajectory, the index range is smaller and the determination efficiency and accuracy are higher.
[0046] For S103: After determining the first reference trajectory at the current moment, the current driving scene can also be determined based on the first reference trajectory, so as to determine the corresponding reference line for the current driving scene. For example, if the first reference trajectory is a trajectory line parallel to the center line of the lane, the current driving scene of the vehicle is a cruising scene. For another example, if the orientation of the end point of the trajectory in the first reference trajectory is significantly different from the orientation of the beginning point, the current driving scene of the vehicle is determined to be an intersection scene, etc.
[0047] The following describes the process of determining the intersection scene.
[0048] In an optional implementation, determining the current driving scene of the vehicle based on the first reference trajectory includes: if it is determined that no lane line is currently detected, or the deviation between the orientation of the target trajectory point and the orientation of the end trajectory point of the first reference trajectory is greater than a first angle threshold, determining whether there is a trajectory point located on the stop line among the trajectory points of the first reference trajectory; if not, determining that the current driving scene belongs to an intersection scene.
[0049] The vehicle's perception module can detect the lane lines of the lane in which the vehicle is located in real time. If the perception module does not currently detect the lane lines, the vehicle may be in an intersection scene and needs further judgment, that is, to determine whether there is a trajectory point located on the stop line among the trajectory points of the first reference trajectory. If not, it is determined that the current driving scene belongs to an intersection scene; if there is a trajectory point on the stop line, it is determined that it does not belong to an intersection scene.
[0050] Alternatively, the deviation between the direction of the target trajectory point and the direction of the end trajectory point of the first reference trajectory can also be determined. If the deviation is greater than the first angle threshold, the vehicle may be in an intersection scene, and further judgment is required, that is, to determine whether there is a trajectory point located at the stop line among the trajectory points of the first reference trajectory. If not, it is determined that the current driving scene belongs to an intersection scene; if there is a trajectory point at the stop line, it is determined that it does not belong to an intersection scene. The first angle threshold can be set as needed, for example, the angle threshold can be 45 degrees, 60 degrees, etc.
[0051] See also Figure 2a The local scene diagram of the intersection scene shown in the figure shows that the deviation between the direction of the target track point of the first reference track shown in the figure and the direction of the end track point is large, but because there is a track point located at the stop line among the track points of the first reference track, the vehicle has not entered the intersection scene at this time. Figure 2b As shown, the deviation between the direction of the target trajectory point of the first reference trajectory shown in the figure and the direction of the end trajectory point is large, and there is no trajectory point located at the stop line among the trajectory points of the first reference trajectory, so the driving scene of the vehicle at this time is an intersection scene.
[0052] Through the above process, it is possible to more accurately determine whether the current driving scene belongs to an intersection scene, so that a driving path can be more accurately planned for the vehicle later.
[0053] The following describes the process of determining the lane change scenario.
[0054] In an optional implementation manner, determining the current driving scene of the vehicle based on the first reference trajectory includes: Step b1, determining first distances between a plurality of lane points on the lane centerline and the trajectory line of the first reference trajectory respectively; Step b2, determining a first number of lane points corresponding to the first distance being greater than a first distance threshold; Step b3: When the first number is greater than or equal to a first number threshold, determine that the current driving scene belongs to a lane change scene.
[0055] The lane centerline includes position information of a plurality of lane points. For each lane point on the lane centerline, a first distance between the lane point and a track line of the first reference track is determined, and the distance may be a lateral distance, where the lateral distance refers to a direction perpendicular to the driving direction on the driving road surface.
[0056] A first number of lane points whose corresponding first distance is greater than a first distance threshold is determined, wherein the first distance threshold can be determined according to the width of the lane in the driving scene. When the first number is greater than or equal to the first number threshold, it indicates that most of the trajectory points on the first reference trajectory are far from the center line of the lane, so it is determined that the current driving scene belongs to a lane change scene.
[0057] Optionally, the method further includes: Step b4: when the first number is less than the first number threshold, determining a target lane area indicated by lane lines on both sides of the vehicle; Step b5, determining a second number of trajectory points in the first reference trajectory that are not located in the target lane area; Step b6: When the second number is greater than a second number threshold, determine that the current driving scene belongs to a lane change scene.
[0058] When the first number is less than the first number threshold, further judgment is performed. Specifically, information about the lane line detected by the perception module is obtained, and the lane line may be a lane line within a certain range (such as within 50 meters, 100 meters, etc.) from the vehicle. When the first number is less than the first number threshold, the target lane area indicated by the lane lines on both sides of the vehicle is determined, that is, the target lane area within a certain range from the vehicle.
[0059] Determine the second number of trajectory points in the first reference trajectory that are not located in the target lane area; if the second number is greater than the second number threshold, it means that most of the trajectory points in the first reference trajectory are not located in the target lane area ahead of the vehicle, so it is determined that the current driving scene belongs to a lane change scene. Conversely, if the second number is less than or equal to the second number threshold, it is determined that the current driving scene does not belong to a lane change scene. The first number threshold and the second number threshold can be set according to actual needs, and are not specifically limited in this disclosure.
[0060] Through the above, it can be more accurately determined whether the current driving scene belongs to a lane change scene, so that the driving path can be more accurately planned for the vehicle later.
[0061] In an optional implementation, determining the current driving scene of the vehicle based on the first reference trajectory includes: when it is determined based on the first reference trajectory that the current driving scene of the vehicle does not belong to an intersection scene and a lane change scene, determining that the current driving scene of the vehicle is a cruising scene.
[0062] Considering that the vehicle's driving scenarios generally include intersection scenarios, lane change scenarios and cruising scenarios, when it is determined according to the first reference trajectory that the vehicle's current driving scenario does not belong to an intersection scenario or a lane change scenario, it can be determined that the vehicle's current driving scenario is a cruising scenario.
[0063] The method of determining the cruise scene by the elimination method is relatively simple and efficient.
[0064] See also Figure 3 As shown, the specific process of determining the current driving scene is exemplarily described. Specifically, the following steps may be included: S31: Determine whether a lane line is not currently detected, or determine whether a deviation between a direction of the target trajectory point and a direction of an end trajectory point of the first reference trajectory is greater than a first angle threshold.
[0065] If yes, then go to step S32. If no, then go to step S33.
[0066] S32: Determine whether there is a trajectory point located at the stop line among the trajectory points of the first reference trajectory.
[0067] If yes, it is determined that the current driving scene does not belong to the intersection scene. If no, it is determined that the current driving scene belongs to the intersection scene.
[0068] S33. Determine first distances between a plurality of lane points on the lane centerline and the trajectory line of the first reference trajectory, and determine a first number of lane points whose corresponding first distances are greater than a first distance threshold; and determine whether the first number is greater than or equal to a first number threshold.
[0069] If yes, it is determined that the current driving scene belongs to a lane-changing scene. If no, S34 is executed.
[0070] S34. Determine a target lane area indicated by lane lines on both sides of the vehicle, and determine a second number of trajectory points in the first reference trajectory that are not located in the target lane area; and determine whether the second number is greater than a second number threshold.
[0071] If yes, it is determined that the current driving scene belongs to the lane changing scene. If no, it means that the current driving scene does not belong to the lane changing scene and the intersection scene, so in this case it is determined that the current driving scene belongs to the cruising scene.
[0072] For S104: After determining the current driving scene, the reference line that matches the current driving scene can be determined based on the track line of the first reference track and the center line of the lane, so that the driving path planned for the vehicle can be generated based on the information of the reference line, and the driving path is consistent with the current driving scene and is more accurate. For example, if the current driving scene is a cruising scene, the track line of the first reference track and the center line of the lane can be weighted summed, and the line obtained by the weighted summation can be determined as the reference line of the cruising scene.
[0073] Optionally, determining a reference line matching the current driving scene according to the trajectory line of the first reference trajectory and the lane center line includes: Case 1: when the current driving scene is an intersection scene, the first reference trajectory is determined as a reference line matching the current driving scene.
[0074] Case 2: when the current driving scene is a lane change scene, the first reference trajectory is determined as a reference line matching the current driving scene.
[0075] Case 3: when the current driving scene is a cruising scene, the lane center line is determined as a reference line that matches the current driving scene.
[0076] When the current driving scene is an intersection scene, there may be no lane lines in this scene or the accuracy of the collected lane lines is low, so the first reference trajectory can be determined as a reference line matching the intersection scene.
[0077] When the current driving scene is a lane-changing scene, there are center lines of different lanes in this scene. At this time, the center line of the lane cannot guide the vehicle to drive well, so the first reference trajectory can be determined as a reference line matching the lane-changing scene.
[0078] When the current driving scene is a cruising scene, since the first reference trajectory is the historical driving trajectory of the vehicle, the first reference trajectory may deviate from the lane center even when traveling straight. In order to alleviate the above problem, the lane center line can be determined as a reference line matching the cruising scene so that subsequent vehicles can travel along the lane center line, thereby improving the accuracy of vehicle driving.
[0079] Through the above process, matching reference lines can be determined for different driving scenarios, so that a driving trajectory matching the current driving scenario can be generated more accurately later.
[0080] After determining the reference line that matches the current driving scene, the information of the reference line can also be sent to the path planning module. The path planning module generates a driving trajectory based on the reference line information and the perception information transmitted by the perception module, such as information about surrounding obstacles and road information.
[0081] In an optional implementation manner, the method further includes: Step c1, while the vehicle is traveling along the driving path, determining whether there is a trajectory point located at a stop line in the first reference trajectory according to the first reference trajectory corresponding to the position of the vehicle at a current moment; Step c2: if it exists, determine the current color of the traffic light; Step c3: Control the vehicle to travel according to the current color of the traffic light.
[0082] When the vehicle is traveling along the driving path, each track point in the first reference track corresponding to the current position of the vehicle can be traversed to determine whether there is a track point located at the stop line in the first reference track. If not, the vehicle is driven normally along the driving track.
[0083] If there is a trajectory point located at the stop line in the first reference trajectory, the traffic light module can be called to control the traffic light module to collect the scene image corresponding to the traffic light, and detect the scene image to determine the current color of the traffic light. Alternatively, the current color of the traffic light can be obtained from the traffic light server, where the traffic light server can store the color information of each traffic light in real time. Alternatively, the current color of the traffic light can be obtained from the cloud big data, where the cloud big data can include the color information of the traffic light detected in real time by other vehicles, smart devices, etc.; or, the cloud can infer the color of the traffic light based on the driving status of the vehicle at the traffic intersection.
[0084] The vehicle is controlled to move according to the current color of the traffic light. For example, if the vehicle is close to the traffic light and the current color of the traffic light is red, the vehicle can be controlled to stop moving, or the vehicle can be controlled to slow down until it stops in front of the stop line.
[0085] The above process can ensure the safety of the vehicle's automatic driving process.
[0086] The driving scenarios determined in the present disclosure include lane change scenarios, cruising scenarios and intersection scenarios. There are scene switching situations during the driving process of the vehicle. In order to more accurately determine the reference line, the corresponding reference line switching logic can be set when the scene switches.
[0087] The following describes the switching process of the reference line when the cruise scene switches to the intersection scene.
[0088] In an optional implementation manner, the method further includes: Step d1, when the current driving scene is a cruising scene and the deviation between the orientation of the target trajectory point corresponding to the vehicle and the orientation of the end trajectory point of the first reference trajectory is greater than a second angle threshold, determining the distance between the vehicle position and the stop line based on the position information of the vehicle; Step d2: When the distance between the vehicle position and the stop line is less than a second distance threshold, switching the reference line of the vehicle from the lane center line to the first reference trajectory.
[0089] Considering that the reference line used in the cruising scene is the lane centerline, and the reference line used in the intersection scene is the first reference trajectory, if the reference line is switched again after switching from the cruising scene to the intersection scene, it may cause a sudden change in the reference line, affecting the vehicle driving. Therefore, when the vehicle switches from the cruising scene to the intersection scene, the reference line can be switched from the lane centerline to the first reference trajectory in advance.
[0090] In specific implementation, when the current driving scene is a cruising scene, determine whether the deviation between the direction of the target trajectory point corresponding to the vehicle and the direction of the end trajectory point of the first reference trajectory is greater than the second angle threshold. If so, it indicates that the vehicle is traveling in front of an intersection scene, and there is a switch from the cruising scene to the intersection scene. Then, based on the vehicle's position information, the distance between the vehicle position and the stop line can be determined. When the distance between the vehicle position and the stop line is less than the second distance threshold, the vehicle has not yet switched to the intersection scene and is close to the intersection, so the vehicle's reference line can be switched from the lane centerline to the first reference trajectory in advance to achieve smooth switching of the reference line and ensure the stability of the reference line. The second distance threshold can be set as needed.
[0091] The following describes the switching process of the reference line when the intersection scene is switched to the cruise scene.
[0092] In an optional implementation manner, the method further includes: Step e1, when the previous driving scene is an intersection scene and the current driving scene is a cruise scene, determining the position of the vehicle when a lane line is first detected in the current driving scene; Step e2, determining a first travel distance between the current position of the vehicle and the position of the vehicle when the lane line is first detected; Step e3: When the first driving distance is greater than a third distance threshold, the reference line of the vehicle is switched from the reference trajectory to the lane center line.
[0093] The study found that after switching from the intersection scene to the cruise scene, the lane line information perceived by the perception module when just entering the cruise scene is bent, that is, the lane line perception result is inaccurate. In order to alleviate the above problem, the reference line is switched delayed after switching from the intersection scene to the cruise scene to ensure the accuracy of the reference line of the cruise scene.
[0094] When the previous driving scene is an intersection scene and the current driving scene is a cruise scene, determine the position of the vehicle when the lane line is first detected in the current driving scene. The position where the lane line is first detected is the starting position of the vehicle when it enters the cruise scene from the intersection scene.
[0095] During implementation, if in two adjacent moments, the driving scene at the previous moment is an intersection scene, and the driving scene at the next moment is a cruising scene, it means that there is a switch between the driving scenes at the two moments, and the vehicle position at the next moment is determined to be the starting position of the vehicle when it enters the cruising scene from the intersection scene.
[0096] According to the current position information and the position information of the vehicle when the lane line is first detected, the first driving distance between the current position of the vehicle and the position of the vehicle when the lane line is first detected is determined. When the first driving distance is greater than the third distance threshold, it indicates that the vehicle has traveled a certain distance in the cruising scenario, and the perception result of the lane line is relatively accurate at this time, so the reference line of the vehicle can be switched from the reference trajectory to the center line of the lane. The third distance threshold can be determined based on prior knowledge.
[0097] Through the above settings, the accuracy and stability of the reference line can be guaranteed after switching from the intersection scene to the cruise scene.
[0098] The following describes the switching process of the reference line when the lane change scene is switched to the cruise scene.
[0099] In an optional implementation manner, the method further includes: Step f1, when the previous driving scene is a lane-changing scene and the current driving scene is a cruising scene, determining the starting position of the vehicle when entering the current driving scene; Step f2, determining a second travel distance between the current position of the vehicle and the starting position; Step f3: When the second driving distance is greater than a fourth distance threshold, the reference line of the vehicle is switched from the reference trajectory to the lane center line.
[0100] Research has found that after switching from a lane-changing scenario to a cruising scenario, the vehicle may not be in the middle of the lane when it first enters the cruising scenario. If the reference line is immediately switched from the first reference trajectory to the center line of the lane, it will cause a sudden change in the reference line, making it unstable. To alleviate the above problem, the reference line can be switched later after switching from a lane-changing scenario to a cruising scenario to ensure the stability of the reference line.
[0101] During implementation, when the previous driving scene is a lane-changing scene and the current driving scene is a cruising scene, the starting position of the vehicle when entering the current driving scene is determined. For example, if in two adjacent moments, the driving scene at the previous moment is a lane-changing scene and the driving scene at the next moment is a cruising scene, it means that the driving scenes at the two moments are switched, and the vehicle position at the next moment is determined to be the starting position of the vehicle when entering the current driving scene.
[0102] According to the current position information and the position information of the starting position, a second driving distance between the vehicle's current position and the starting position is determined. When the second driving distance is greater than a fourth distance threshold, it indicates that the vehicle has traveled a certain distance in the cruising scenario, and at this time, the reference line of the vehicle can be switched from the reference trajectory to the lane centerline. The fourth distance threshold can be set as needed.
[0103] Through the above settings, the continuity and stability of the reference line after switching from the lane changing scene to the cruising scene can be guaranteed.
[0104] Those skilled in the art will appreciate that, in the above method of specific implementation, the order in which the steps are written does not imply a strict execution order and does not constitute any limitation on the implementation process. The specific execution order of the steps should be determined by their functions and possible internal logic.
[0105] Based on the same inventive concept, a path planning device corresponding to the path planning method is also provided in the embodiment of the present disclosure. Since the principle of solving the problem by the device in the embodiment of the present disclosure is similar to the above-mentioned path planning method in the embodiment of the present disclosure, the implementation of the device can refer to the implementation of the method, and the repeated parts will not be repeated.
[0106] Reference Figure 4, which is a schematic diagram of the architecture of a path planning device provided by an embodiment of the present disclosure, the device includes: an acquisition module 401, a first determination module 402, a second determination module 403, and a generation module 404; wherein, The acquisition module 401 is used to acquire the vehicle's current position information and the information of the lane centerline at which the vehicle is currently located; A first determining module 402, configured to determine a first reference trajectory at the current moment from the historical driving trajectory of the vehicle according to the position information at the current moment; A second determination module 403, configured to determine a current driving scene of the vehicle based on the first reference trajectory; The generation module 404 is used to determine a reference line matching the current driving scene according to the trajectory line of the first reference trajectory and the lane center line, and generate a driving path planned for the vehicle according to information of the reference line.
[0107] In a possible implementation manner, when the first determination module 402 determines the first reference trajectory at the current moment from the historical driving trajectory of the vehicle according to the position information at the current moment, it is configured to: Acquire a second reference trajectory determined at a previous moment; determine a target trajectory point closest to the vehicle position from the second reference trajectory based on the position information at the current moment; determine the first reference trajectory from the historical driving trajectory based on the information of the target trajectory point and a set reference distance or number of reference trajectory points.
[0108] In a possible implementation manner, the second determination module 403, when determining the current driving scene of the vehicle based on the first reference trajectory, is configured to: If it is determined that no lane line is currently detected, or the deviation between the orientation of the target trajectory point and the orientation of the end trajectory point of the first reference trajectory is greater than a first angle threshold, it is determined whether there is a trajectory point located on the stop line among the trajectory points of the first reference trajectory; if not, it is determined that the current driving scene belongs to an intersection scene.
[0109] In a possible implementation manner, the second determination module 403, when determining the current driving scene of the vehicle based on the first reference trajectory, is configured to: Determine first distances between a plurality of lane points on the lane centerline and the trajectory line of the first reference trajectory; determine a first number of lane points corresponding to the first distance being greater than a first distance threshold; and when the first number is greater than or equal to a first number threshold, determine that the current driving scene belongs to a lane change scene.
[0110] In a possible implementation manner, the second determining module 403 is further configured to: When the first number is less than the first number threshold, determine the target lane area indicated by the lane lines on both sides of the vehicle; determine the second number of trajectory points in the first reference trajectory that are not located in the target lane area; when the second number is greater than the second number threshold, determine that the current driving scene belongs to a lane change scene.
[0111] In a possible implementation, the second determination module 403, when determining the current driving scene of the vehicle based on the first reference trajectory, is used to: when it is determined based on the first reference trajectory that the current driving scene of the vehicle does not belong to an intersection scene and a lane change scene, determine that the current driving scene of the vehicle is a cruising scene.
[0112] In a possible implementation manner, the generating module 404, when determining the reference line matching the current driving scene according to the trajectory line of the first reference trajectory and the lane center line, is configured to: When the current driving scene is an intersection scene, determining the first reference trajectory as a reference line matching the current driving scene; When the current driving scene is a lane change scene, determining the first reference trajectory as a reference line matching the current driving scene; When the current driving scene is a cruising scene, the lane center line is determined as a reference line matching the current driving scene.
[0113] In a possible implementation manner, the device further includes: a switching module 405, configured to: When the current driving scene is a cruising scene and the deviation between the orientation of the target trajectory point corresponding to the vehicle and the orientation of the end trajectory point of the first reference trajectory is greater than a second angle threshold, the distance between the vehicle position and the stop line is determined based on the vehicle's position information; when the distance between the vehicle position and the stop line is less than the second distance threshold, the reference line of the vehicle is switched from the lane center line to the first reference trajectory.
[0114] In a possible implementation, the switching module 405 is further used to: when the previous driving scene is an intersection scene and the current driving scene is a cruising scene, determine the position of the vehicle when the lane line is first detected in the current driving scene; determine a first driving distance between the position of the vehicle at a current moment and the position of the vehicle when the lane line is first detected; when the first driving distance is greater than a third distance threshold, switch the reference line of the vehicle from the reference trajectory to the lane center line.
[0115] In a possible implementation, the switching module 405 is further used to: when the previous driving scene is a lane change scene and the current driving scene is a cruising scene, determine the starting position of the vehicle when entering the current driving scene; determine a second driving distance between the position of the vehicle at a current moment and the starting position; when the second driving distance is greater than a fourth distance threshold, switch the reference line of the vehicle from the reference trajectory to the lane center line.
[0116] In a possible implementation manner, the device further includes: a control module 406, configured to: When the vehicle is traveling along the driving path, it is determined whether there is a trajectory point located at a stop line in the first reference trajectory according to the first reference trajectory corresponding to the position of the vehicle at a current moment; if so, the current color of the traffic light is determined; and the vehicle is controlled to travel according to the current color of the traffic light.
[0117] For descriptions of the processing flow of each module in the device and the interaction flow between each module, reference may be made to the relevant descriptions in the above method embodiment, which will not be described in detail here.
[0118] Based on the same technical concept, the embodiment of the present disclosure also provides a computer device. Figure 5 As shown, it is a schematic diagram of the structure of a computer device 500 provided in an embodiment of the present disclosure, including a processor 501, a memory 502, and a bus 503. Among them, the memory 502 is used to store execution instructions, including a memory 5021 and an external memory 5022; the memory 5021 here is also called an internal memory, which is used to temporarily store the operation data in the processor 501, and the data exchanged with the external memory 5022 such as a hard disk. The processor 501 exchanges data with the external memory 5022 through the memory 5021. When the computer device 500 is running, the processor 501 communicates with the memory 502 through the bus 503, so that the processor 501 executes the following instructions: Obtain the vehicle's current position information and the center line of the lane it is currently in; Determining a first reference trajectory at the current moment from the historical driving trajectory of the vehicle according to the position information at the current moment; Determining a current driving scene of the vehicle based on the first reference trajectory; A reference line matching the current driving scene is determined based on the trajectory line of the first reference trajectory and the lane center line, and a driving path planned for the vehicle is generated based on information of the reference line.
[0119] In a possible implementation manner, in the instruction of the processor 501, determining the first reference trajectory at the current moment from the historical driving trajectory of the vehicle according to the position information at the current moment includes: Acquire a second reference trajectory determined at a previous moment; determine a target trajectory point closest to the vehicle position from the second reference trajectory based on the position information at the current moment; determine the first reference trajectory from the historical driving trajectory based on the information of the target trajectory point and a set reference distance or number of reference trajectory points.
[0120] In a possible implementation manner, in the instruction of the processor 501, determining the current driving scene of the vehicle based on the first reference trajectory includes: If it is determined that no lane line is currently detected, or the deviation between the orientation of the target trajectory point and the orientation of the end trajectory point of the first reference trajectory is greater than a first angle threshold, it is determined whether there is a trajectory point located on the stop line among the trajectory points of the first reference trajectory; if not, it is determined that the current driving scene belongs to an intersection scene.
[0121] In a possible implementation manner, in the instruction of the processor 501, determining the current driving scene of the vehicle based on the first reference trajectory includes: Determine first distances between a plurality of lane points on the lane centerline and the trajectory line of the first reference trajectory; determine a first number of lane points corresponding to the first distance being greater than a first distance threshold; and when the first number is greater than or equal to a first number threshold, determine that the current driving scene belongs to a lane change scene.
[0122] In a possible implementation manner, the instruction of the processor 501 further includes: When the first number is less than the first number threshold, determine the target lane area indicated by the lane lines on both sides of the vehicle; determine the second number of trajectory points in the first reference trajectory that are not located in the target lane area; when the second number is greater than the second number threshold, determine that the current driving scene belongs to a lane change scene.
[0123] In a possible implementation, in the instructions of the processor 501, determining the current driving scene of the vehicle based on the first reference trajectory includes: when it is determined that the current driving scene of the vehicle does not belong to an intersection scene and a lane change scene based on the first reference trajectory, determining that the current driving scene of the vehicle is a cruising scene.
[0124] In a possible implementation manner, in the instruction of the processor 501, determining the reference line matching the current driving scene according to the trajectory line of the first reference trajectory and the lane center line includes: When the current driving scene is an intersection scene, determining the first reference trajectory as a reference line matching the current driving scene; When the current driving scene is a lane change scene, determining the first reference trajectory as a reference line matching the current driving scene; When the current driving scene is a cruising scene, the lane center line is determined as a reference line matching the current driving scene.
[0125] In a possible implementation manner, the instruction of the processor 501 further includes: When the current driving scene is a cruising scene and the deviation between the orientation of the target trajectory point corresponding to the vehicle and the orientation of the end trajectory point of the first reference trajectory is greater than a second angle threshold, the distance between the vehicle position and the stop line is determined based on the vehicle's position information; when the distance between the vehicle position and the stop line is less than the second distance threshold, the reference line of the vehicle is switched from the lane center line to the first reference trajectory.
[0126] In a possible implementation manner, the instruction of the processor 501 further includes: When the previous driving scene is an intersection scene and the current driving scene is a cruising scene, determine the position of the vehicle when the lane line is first detected in the current driving scene; determine a first driving distance between the position of the vehicle at a current moment and the position of the vehicle when the lane line is first detected; when the first driving distance is greater than a third distance threshold, switch the reference line of the vehicle from the reference trajectory to the lane center line.
[0127] In a possible implementation manner, the instruction of the processor 501 further includes: When the previous driving scene is a lane-changing scene and the current driving scene is a cruising scene, determining the starting position of the vehicle when entering the current driving scene; determining a second driving distance between the position of the vehicle at a current moment and the starting position; and when the second driving distance is greater than a fourth distance threshold, switching the reference line of the vehicle from a reference trajectory to a lane centerline.
[0128] In a possible implementation manner, the instruction of the processor 501 further includes: When the vehicle is traveling along the driving path, it is determined whether there is a trajectory point located at a stop line in the first reference trajectory according to the first reference trajectory corresponding to the position of the vehicle at a current moment; if so, the current color of the traffic light is determined; and the vehicle is controlled to travel according to the current color of the traffic light.
[0129] The embodiments of the present disclosure also provide a computer program product, which carries a program code. The instructions included in the program code can be used to execute the steps of the path planning method described in the above method embodiment. For details, please refer to the above method embodiment, which will not be repeated here.
[0130] The computer program product may be implemented in hardware, software or a combination thereof. In one optional embodiment, the computer program product is implemented as a computer program product. In another optional embodiment, the computer program product is implemented as a software product, such as a software development kit (SDK).
[0131] Those skilled in the art can clearly understand that, for the convenience and simplicity of description, the specific working process of the system and device described above can refer to the corresponding process in the aforementioned method embodiment, and will not be repeated here. In the several embodiments provided in the present disclosure, it should be understood that the disclosed system, device and method can be implemented in other ways. The device embodiments described above are merely schematic. For example, the division of the units is only a logical function division. There may be other division methods in actual implementation. For example, multiple units or components can be combined or integrated into another system, or some features can be ignored or not executed. Another point is that the mutual coupling or direct coupling or communication connection shown or discussed can be through some communication interfaces, and the indirect coupling or communication connection of the device or unit can be electrical, mechanical or other forms.
[0132] The units described as separate components may or may not be physically separated, and the components shown as units may or may not be physical units, that is, they may be located in one place or distributed on multiple network units. Some or all of the units may be selected according to actual needs to achieve the purpose of the solution of this embodiment.
[0133] In addition, each functional unit in each embodiment of the present disclosure may be integrated into one processing unit, or each unit may exist physically separately, or two or more units may be integrated into one unit.
[0134] If the functions are implemented in the form of software functional units and sold or used as independent products, they can be stored in a non-volatile computer-readable program product that can be executed by a processor. Based on this understanding, the technical solution of the present disclosure, or the part that contributes to the prior art or the part of the technical solution, can be embodied in the form of a software product. The computer software product is stored in a program product, including several instructions for enabling a computer device (which can be a personal computer, a server, or a network device, etc.) to execute all or part of the steps of the method described in each embodiment of the present disclosure. The aforementioned program products include: various media that can store program codes, such as USB flash drives, mobile hard disks, read-only memories (ROM), random access memories (RAM), magnetic disks or optical disks.
[0135] Finally, it should be noted that the above-described embodiments are only specific implementation methods of the present disclosure, which are used to illustrate the technical solutions of the present disclosure, rather than to limit them. The protection scope of the present disclosure is not limited thereto. Although the present disclosure is described in detail with reference to the above-described embodiments, ordinary technicians in the field should understand that any technician familiar with the technical field can still modify the technical solutions recorded in the above-described embodiments within the technical scope disclosed in the present disclosure, or can easily think of changes, or make equivalent replacements for some of the technical features therein; and these modifications, changes or replacements do not make the essence of the corresponding technical solutions deviate from the spirit and scope of the technical solutions of the embodiments of the present disclosure, and should be included in the protection scope of the present disclosure. Therefore, the protection scope of the present disclosure should be based on the protection scope of the claims.
Claims
1. A path planning method, characterized in that: include: Obtain the vehicle's current position information and the center line of the lane it is currently in; Determining a first reference trajectory at the current moment from the historical driving trajectory of the vehicle according to the position information at the current moment; Determining a current driving scene of the vehicle based on the first reference trajectory; A reference line matching the current driving scene is determined based on the trajectory line of the first reference trajectory and the lane center line, and a driving path planned for the vehicle is generated based on information of the reference line.
2. The method according to claim 1, characterized in that The step of determining the first reference track at the current moment from the historical driving track of the vehicle according to the position information at the current moment includes: Acquire a second reference trajectory determined at a previous moment; Determine, from the second reference trajectory, a target trajectory point closest to the vehicle position according to the current position information; The first reference trajectory is determined from the historical driving trajectory according to the information of the target trajectory point and a set reference distance or the number of reference trajectory points.
3. The method according to claim 1, characterized in that The determining, based on the first reference trajectory, a current driving scene of the vehicle includes: If it is determined that no lane line is currently detected, or the deviation between the orientation of the target trajectory point and the orientation of the end trajectory point of the first reference trajectory is greater than a first angle threshold, determining whether there is a trajectory point located at a stop line among the trajectory points of the first reference trajectory; If not, it is determined that the current driving scene belongs to an intersection scene.
4. The method according to claim 1, characterized in that: The determining, based on the first reference trajectory, a current driving scene of the vehicle includes: Determine first distances between a plurality of lane points on the lane centerline and a trajectory line of the first reference trajectory respectively; Determining a first number of lane points corresponding to the first distance being greater than a first distance threshold; When the first number is greater than or equal to a first number threshold, it is determined that the current driving scene belongs to a lane change scene.
5. The method according to claim 4, characterized in that The method further comprises: When the first number is less than the first number threshold, determining a target lane area indicated by lane lines on both sides of the vehicle; Determining a second number of trajectory points in the first reference trajectory that are not located in the target lane area; When the second number is greater than a second number threshold, it is determined that the current driving scene belongs to a lane change scene.
6. The method according to claim 1, characterized in that The determining, based on the first reference trajectory, a current driving scene of the vehicle includes: When it is determined based on the first reference trajectory that the current driving scene of the vehicle does not belong to the intersection scene and the lane change scene, the current driving scene of the vehicle is determined to be a cruising scene.
7. The method according to claim 1, characterized in that The step of determining a reference line matching the current driving scene according to the trajectory line of the first reference trajectory and the lane center line includes: When the current driving scene is an intersection scene, determining the first reference trajectory as a reference line matching the current driving scene; When the current driving scene is a lane change scene, determining the first reference trajectory as a reference line matching the current driving scene; When the current driving scene is a cruising scene, the lane center line is determined as a reference line matching the current driving scene.
8. The method according to any one of claims 1 to 7, characterized in that: The method further comprises: When the current driving scene is a cruising scene and the deviation between the orientation of the target trajectory point corresponding to the vehicle and the orientation of the end trajectory point of the first reference trajectory is greater than a second angle threshold, determining the distance between the vehicle position and the stop line based on the position information of the vehicle; When the distance between the vehicle position and the stop line is less than a second distance threshold, the reference line of the vehicle is switched from the lane center line to the first reference trajectory.
9. The method according to any one of claims 1 to 7, characterized in that: The method further comprises: When the previous driving scene is an intersection scene and the current driving scene is a cruise scene, determining the position of the vehicle when a lane line is first detected in the current driving scene; Determine a first travel distance between the position of the vehicle at a current moment and the position of the vehicle when the lane line is first detected; When the first driving distance is greater than a third distance threshold, the reference line of the vehicle is switched from the reference trajectory to the lane center line.
10. The method according to any one of claims 1 to 7, characterized in that: The method further comprises: When the previous driving scene is a lane-changing scene and the current driving scene is a cruising scene, determining a starting position of the vehicle when entering the current driving scene; Determining a second travel distance between the vehicle's current position and the starting position; When the second driving distance is greater than a fourth distance threshold, the reference line of the vehicle is switched from the reference trajectory to the lane center line.
11. The method according to any one of claims 1 to 7, characterized in that: The method further comprises: During the process of the vehicle traveling along the driving path, determining whether there is a trajectory point located at a stop line in the first reference trajectory according to the first reference trajectory corresponding to the position of the vehicle at a current moment; If it exists, determine the current color of the traffic light; The vehicle is controlled to travel according to the current color of the traffic light.
12. A computer device, characterized in that: include: A processor and a memory, wherein the memory stores machine-readable instructions executable by the processor, and when the machine-readable instructions are executed by the processor, the steps of the path planning method according to any one of claims 1 to 11 are performed.
13. A computer program product, comprising a computer program, characterized in that When the computer program is executed, the steps of the path planning method according to any one of claims 1 to 11 are implemented.
Citation Information
Patent Citations
Method and device for positioning vehicle in reference track point
CN115294171A
Reference trajectory planning method and device of vehicle, electronic equipment and storage medium
CN115900742A
Software architecture platform of autonomous vehicle, control method, vehicle and medium
CN116001805A
Driving path planning method and device, vehicle and storage medium
CN116101327A
Transverse control method and structure for vehicles going straight at intersection
CN118004275A
Cited By
Driving strategy determination method and device, electronic equipment and computer program product
CN120986446A
