Vehicle driving path planning method and device, electronic equipment and storage medium

By detecting the speed and distance of obstacles and generating obstacle avoidance trajectories, the problems of inaccurate path planning and safety hazards in complex environments are solved, and the real-time and safety of vehicle driving are improved.

CN119085656APending Publication Date: 2024-12-06CHONGQING SELIS PHOENIX INTELLIGENT INNOVATION TECH CO LTD
View PDF 9 Cites 0 Cited by

Patent Information

Application Number
CN202411258120.1
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-09-09
Publication Date
2024-12-06

AI Technical Summary

Technical Problem

In complex driving environments, traditional global path planning algorithms are difficult to adapt to changes in multiple obstacles on the road, resulting in path planning inaccuracy and safety hazards.

Method used

By detecting the movement speed and distance of the obstacle, we judge whether the vehicle meets obstacle avoidance conditions, obtains motion status data, generates obstacle avoidance trajectory used to indicate the vehicle to replace the lane, and determines the safety trajectory using polynomial curve fitting and safety inspection.

Benefits of technology

It realizes the generation of obstacle avoidance paths based on obstacle motion states in complex environments in real time, improving the real-time, accuracy and safety of path planning.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119085656A_ABST
    Figure CN119085656A_ABST
Patent Text Reader

Abstract

The embodiment of the invention relates to a vehicle driving path planning method and device, electronic equipment and a storage medium, and the method comprises the steps: determining the moving speed of an obstacle as a first speed in response to the detection of the obstacle in a front detection range of a target vehicle, and determining the distance between the target vehicle and the obstacle as a first distance; based on the first speed and the first distance, determining whether the target vehicle currently meets an obstacle avoidance condition; if yes, acquiring motion state data of the target vehicle; and based on the motion state data, generating a target obstacle avoidance track used for indicating the target vehicle to change from the current first lane to the second lane. According to the embodiment of the invention, on the basis of detecting various obstacles on the road, the obstacle avoidance path can be planned in real time according to the motion state of the obstacles, the obstacle avoidance path can be effectively planned according to the actual road condition, and the real-time performance and accuracy of path planning in a complex environment are improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

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

[0002] Current smart vehicles usually include an automatic collision avoidance system to prevent vehicle collisions. The system uses radar technology to detect obstacles ahead. Once a potential risk is detected, it will issue a deceleration prompt to the driver and automatically perform braking operations when necessary to ensure driving safety. However, in some complex road conditions, such as schools, factories and other parks, there are usually a variety of traffic participants and facilities, such as pedestrians, bicycles, electric bicycles, cars, etc. When smart cars are driving on park roads, the environment changes frequently, such as personnel flow, loading and unloading activities, and the movement of temporary obstacles. Traditional global path planning algorithms are difficult to adapt to these changes in a timely manner, which can easily lead to inaccuracies in path planning and safety hazards. Therefore, how to effectively plan paths for obstacles on the road in a complex driving environment is a problem that needs to be solved. Summary of the invention

[0003] In view of this, in order to solve some or all of the above-mentioned technical problems, the embodiments of the present application provide a vehicle driving path planning method, device, electronic device and computer-readable storage medium.

[0004] In a first aspect, an embodiment of the present application provides a vehicle driving path planning method, the method comprising: in response to detecting an obstacle within a detection range in front of a target vehicle, determining the moving speed of the obstacle as a first speed, and determining the distance between the target vehicle and the obstacle as a first distance; based on the first speed and the first distance, determining whether the target vehicle currently meets the obstacle avoidance conditions; if so, obtaining motion state data of the target vehicle; based on the motion state data, generating a target obstacle avoidance trajectory for instructing the target vehicle to change from the current first lane to the second lane.

[0005] In one possible implementation, based on the first speed and the first distance, determining whether the target vehicle currently meets the obstacle avoidance condition includes: using a preset following vehicle acceptance model to calculate the following vehicle acceptance for the first speed and the first distance to obtain the following vehicle acceptance; if the following vehicle acceptance is within a preset range, determining that the target vehicle meets the obstacle avoidance condition.

[0006] In one possible implementation, based on the motion state data, a target obstacle avoidance trajectory is generated to instruct the target vehicle to change from the first lane it is currently traveling in to the second lane, including: determining the initial motion state parameters of the target vehicle when the obstacle avoidance operation begins, and predicting the ending motion state parameters of the target vehicle after the obstacle avoidance is completed; performing trajectory curve fitting based on the initial motion state parameters and the ending motion state parameters to obtain the target obstacle avoidance trajectory.

[0007] In one possible implementation, trajectory curve fitting is performed according to initial motion state parameters and end motion state parameters to obtain a target obstacle avoidance trajectory, including: determining a current driving mode of the target vehicle and a lane change time interval corresponding to the driving mode; performing N-order polynomial curve fitting according to at least two lane change times included in a preset lane change time interval and according to the initial motion state parameters and the end motion state parameters to obtain at least two candidate obstacle avoidance trajectories, wherein N is a preset value; and determining a target obstacle avoidance trajectory from the at least two candidate obstacle avoidance trajectories.

[0008] In one possible implementation, determining a target obstacle avoidance trajectory from at least two candidate obstacle avoidance trajectories includes: performing safety checks on the at least two candidate obstacle avoidance trajectories respectively to obtain at least one safe obstacle avoidance trajectory that meets safe driving conditions; and selecting an obstacle avoidance trajectory that meets a lane change time condition from the at least one obtained safe obstacle avoidance trajectory as the target obstacle avoidance trajectory.

[0009] In one possible implementation, safety checks are performed on at least two candidate obstacle avoidance trajectories respectively to obtain at least one safe obstacle avoidance trajectory that meets safe driving conditions, including: determining a first occupied space range of the target vehicle and a second occupied space range of the obstacle; determining a safe distance between the target vehicle and the obstacle based on the first occupied space range and the second occupied space range; and selecting a safe obstacle avoidance trajectory that meets safe driving conditions from at least two candidate obstacle avoidance trajectories according to the safety distance.

[0010] In one possible implementation, after generating a target obstacle avoidance trajectory for instructing the target vehicle to change from a currently traveling first lane to a second lane based on motion state data, the method further includes: obtaining sensing data collected by sensors on the target vehicle while the target vehicle is traveling along the target obstacle avoidance trajectory; determining whether the target obstacle avoidance trajectory meets adjustment conditions based on the sensing data; if the adjustment conditions are met, performing a short-time obstacle avoidance path fitting operation based on the sensing data to obtain a short-time obstacle avoidance trajectory, wherein the length of the short-time obstacle avoidance trajectory is less than the length of the target obstacle avoidance trajectory; and adjusting the target obstacle avoidance trajectory based on the short-time obstacle avoidance trajectory to obtain an adjusted obstacle avoidance trajectory.

[0011] In one possible implementation, determining whether the target obstacle avoidance trajectory meets the adjustment conditions is performed based on the sensing data, including: if the sensing data indicates that a new obstacle appears on the target obstacle avoidance trajectory, determining that the target obstacle avoidance trajectory meets the adjustment conditions; if the adjustment conditions are met, performing a short-time obstacle avoidance path fitting operation based on the sensing data to obtain the short-time obstacle avoidance trajectory, including: based on the sensing data, determining that the speed of the new obstacle is a second speed, and determining that the distance between the new obstacle and the target vehicle is a second distance; performing a short-time obstacle avoidance path fitting operation based on the second speed and the second distance to obtain the short-time obstacle avoidance trajectory.

[0012] In a second aspect, an embodiment of the present application provides a vehicle driving path planning device, which includes: a first determination module, used to determine the moving speed of the obstacle as a first speed, and determine the distance between the target vehicle and the obstacle as a first distance in response to detecting an obstacle in the detection range in front of the target vehicle; a second determination module, used to determine whether the target vehicle currently meets the obstacle avoidance conditions based on the first speed and the first distance; a first acquisition module, used to acquire the motion state data of the target vehicle if it meets the conditions; and a generation module, used to generate a target obstacle avoidance trajectory for instructing the target vehicle to change from the first lane currently being driven to the second lane based on the motion state data.

[0013] In a third aspect, an embodiment of the present application provides an electronic device, comprising: a memory for storing a computer program; a processor for executing the computer program stored in the memory, and when the computer program is executed, the method of any embodiment of the vehicle driving path planning method of the first aspect of the present application is implemented.

[0014] In a fourth aspect, an embodiment of the present application provides a computer-readable storage medium having a computer program stored thereon. When the computer program is executed by a processor, a method as in any embodiment of the vehicle driving path planning method of the first aspect described above is implemented.

[0015] In a fifth aspect, an embodiment of the present application provides a computer program, which includes a computer-readable code. When the computer-readable code runs on a device, the processor in the device implements a method as in any embodiment of the vehicle driving path planning method of the first aspect mentioned above.

[0016] The vehicle driving path planning method, device, electronic device and computer-readable storage medium provided in the embodiments of the present application, by determining the moving speed of the obstacle and the distance between the obstacle and the obstacle when an obstacle is detected in the detection range in front of the target vehicle, and determining whether the target vehicle currently meets the obstacle avoidance conditions based on the speed and distance, and if so, generating a target obstacle avoidance trajectory for instructing the target vehicle to change from the first lane currently being driven to the second lane based on the motion state data of the target vehicle. The embodiments of the present application realize that on the basis of implementing the detection of various obstacles on the road, obstacle avoidance path planning can be performed in real time according to the motion state of the obstacle, so that when the map information required for global path planning is incomplete, effective obstacle avoidance path planning can be performed according to the actual road conditions, and the generated obstacle avoidance trajectory can guide the vehicle to drive safely, thereby improving the real-time and accuracy of path planning in complex environments. BRIEF DESCRIPTION OF THE DRAWINGS

[0017] The accompanying drawings, which are incorporated in and constitute a part of this specification, illustrate embodiments consistent with the present application and, together with the description, serve to explain the principles of the present application.

[0018] In order to more clearly illustrate the embodiments of the present application or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, for ordinary technicians in this field, other drawings can be obtained based on these drawings without paying any creative labor.

[0019] One or more embodiments are exemplarily described by pictures in the corresponding drawings, and these exemplified descriptions do not constitute limitations on the embodiments. Elements with the same reference numerals in the drawings represent similar elements, and unless otherwise stated, the figures in the drawings do not constitute proportional limitations.

[0020] Figure 1 A flow chart of a vehicle driving path planning method provided in an embodiment of the present application;

[0021] Figure 2 A schematic diagram of a target obstacle avoidance trajectory generated according to an embodiment of the present application;

[0022] Figure 3 A flowchart of another vehicle driving path planning method provided in an embodiment of the present application;

[0023] Figure 4 A flowchart of another vehicle driving path planning method provided in an embodiment of the present application;

[0024] Figure 5 A flowchart of another vehicle driving path planning method provided in an embodiment of the present application;

[0025] Figure 6 A schematic diagram of lateral displacement and longitudinal displacement provided in an embodiment of the present application;

[0026] Figure 7 A schematic diagram of an embodiment of the present application using a body circle to represent an occupied space range;

[0027] Figure 8 A flowchart of another vehicle driving path planning method provided in an embodiment of the present application;

[0028] Fig. 9 A schematic diagram of adjusting an obstacle avoidance trajectory based on a short-term obstacle avoidance trajectory provided in an embodiment of the present application;

[0029] Fig.10 A flowchart of another vehicle driving path planning method provided in an embodiment of the present application;

[0030] Fig.11 A schematic diagram of the structure of a vehicle driving path planning device provided in an embodiment of the present application;

[0031] Fig.12 A schematic diagram of the structure of an electronic device provided in an embodiment of the present application. DETAILED DESCRIPTION

[0032] Various exemplary embodiments of the present application will now be described in detail with reference to the accompanying drawings. Obviously, the described embodiments are part of the embodiments of the present application, rather than all of the embodiments. It should be noted that unless otherwise specifically stated, the relative arrangement of the components and steps, the numerical expressions and the numerical values ​​described in these embodiments do not limit the scope of the present application.

[0033] Those skilled in the art will understand that the terms "first" and "second" in the embodiments of the present application are only used to distinguish between different steps, devices, modules and other objects, and do not represent any specific technical meanings, nor do they indicate the logical order between them.

[0034] It should also be understood that in this embodiment, “plurality” may refer to two or more than two, and “at least one” may refer to one, two or more than two.

[0035] It should also be understood that any component, data or structure mentioned in the embodiments of the present application can generally be understood as one or more, unless explicitly limited or otherwise indicated in the context.

[0036] In addition, the term "and / or" in this application is only a description of the association relationship of associated objects, indicating that there can be three relationships. For example, A and / or B can represent: A exists alone, A and B exist at the same time, and B exists alone. In addition, the character " / " in this application generally indicates that the associated objects before and after are in an "or" relationship.

[0037] It should also be understood that the description of the various embodiments in this application focuses on the differences between the various embodiments, and the same or similar aspects thereof can be referenced to each other, and for the sake of brevity, they will not be described one by one.

[0038] The following description of at least one exemplary embodiment is merely illustrative in nature and is in no way intended to limit the present application, its application, or uses.

[0039] Technologies, circuits, and devices known to ordinary technicians in the relevant art may not be discussed in detail, but where appropriate, the above-mentioned technologies, circuits, and devices should be considered as part of the specification.

[0040] It should be noted that like reference numerals and letters refer to similar items in the following figures, and therefore, once an item is defined in one figure, it need not be further discussed in subsequent figures.

[0041] It should be noted that, in the absence of conflict, the embodiments in this application and the features in the embodiments can be combined with each other. To facilitate the understanding of the embodiments of the present application, the present application will be described in detail below with reference to the accompanying drawings and in combination with the embodiments. Obviously, the described embodiments are part of the embodiments of the present application, rather than all of the embodiments. Based on the embodiments in this application, all other embodiments obtained by ordinary technicians in this field without making creative work are within the scope of protection of this application.

[0042] In order to solve the technical problems of low accuracy, real-timeness and safety of vehicle path planning in complex environments in the prior art, the present application provides a vehicle path planning method, which can generate an obstacle avoidance path according to the movement state of the obstacle in real time, thereby improving the real-time, accuracy and safety of vehicle path planning.

[0043] Figure 1 A flow chart of a vehicle driving path planning method provided in an embodiment of the present application. The method can be applied to a vehicle and can be executed by a controller on the vehicle; it can also be executed by other electronic devices that are connected to the vehicle in communication, such as a server, a smart phone, a laptop computer, a tablet computer, or one or more electronic devices. These electronic devices can obtain obstacle information on the road where the vehicle is traveling and the vehicle's motion state data, generate an obstacle avoidance trajectory, and feed the obstacle avoidance trajectory back to the vehicle.

[0044] In addition, the execution subject of the present method may be hardware or software. When the execution subject is hardware, the execution subject may be one or more of the electronic devices. For example, a single electronic device may execute the present method, or a plurality of electronic devices may cooperate with each other to execute the present method. When the execution subject is software, the present method may be implemented as a plurality of software or software modules, or as a single software or software module. No specific limitation is made herein.

[0045] like Figure 1 As shown, the method specifically includes:

[0046] Step 101, in response to detecting an obstacle in a detection range in front of a target vehicle, determining a moving speed of the obstacle as a first speed, and determining a distance between the target vehicle and the obstacle as a first distance.

[0047] In some embodiments, the target vehicle may be any vehicle targeted by the electronic device executing the method. The target vehicle may detect surrounding obstacles in real time to determine the location, size, motion state, and other information of the obstacles. For example, obstacle detection may be performed by machine vision, laser radar, and other methods to determine the moving speed and distance of the obstacles in front of the target vehicle.

[0048] The above obstacles may be obstacles of various types, such as mobile obstacles such as cars, pedestrians, bicycles, etc., or stationary obstacles (moving speed is 0) such as roadblocks and debris.

[0049] Step 102: Determine whether the target vehicle currently meets the obstacle avoidance condition based on the first speed and the first distance.

[0050] In some embodiments, since the road environment in which the target vehicle is currently traveling is relatively complex, in order to improve driving safety and avoid a decrease in communication efficiency caused by frequent use of lanes to avoid obstacles, it is necessary to set obstacle avoidance conditions in advance and perform obstacle avoidance path planning operations when the obstacle avoidance conditions are met.

[0051] As an example, the obstacle avoidance condition may include: the first speed is less than the preset speed and / or the first distance is greater than the preset distance. That is, when the obstacle in front moves forward slowly and the distance to the target vehicle is short, the target vehicle may collide with the obstacle. At this time, obstacle avoidance path planning is required to determine whether the obstacle avoidance condition is met at this time.

[0052] Step 103: If the conditions are met, obtain the motion state data of the target vehicle.

[0053] In some embodiments, if the obstacle avoidance condition is met, the electronic device may obtain the motion state data of the target vehicle. The motion state data may include but is not limited to at least one of the following: the current position of the target vehicle, the speed and acceleration of the target vehicle, the target position of the target vehicle after avoiding obstacles, etc.

[0054] Optionally, after step 102, if it is determined that the target vehicle currently does not meet the obstacle avoidance condition, a following driving operation for the obstacle is performed to avoid a decrease in road traffic efficiency caused by frequent obstacle avoidance. For example, the following driving operation can be performed by an ACC (adaptive cruise control) module on the target vehicle.

[0055] Step 104 : generating a target obstacle avoidance trajectory for instructing the target vehicle to change from the first lane currently being driven to the second lane based on the motion state data.

[0056] In some embodiments, based on the starting position, target position, vehicle speed, acceleration and other data included in the motion state data, a curve fitting can be performed, and the fitted curve is the target obstacle avoidance trajectory. After obtaining the target obstacle avoidance trajectory, the target vehicle can drive along the target obstacle avoidance trajectory to perform obstacle avoidance operations, or the obstacle avoidance trajectory screen can be displayed on the display screen of the target vehicle to prompt the driver to manually perform obstacle avoidance operations. Figure 2 As shown, CAR 1 is the target vehicle, OBS is the obstacle in front, and the curve l in the figure is the target obstacle avoidance trajectory. The starting point of the target obstacle avoidance trajectory is the first lane, and the end point is the second lane.

[0057] The vehicle driving path planning method provided in the embodiment of the present application determines the moving speed of the obstacle and the distance between the obstacle and the obstacle when an obstacle is detected in the detection range in front of the target vehicle. Based on the speed and distance, it is determined whether the target vehicle currently meets the obstacle avoidance conditions. If it does, based on the motion state data of the target vehicle, a target obstacle avoidance trajectory is generated to instruct the target vehicle to change from the first lane currently being driven to the second lane. The embodiment of the present application realizes that on the basis of implementing the detection of various obstacles on the road, obstacle avoidance path planning can be performed in real time according to the motion state of the obstacle, so that when the map information required for global path planning is incomplete, effective obstacle avoidance path planning can be performed according to the actual road conditions. The generated obstacle avoidance trajectory can guide the vehicle to drive safely, improving the real-time and accuracy of path planning in complex environments.

[0058] In some optional implementations, such as Figure 3 As shown, step 102 includes:

[0059] Step 1021: Calculate the following vehicle acceptance degree for the first speed and the first distance using a preset following vehicle acceptance degree model to obtain the following vehicle acceptance degree.

[0060] The following vehicle acceptance model may include a calculation formula, a corresponding relationship table, etc., and the following vehicle acceptance model may be used to calculate the following vehicle acceptance. The following vehicle acceptance indicates the degree of acceptance of the target vehicle to follow the obstacle ahead.

[0061] As an example, the following vehicle acceptance model may include the following formula (1):

[0062] F r =L OBS -v OBS ·T s (1)

[0063] Among them, F r is the acceptance of the accompanying vehicle, such as Figure 2 As shown, OBS represents the obstacle in front of the target vehicle, which is a vehicle, L OBS Indicates the distance between the target vehicle and the obstacle vehicle in front, that is, the first distance, v OBS Indicates the current speed of the vehicle ahead of the obstacle, i.e. the first speed, T s Indicates the headway coefficient, usually set to 2s.

[0064] From formula (1), we can see that v OBS The larger the F r The smaller it is, the smaller the probability of a collision between the target vehicle and the obstacle vehicle. At this time, the target vehicle is more willing to follow the obstacle in front. That is, there is no need to plan an obstacle avoidance path at this time, and it only needs to continue to follow the obstacle in front.

[0065] Step 1022: If the following vehicle acceptance is within a preset range, it is determined that the target vehicle meets the obstacle avoidance condition.

[0066] As an example, if F r >6, it is determined that the following vehicle acceptance is within the preset range, and then it is determined that the target vehicle meets the obstacle avoidance conditions.

[0067] This embodiment sets a following vehicle acceptance model to determine in real time whether the target vehicle needs to perform obstacle avoidance path planning, thereby performing obstacle avoidance operations only under specific circumstances and avoiding a decrease in road traffic efficiency due to frequent obstacle avoidance.

[0068] In some optional implementations, such as Figure 4 As shown, step 104 includes:

[0069] Step 1041, determining the initial motion state parameters of the target vehicle when starting the obstacle avoidance operation, and predicting the final motion state parameters of the target vehicle after the obstacle avoidance operation is completed.

[0070] Among them, the initial motion state parameter represents the current motion state of the target vehicle, such as Figure 2 As shown, the motion state parameters at the P1 position are the initial motion state parameters. For example, the initial motion state parameters may include the current position, speed, acceleration, etc. of the target vehicle. The initial motion state parameters may be acquired by a positioning device, a sensor, and other equipment on the vehicle.

[0071] The end motion state parameters are the motion state parameters of the target vehicle after switching to the second lane, determined according to the position of the obstacle. Figure 2 As shown, the motion state parameter at the P2 position is the end motion state parameter. For example, the end motion state parameter may include the lateral displacement and forward displacement of the target vehicle from the P1 position to the P2 position, and may also include the predicted travel time from the P1 position to the P2 position.

[0072] Step 1042, performing trajectory curve fitting according to the initial motion state parameters and the final motion state parameters to obtain the target obstacle avoidance trajectory.

[0073] Specifically, after obtaining the initial motion state parameters and the final motion state parameters, curve parameter fitting can be performed according to a preset polynomial, so that the curve obtained after fitting is determined as the target obstacle avoidance trajectory.

[0074] This embodiment can perform accurate curve fitting by determining the initial motion state parameters and the final motion state parameters of the target vehicle, and the obtained target obstacle avoidance trajectory can enable the target vehicle to change lanes accurately, thereby improving the safety of the vehicle's obstacle avoidance.

[0075] In some optional implementations, such as Figure 5 As shown, step 1042 includes:

[0076] Step 10421, determine the current driving mode of the target vehicle and the lane change time interval corresponding to the driving mode.

[0077] Generally, the driving modes of the target vehicle may include energy-saving mode, comfort mode, sports mode, etc. Different driving modes require different time to switch lanes when avoiding obstacles. For example, in the campus road scenario, in energy-saving mode, the lane change time interval is 8s<t≤10s; in comfort mode, the lane change time interval is 6s<t≤8s; in sports mode, the lane change time interval is 4s≤t≤6s.

[0078] Step 10422: Perform N-order polynomial curve fitting according to at least two lane change durations included in the preset lane change duration interval and according to the initial motion state parameters and the end motion state parameters to obtain at least two candidate obstacle avoidance trajectories.

[0079] Among them, each lane change duration interval may include at least two preset lane change durations. For example, a lane change duration is set every 0.2s. That is, the lane change duration interval corresponding to the energy-saving mode includes the lane change durations of {8.2s, 8.4s, 8.6s, 8.8s, 9s, 9.2s, 9.4s, 9.6s, 9.8s, 10s}; the lane change duration interval corresponding to the comfort mode includes the lane change durations of {6.2s, 6.4s, 6.6s, 6.8s, 7s, 7.2s, 7.4s, 7.6s, 7.8s, 8s}; the lane change duration interval corresponding to the sports mode includes the lane change durations of {4s, 4.2s, 4.4s, 4.6s, 4.8s, 5s, 5.2s, 5.4s, 5.6s, 5.8s, 6s}.

[0080] The above N is a preset value, for example, N can be 5, that is, according to the initial motion state parameters and the end motion state parameters, a 5th-order polynomial curve fitting is performed to ensure a smooth transition of the vehicle's speed and acceleration.

[0081] like Figure 6 As shown, (x 0 ,y 0 ,t 0 ) represents the initial position and time when the target vehicle starts to avoid obstacles, (x end ,y end ,t end ) represents the position and time of the target vehicle after obstacle avoidance is completed. The fifth-order polynomial is shown in the following formula (2):

[0082]

[0083] Among them, x(t) and y(t) are the longitudinal and lateral positions of the target vehicle changing with time t, respectively; a k and b k are the fifth-order polynomial coefficients of the longitudinal and transverse positions respectively; t 0 The time when the target vehicle starts to avoid obstacles.

[0084] The first-order derivative and the second-order derivative of the lateral displacement y(t) are calculated as shown in the following equations (3) and (4):

[0085] y(t)′=b 1 +2b 2 t+3b 4 t 2 +4b4 t 3 +5b 5 t 4 (3)

[0086] y(t)″=2b 2 t+6b 4 t+12b 4 t 2 +20b 5 t 3 (4)

[0087] The state S of the target vehicle before and after obstacle avoidance is expressed as:

[0088] S=[y(t 0 ),y(t 0 )′,y(t 0 )″,y(t end ),y(t end )′,y(t end )″] (5)

[0089] The coefficients of the quintic polynomial are expressed as:

[0090] b=[b 5 ,b 4 ,b 3 ,b 2 ,b 1 ,b 0 ] (6)

[0091] Then we can get the coefficients of the quintic polynomial curve:

[0092] b=B -1 S (7)

[0093] in,

[0094]

[0095] Knowing the state S of the target vehicle before and after obstacle avoidance, the obstacle avoidance trajectory can be determined. 0 ),y(t 0 )′,y(t 0 )″], namely the current position, speed and acceleration of the target vehicle, which are the above-mentioned initial motion state parameters.

[0096] Usually, in order to simplify the trajectory planning process, the longitudinal velocity change during obstacle avoidance is ignored, and during lane changing, the longitudinal motion and lateral motion of the target vehicle are independent of each other and uncoupled.

[0097] In t 0At the initial state at time , the lateral displacement, lateral velocity, and lateral acceleration are all 0. Figure 6 As shown in the figure, after the longitudinal distance D changes, the vehicle obstacle avoidance ends at time t end , the lateral displacement is L, and the lateral velocity and lateral acceleration are also 0. Then the constraint equation that the lane change trajectory should satisfy is as follows:

[0098]

[0099] in,

[0100]

[0101] In the formula, v ego represents the speed of the target vehicle, D represents the longitudinal displacement of the vehicle during obstacle avoidance, and L represents the lateral displacement of the vehicle during obstacle avoidance. For example, if the road width is 3.75 m, t end Indicates the lane change duration.

[0102] Substituting this constraint into the above equations (2), (3), and (4), we can obtain the obstacle avoidance trajectory equation:

[0103]

[0104] From this trajectory equation, we can see that as long as the lane change time t is determined end , the obstacle avoidance trajectory can be determined.

[0105] For each of the at least two lane change durations included in the lane change duration interval, an obstacle avoidance trajectory can be obtained using formula (12).

[0106] Step 10423, determine a target obstacle avoidance trajectory from at least two candidate obstacle avoidance trajectories.

[0107] Specifically, the target obstacle avoidance trajectory may be determined from at least two candidate obstacle avoidance trajectories according to various methods for determining the target obstacle avoidance trajectory. For example, the shortest path may be determined from at least two candidate obstacle avoidance trajectories as the target obstacle avoidance trajectory, or the trajectory with the lowest collision probability may be determined as the target obstacle avoidance trajectory.

[0108] This embodiment determines the current driving mode of the target vehicle, fits multiple corresponding obstacle avoidance trajectories according to the driving mode, and selects one obstacle avoidance trajectory as the target obstacle avoidance trajectory, thereby adapting the obstacle avoidance trajectory to the vehicle's driving mode, thereby helping to improve the scene adaptability of the obstacle avoidance operation and improve the vehicle's driving safety.

[0109] In some optional implementations, step 10423 may be performed as follows:

[0110] First, safety checks are performed on at least two candidate obstacle avoidance trajectories respectively to obtain at least one safe obstacle avoidance trajectory that meets safe driving conditions.

[0111] Specifically, it is possible to determine whether each obstacle avoidance trajectory has a risk of colliding with an obstacle based on the minimum distance between the target vehicle and the obstacle when the target vehicle is traveling along the obstacle avoidance trajectory.

[0112] Optionally, when performing safety inspection, in addition to determining the collision risk with the obstacle in front of the target vehicle, the collision risk with other obstacles can also be determined. Figure 2 As shown, CAR 2 For vehicles in the second lane, the data collected by machine vision, laser radar and other equipment can be used to calculate the distance between the target vehicle and CAR 2 The distance between R and CAR 2 The speed v R , according to L R and v R , determine whether there is a 2 If there is a collision risk, the obstacle avoidance operation will be stopped until the CAR 2 The risk of collision is eliminated.

[0113] Then, from the obtained at least one safe obstacle avoidance trajectory, an obstacle avoidance trajectory that meets the lane change duration condition is selected as the target obstacle avoidance trajectory.

[0114] The lane change time condition may be set according to actual needs. For example, the obstacle avoidance trajectory with the shortest lane change time among the at least one safe obstacle avoidance trajectory may be used as the target obstacle avoidance trajectory that meets the lane change time condition.

[0115] This embodiment performs safety checks on at least two candidate obstacle avoidance trajectories respectively, and extracts an obstacle avoidance trajectory that can be driven safely, thereby helping to improve the driving safety of the vehicle.

[0116] In some optional implementations, in step 10423, at least one safe obstacle avoidance trajectory that meets the safe driving conditions may be generated according to the following steps:

[0117] First, a first occupied space range of the target vehicle and a second occupied space range of the obstacle are determined.

[0118] The occupied space range can be represented by the range covered by a specific shape that includes the target vehicle or obstacle. Figure 7 As shown in Figure 1, the car body circle can be used to represent the occupied space range. i (x i ,y i,v i ,θ i ) is the state of vehicle i, representing coordinates, speed, and heading angle respectively. (x c ,y c ) is the coordinate of the collision point of the car body circle model, V 1 、V 2 Car 1 、Car 2 speed.

[0119] Assume L i and W i are the length and width of the vehicle rectangle, R i is the radius of the car body circle. When two cars collide:

[0120]

[0121] Then, based on the first occupied space range and the second occupied space range, a safe distance between the target vehicle and the obstacle is determined.

[0122] Specifically, the safety distance can be set according to actual needs. For example, the sum of the body circle radius and a preset distance margin (for example, 1m) can be set as the safety distance. Figure 7 As shown, Car 1 、Car 2 The safe distance between 1 +R 2 +1.

[0123] Finally, according to the safety distance, a safe obstacle avoidance trajectory that meets the safe driving conditions is selected from at least two candidate obstacle avoidance trajectories.

[0124] The safe driving condition means that when the target vehicle is driving along a safe obstacle avoidance trajectory, the minimum distance between the target vehicle and the obstacle is less than the above safety distance.

[0125] This embodiment determines the occupied space range, selects a safe obstacle avoidance trajectory according to the occupied space range and the safety distance, and screens out a trajectory that can be used for safe obstacle avoidance from multiple fitted candidate obstacle avoidance trajectories, thereby helping to improve the safety of vehicle obstacle avoidance.

[0126] In some optional implementations, such as Figure 8 As shown, after step 104, the method further includes:

[0127] Step 105 , while the target vehicle is traveling along the target obstacle avoidance trajectory, sensing data collected by sensors on the target vehicle is obtained.

[0128] The above-mentioned sensors may include various types of sensors, such as cameras, lidars, etc.

[0129] Step 106: Determine whether the target obstacle avoidance trajectory meets the adjustment conditions based on the sensing data.

[0130] According to the sensing data, it can be determined whether there is an obstacle that affects the target vehicle's driving along the target obstacle avoidance trajectory. If there is, it can be determined that the adjustment conditions are met. For example, an obstacle is on the target obstacle avoidance trajectory, or the speed of a newly appeared obstacle is determined according to the sensing data. If it is determined based on the speed that the newly appeared obstacle is about to reach the target obstacle avoidance trajectory, it is determined that the newly appeared obstacle affects the driving trajectory of the target vehicle.

[0131] Step 107: If the adjustment conditions are met, a short-term obstacle avoidance path fitting operation is performed based on the sensing data to obtain a short-term obstacle avoidance trajectory.

[0132] Among them, the length of the short-term obstacle avoidance trajectory is smaller than the length of the target obstacle avoidance trajectory.

[0133] Specifically, based on the curve representing the target obstacle avoidance trajectory, a shorter obstacle avoidance trajectory can be fitted according to the position, speed and other parameters of the new obstacle included in the sensing data. The travel time of this trajectory is shorter, so it is called a short-time obstacle avoidance trajectory.

[0134] Step 108: Based on the short-term obstacle avoidance trajectory, the target obstacle avoidance trajectory is adjusted to obtain an adjusted obstacle avoidance trajectory.

[0135] Specifically, the short-term obstacle avoidance trajectory may replace the corresponding part of the target obstacle avoidance trajectory, thereby completing the adjustment of the target obstacle avoidance trajectory.

[0136] like Fig. 9 As shown, the target vehicle CAR 1 When the obstacle vehicle OBS is detected ahead, a long-term obstacle avoidance path planning within a time range of T is performed, and the target obstacle avoidance trajectory is obtained, that is, curve S1. While the target vehicle is driving along the long-term planned obstacle avoidance trajectory S1, a short-term path planning with a time length of t is performed based on the sensing data collected from the sensor, and S1 is adjusted based on the short-term path. When the target vehicle drives to CAR 1 * When an obstacle such as a pedestrian enters S1, short-term planning is performed to obtain a short-term obstacle avoidance path. The short-term obstacle avoidance path replaces the corresponding part in S1 to obtain a new path S2, which is the adjusted obstacle avoidance trajectory, thereby ensuring that the target vehicle can avoid obstacles safely.

[0137] This embodiment combines long-term obstacle avoidance path planning with short-term obstacle avoidance path planning. When a vehicle is traveling on a road lacking global traffic information (such as roads within a park), the obstacle avoidance path can be adjusted in real time through long-term and short-term path planning methods, thereby ensuring the safety of vehicle driving.

[0138] In some optional implementations, such as Fig.10 As shown, step 106 includes:

[0139] Step 1061 : If the sensing data indicates that a new obstacle appears on the target obstacle avoidance trajectory, it is determined that the target obstacle avoidance trajectory meets the adjustment condition.

[0140] That is, when a new obstacle is detected on the target obstacle avoidance trajectory, the target obstacle avoidance trajectory needs to be adjusted.

[0141] Step 107 includes:

[0142] Step 1071, based on the sensing data, determining the speed of the new obstacle as a second speed, and determining the distance between the new obstacle and the target vehicle as a second distance.

[0143] Specifically, the sensing data may include data such as images and three-dimensional point clouds. Using the sensing data, the positions of the new obstacles at different times may be detected, and then the second speed and the second distance may be calculated.

[0144] Step 1072: Perform a short-term obstacle avoidance path fitting operation based on the second speed and the second distance to obtain a short-term obstacle avoidance trajectory.

[0145] Specifically, the method for performing obstacle avoidance path fitting based on the second speed and the second distance may be the same as the method for performing target obstacle avoidance path fitting based on the first speed and the first distance described in the above embodiment, and will not be described in detail here.

[0146] This embodiment uses sensing data to determine the speed and distance of new obstacles that affect the target obstacle avoidance trajectory, and performs short-term obstacle avoidance path fitting based on the speed and distance. This enables real-time fitting of obstacle avoidance trajectories for other obstacles while the vehicle is avoiding obstacles along the long-term path. This allows the short-term obstacle avoidance trajectory to be more closely matched to the actual road conditions, thereby improving the real-time and accuracy of the obstacle avoidance operation.

[0147] Fig.11A schematic diagram of the structure of a vehicle driving path planning device provided in an embodiment of the present application. Specifically comprising: a first determination module 1101, for determining the moving speed of the obstacle as a first speed and the distance between the target vehicle and the obstacle as a first distance in response to detecting an obstacle in the detection range in front of the target vehicle; a second determination module 1102, for determining whether the target vehicle currently meets the obstacle avoidance condition based on the first speed and the first distance; a first acquisition module 1103, for acquiring the motion state data of the target vehicle if it meets the condition; a generation module 1104, for generating a target obstacle avoidance trajectory for instructing the target vehicle to change from the current first lane to the second lane based on the motion state data.

[0148] In some optional implementations, the second determination module includes: a calculation unit, used to use a preset following vehicle acceptance model to perform a following vehicle acceptance calculation on the first speed and the first distance to obtain the following vehicle acceptance; and a first determination unit, used to determine that the target vehicle meets the obstacle avoidance conditions if the following vehicle acceptance is within a preset range.

[0149] In some optional implementations, the generation module includes: a second determination unit, used to determine the initial motion state parameters of the target vehicle when the obstacle avoidance operation begins, and to predict the ending motion state parameters of the target vehicle after the obstacle avoidance is completed; a first fitting unit, used to perform trajectory curve fitting based on the initial motion state parameters and the ending motion state parameters to obtain the target obstacle avoidance trajectory.

[0150] In some optional implementations, the first fitting unit includes: a first determination subunit, used to determine the current driving mode of the target vehicle, and the lane change time interval corresponding to the driving mode; a fitting subunit, used to perform N-order polynomial curve fitting according to at least two lane change times included in a preset lane change time interval, and according to initial motion state parameters and ending motion state parameters, to obtain at least two candidate obstacle avoidance trajectories, where N is a preset value; a second determination subunit, used to determine a target obstacle avoidance trajectory from the at least two candidate obstacle avoidance trajectories.

[0151] In some optional implementations, the second determination subunit is further used to: perform safety checks on at least two candidate obstacle avoidance trajectories respectively to obtain at least one safe obstacle avoidance trajectory that meets safe driving conditions; and select an obstacle avoidance trajectory that meets the lane change time condition from the at least one obtained safe obstacle avoidance trajectory as the target obstacle avoidance trajectory.

[0152] In some optional implementations, the second determination subunit is further used to: determine a first occupied space range of the target vehicle and a second occupied space range of the obstacle; determine a safe distance between the target vehicle and the obstacle based on the first occupied space range and the second occupied space range; and select a safe obstacle avoidance trajectory that meets safe driving conditions from at least two candidate obstacle avoidance trajectories based on the safe distance.

[0153] In some optional implementations, the device also includes: a second acquisition module, used to obtain sensing data collected by sensors on the target vehicle while the target vehicle is traveling along the target obstacle avoidance trajectory; a third determination module, used to determine whether the target obstacle avoidance trajectory meets the adjustment conditions based on the sensing data; a fitting module, used to perform a short-term obstacle avoidance path fitting operation based on the sensing data to obtain a short-term obstacle avoidance trajectory if the adjustment conditions are met, wherein the length of the short-term obstacle avoidance trajectory is less than the length of the target obstacle avoidance trajectory; an adjustment module, used to adjust the target obstacle avoidance trajectory based on the short-time obstacle avoidance trajectory to obtain an adjusted obstacle avoidance trajectory.

[0154] In some optional implementations, the third determination module is further used to: if the sensing data indicates that a new obstacle appears on the target obstacle avoidance trajectory, determine that the target obstacle avoidance trajectory meets the adjustment conditions; the fitting module includes: a third determination unit, used to determine, based on the sensing data, the speed of the new obstacle as the second speed, and determine the distance between the new obstacle and the target vehicle as the second distance; a second fitting unit, used to perform a short-term obstacle avoidance path fitting operation based on the second speed and the second distance to obtain a short-term obstacle avoidance trajectory.

[0155] The vehicle driving path planning device provided in this embodiment can be as follows Fig.11 The vehicle driving path planning device shown in can execute all the steps of the above vehicle driving path planning methods, thereby achieving the technical effects of the above vehicle driving path planning methods. Please refer to the above related description for details. For the sake of brevity, it will not be repeated here.

[0156] Fig.12 A schematic diagram of the structure of an electronic device provided in an embodiment of the present application, Fig.12 The electronic device 1200 shown includes: at least one processor 1201, a memory 1202, at least one network interface 1204 and other user interfaces 1203. The various components in the electronic device 1200 are coupled together via a bus system 1205. It is understood that the bus system 1205 is used to achieve connection and communication between these components. In addition to the data bus, the bus system 1205 also includes a power bus, a control bus and a status signal bus. However, for the sake of clarity, the bus system 1205 is not described in detail. Fig.12 Various buses are labeled as bus system 1205.

[0157] The user interface 1203 may include a display, a keyboard, or a pointing device (eg, a mouse, a trackball, a touch pad, or a touch screen).

[0158] It can be understood that the memory 1202 in the embodiment of the present application can be a volatile memory or a non-volatile memory, or can include both volatile and non-volatile memories. Among them, the non-volatile memory can be a read-only memory (ROM), a programmable read-only memory (PROM), an erasable programmable read-only memory (EPROM), an electrically erasable programmable read-only memory (EEPROM), or a flash memory. The volatile memory can be a random access memory (RAM), which is used as an external cache. By way of example and not limitation, many forms of RAM are available, such as static random access memory (SRAM), dynamic random access memory (DRAM), synchronous dynamic random access memory (SDRAM), double data rate synchronous dynamic random access memory (DDRSDRAM), enhanced synchronous dynamic random access memory (ESDRAM), synchronous link dynamic random access memory (SLDRAM), and direct memory bus random access memory (DRRAM). The memory 1202 described herein is intended to include, but is not limited to, these and any other suitable types of memory.

[0159] In some embodiments, the memory 1202 stores the following elements, executable units or data structures, or a subset thereof, or an extended set thereof: an operating system 12021 and an application program 12022 .

[0160] Among them, the operating system 12021 includes various system programs, such as a framework layer, a core library layer, a driver layer, etc., which are used to implement various basic services and process hardware-based tasks. The application 12022 includes various application programs, such as a media player (Media Player), a browser (Browser), etc., which are used to implement various application services. The program for implementing the method of the embodiment of the present application can be included in the application 12022.

[0161] In this embodiment, by calling the program or instruction stored in the memory 1202, specifically, the program or instruction stored in the application 12022, the processor 1201 is used to execute the method steps provided by each method embodiment, for example, including:

[0162] In response to detecting an obstacle within a detection range in front of a target vehicle, determining a moving speed of the obstacle as a first speed, and determining a distance between the target vehicle and the obstacle as a first distance; determining whether the target vehicle currently meets obstacle avoidance conditions based on the first speed and the first distance; if so, obtaining motion state data of the target vehicle; and generating a target obstacle avoidance trajectory for instructing the target vehicle to change from a currently traveling first lane to a second lane based on the motion state data.

[0163] The method disclosed in the above embodiment of the present application can be applied to the processor 1201, or implemented by the processor 1201. The processor 1201 may be an integrated circuit chip with signal processing capabilities. In the implementation process, each step of the above method can be completed by the hardware integrated logic circuit or software instructions in the processor 1201. The above processor 1201 can be a general processor, a digital signal processor (Digital Signal Processor, DSP), an application specific integrated circuit (Application Specific Integrated Circuit, ASIC), a field programmable gate array (Field Programmable Gate Array, FPGA) or other programmable logic devices, discrete gates or transistor logic devices, discrete hardware components. The methods, steps and logic block diagrams disclosed in the embodiments of the present application can be implemented or executed. The general processor can be a microprocessor or the processor can also be any conventional processor, etc. The steps of the method disclosed in the embodiment of the present application can be directly embodied as a hardware decoding processor to execute, or the hardware and software units in the decoding processor can be executed. The software unit can be located in a mature storage medium in the field such as a random access memory, a flash memory, a read-only memory, a programmable read-only memory or an electrically erasable programmable memory, a register, etc. The storage medium is located in the memory 1202, and the processor 1201 reads the information in the memory 1202 and completes the steps of the above method in combination with its hardware.

[0164] It is understood that the embodiments described herein may be implemented in hardware, software, firmware, middleware, microcode, or a combination thereof. For hardware implementation, the processing unit may be implemented in one or more application specific integrated circuits (ASIC), digital signal processors (DSP), digital signal processing devices (DSPDevice, DSPD), programmable logic devices (PLD), field programmable gate arrays (FPGA), general purpose processors, controllers, microcontrollers, microprocessors, other electronic units for performing the above functions of the present application, or a combination thereof.

[0165] For software implementation, the technology described above in this article can be implemented by a unit that performs the functions described above in this article. The software code can be stored in a memory and executed by a processor. The memory can be implemented in the processor or outside the processor.

[0166] The electronic device provided in this embodiment may be Fig.12 The electronic device shown in can execute all the steps of the vehicle driving path planning methods described above, thereby achieving the technical effects of the vehicle driving path planning methods described above. Please refer to the above related description for details. For the sake of brevity, it will not be repeated here.

[0167] The embodiment of the present application also provides a storage medium (computer-readable storage medium). The storage medium here stores one or more programs. The storage medium may include a volatile memory, such as a random access memory; the memory may also include a non-volatile memory, such as a read-only memory, a flash memory, a hard disk or a solid-state drive; the memory may also include a combination of the above-mentioned types of memory.

[0168] When one or more programs in the storage medium can be executed by one or more processors, the vehicle driving path planning method executed on the electronic device side can be implemented.

[0169] The processor is used to execute the program stored in the memory to implement the following steps of the vehicle driving path planning method executed on the electronic device side:

[0170] In response to detecting an obstacle within a detection range in front of a target vehicle, determining a moving speed of the obstacle as a first speed, and determining a distance between the target vehicle and the obstacle as a first distance; determining whether the target vehicle currently meets obstacle avoidance conditions based on the first speed and the first distance; if so, obtaining motion state data of the target vehicle; and generating a target obstacle avoidance trajectory for instructing the target vehicle to change from a currently traveling first lane to a second lane based on the motion state data.

[0171] The professionals should further realize that the units and algorithm steps of each example described in conjunction with the embodiments disclosed herein can be implemented by electronic hardware, computer software, or a combination of the two. In order to clearly illustrate the interchangeability of hardware and software, the composition and steps of each example have been generally described in terms of function in the above description. Whether these functions are performed in hardware or software depends on the specific application and design constraints of the technical solution. Professional and technical personnel can use different circuits to implement the described functions for each specific application, but such implementation should not be considered to be beyond the scope of this application.

[0172] The steps of the circuits or algorithms described in conjunction with the embodiments disclosed herein may be implemented using hardware, software modules executed by a processor, or a combination of the two. The software modules may be placed in a random access memory (RAM), a memory, a read-only memory (ROM), an electrically programmable ROM, an electrically erasable programmable ROM, a register, a hard disk, a removable disk, a CD-ROM, or any other form of storage medium known in the art.

[0173] It should be understood that the terms used in the text are only for the purpose of describing specific example embodiments, and are not intended to be limiting. Unless the context clearly indicates otherwise, the singular forms "one", "an" and "said" as used in the text may also be meant to include plural forms. The terms "include", "comprise", "contain", and "have" are inclusive, and therefore specify the existence of stated features, steps, operations, elements and / or parts, but do not exclude the existence or addition of one or more other features, steps, operations, elements, parts, and / or combinations thereof. The steps, processes, and operations described in the text are not interpreted as necessarily requiring them to be performed in the specific order described or illustrated, unless the execution order is clearly indicated. It should also be understood that additional or alternative steps may be used.

[0174] The above description is only a specific implementation of the present application, so that those skilled in the art can understand or implement the present application. Various modifications to these embodiments will be apparent to those skilled in the art, and the general principles defined herein can be implemented in other embodiments without departing from the spirit or scope of the present application. Therefore, the present application will not be limited to the embodiments shown herein, but will conform to the widest range consistent with the principles and novel features applied for herein.

Claims

1. A vehicle driving path planning method, characterized in that: The method comprises: In response to detecting an obstacle in a detection range in front of a target vehicle, determining a moving speed of the obstacle as a first speed, and determining a distance between the target vehicle and the obstacle as a first distance; Based on the first speed and the first distance, determining whether the target vehicle currently meets the obstacle avoidance condition; If yes, obtaining the motion state data of the target vehicle; Based on the motion state data, a target obstacle avoidance trajectory is generated for instructing the target vehicle to change from a first lane currently being traveled to a second lane.

2. The method according to claim 1, characterized in that The determining, based on the first speed and the first distance, whether the target vehicle currently meets the obstacle avoidance condition includes: Using a preset following vehicle acceptance model, calculating the following vehicle acceptance for the first speed and the first distance to obtain the following vehicle acceptance; If the following vehicle acceptance is within a preset range, it is determined that the target vehicle meets the obstacle avoidance condition.

3. The method according to claim 1, characterized in that The generating, based on the motion state data, a target obstacle avoidance trajectory for instructing the target vehicle to change from a first lane currently being driven to a second lane comprises: Determining initial motion state parameters of the target vehicle when starting an obstacle avoidance operation, and predicting ending motion state parameters of the target vehicle after the obstacle avoidance operation is completed; According to the initial motion state parameters and the end motion state parameters, trajectory curve fitting is performed to obtain the target obstacle avoidance trajectory.

4. The method according to claim 3, characterized in that The performing trajectory curve fitting according to the initial motion state parameter and the end motion state parameter to obtain the target obstacle avoidance trajectory includes: Determining a current driving mode of the target vehicle and a lane change duration interval corresponding to the driving mode; According to at least two lane change durations included in the preset lane change duration interval, and according to the initial motion state parameter and the end motion state parameter, an N-order polynomial curve fitting is performed to obtain at least two candidate obstacle avoidance trajectories, where N is a preset value; The target obstacle avoidance trajectory is determined from the at least two candidate obstacle avoidance trajectories.

5. The method according to claim 4, characterized in that The step of determining the target obstacle avoidance trajectory from the at least two candidate obstacle avoidance trajectories includes: Performing safety checks on the at least two candidate obstacle avoidance trajectories respectively to obtain at least one safe obstacle avoidance trajectory that meets safe driving conditions; From the obtained at least one safe obstacle avoidance trajectory, an obstacle avoidance trajectory that meets the lane change duration condition is selected as the target obstacle avoidance trajectory.

6. The method according to claim 5, characterized in that The step of performing safety checks on the at least two candidate obstacle avoidance trajectories to obtain at least one safe obstacle avoidance trajectory that meets safe driving conditions includes: Determining a first occupied space range of the target vehicle and a second occupied space range of the obstacle; Determining a safe distance between the target vehicle and the obstacle based on the first occupied space range and the second occupied space range; A safe obstacle avoidance trajectory that meets safe driving conditions is selected from the at least two candidate obstacle avoidance trajectories according to the safety distance.

7. The method according to any one of claims 1 to 6, characterized in that: After generating a target obstacle avoidance trajectory for instructing the target vehicle to change from the first lane currently being driven to the second lane based on the motion state data, the method further includes: Acquiring sensing data collected by sensors on the target vehicle while the target vehicle is traveling along the target obstacle avoidance trajectory; Determining whether the target obstacle avoidance trajectory meets the adjustment conditions according to the sensing data; If the adjustment condition is met, a short-term obstacle avoidance path fitting operation is performed based on the sensing data to obtain a short-term obstacle avoidance trajectory, wherein the length of the short-term obstacle avoidance trajectory is less than the length of the target obstacle avoidance trajectory; Based on the short-term obstacle avoidance trajectory, the target obstacle avoidance trajectory is adjusted to obtain an adjusted obstacle avoidance trajectory.

8. The method according to claim 7, characterized in that The step of determining, based on the sensing data, whether the target obstacle avoidance trajectory meets the adjustment condition includes: If the sensing data indicates that a new obstacle appears on the target obstacle avoidance trajectory, determining that the target obstacle avoidance trajectory meets the adjustment condition; If the adjustment condition is met, a short-term obstacle avoidance path fitting operation is performed based on the sensing data to obtain a short-term obstacle avoidance trajectory, including: Based on the sensing data, determining a speed of the new obstacle as a second speed, and determining a distance between the new obstacle and the target vehicle as a second distance; A short-term obstacle avoidance path fitting operation is performed based on the second speed and the second distance to obtain a short-term obstacle avoidance trajectory.

9. A vehicle driving path planning device, characterized in that: The device comprises: a first determination module, configured to, in response to detecting that an obstacle appears in a detection range in front of a target vehicle, determine a moving speed of the obstacle as a first speed, and determine a distance between the target vehicle and the obstacle as a first distance; A second determination module, configured to determine whether the target vehicle currently meets an obstacle avoidance condition based on the first speed and the first distance; A first acquisition module, used for acquiring the motion state data of the target vehicle if the condition is met; A generating module is used to generate a target obstacle avoidance trajectory for instructing the target vehicle to change from a first lane currently being driven to a second lane based on the motion state data.

10. An electronic device, characterized in that: include: Memory for storing computer programs; A processor is used to execute the computer program stored in the memory, and when the computer program is executed, the vehicle driving path planning method described in any one of claims 1 to 8 is implemented.

Citation Information

Patent Citations

  • Conic curve-based self-driving obstacle avoidance method, device, apparatus and medium

    CN109270933A

  • Dynamic trajectory planning method for unmanned vehicle based on local optimum

    CN110362096A

  • Vehicle lane changing planning method, automatic driving vehicle and storage medium

    CN111923910A

  • Intelligent vehicle high-speed lane changing planning method based on collision detection

    CN112965489A

  • Intelligent passenger car dynamic lane changing trajectory planning method in multi-car complex traffic environment

    CN114987461A