Vehicle trajectory prediction method and device, storage medium and electronic equipment

By obtaining the historical trajectory information of the target vehicle and judging the motion scene, using rule models or deep learning neural networks for trajectory prediction, the problem of target vehicle trajectory prediction accuracy and stability in autonomous driving is solved, and the prediction accuracy and robustness are improved.

CN119305581AActive Publication Date: 2025-01-14GUANGZHOU AUTOMOBILE GROUP CO LTD

Patent Information

Application Number
CN202310858872.0
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2023-07-12
Publication Date
2025-01-14
Estimated Expiration
2043-07-12

AI Technical Summary

Technical Problem

In the field of autonomous driving, the perception effect of the bicycle perception module is unstable, resulting in poor accuracy and stability of the future trajectory prediction of the target vehicle, especially in complex scenarios, which is difficult to accurately predict.

Method used

By obtaining the historical trajectory information of the target vehicle, judging its motion scene, and using a regular model or deep learning neural network to predict the trajectory according to the different scenarios. If it is a straight or a lane change, use a regular model to predict; if it is a turn or a turn, use a pre-trained deep learning neural network to process multi-channel images for prediction.

Benefits of technology

It improves the accuracy and stability of target vehicle trajectory prediction, optimizes the accuracy and robustness of prediction algorithms, reduces the time-consuming reasoning, and adapts to the complexity of different scenarios.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119305581A_ABST
    Figure CN119305581A_ABST
Patent Text Reader

Abstract

The invention relates to a vehicle track prediction method and device, a storage medium and electronic equipment, and the method comprises the steps: obtaining historical track information of a target vehicle, and determining a motion scene of the target vehicle according to the historical track information; predicting a future trajectory of the target vehicle according to the motion scene; wherein when the motion scene is straight going or lane changing, the future trajectory of the target vehicle is predicted according to the historical trajectory information and a preset rule model; and when the motion scene is turning or turning around, lane line information is acquired, a multi-channel image is acquired according to the historical track information and the lane line information, and the multi-channel image is input and processed by using a pre-trained deep learning neural network to predict a future track of the target vehicle. The reasoning time consumption can be effectively reduced and the prediction stability can be effectively improved on the premise of ensuring the prediction precision.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of autonomous driving technology, and specifically to a vehicle trajectory prediction method and its device, storage medium, and electronic device. Background Art

[0002] In the field of autonomous driving, the vehicle's perception module detects the vehicle's surrounding environment information and outputs perception information. The vehicle's prediction module receives the perception information, predicts the running trajectory of the surrounding target vehicles in the future, and outputs it to the vehicle's planning and decision-making module for path planning.

[0003] However, due to the instability of the perception effect of the ego vehicle's perception module and the great uncertainty of the long-term running trajectory of the target vehicle in complex scenarios, the prediction accuracy and stability of the ego vehicle's prediction module for the future trajectory of the target vehicle are poor. Summary of the invention

[0004] The purpose of this application is to propose a vehicle trajectory prediction method and its device, storage medium, and electronic device to improve the trajectory prediction accuracy and stability of the target vehicle.

[0005] To achieve the above object, an embodiment of the present application provides a vehicle trajectory prediction method, the method comprising:

[0006] Acquire historical trajectory information of the target vehicle, and determine the movement scene of the target vehicle according to the historical trajectory information; the historical trajectory information includes multiple historical position coordinates of the target vehicle in the world coordinate system and their corresponding moments; the historical position coordinates include a horizontal coordinate and a vertical coordinate;

[0007] The future trajectory of the target vehicle is predicted according to the motion scene; when the motion scene is straight driving or lane change, the future trajectory of the target vehicle is predicted according to the historical trajectory information and a preset rule model; when the motion scene is turning or making a U-turn, lane line information is obtained, a multi-channel image is obtained according to the historical trajectory information and the lane line information, and the multi-channel image is input into a pre-trained deep learning neural network for processing to predict the future trajectory of the target vehicle.

[0008] In some embodiments, predicting the future trajectory of the target vehicle based on the historical trajectory information and a preset rule model specifically includes:

[0009] Acquire the speed and acceleration of the target vehicle according to the historical trajectory information;

[0010] Based on the kinematic model, predicting the trajectory of the target vehicle within a preset future time according to the speed and acceleration of the target vehicle to obtain a first future trajectory;

[0011] Based on the Kalman filter model, the trajectory of the target vehicle within a preset future time is predicted according to the speed and acceleration of the target vehicle to obtain a second future trajectory;

[0012] The first future trajectory and the second future trajectory are weighted and smoothed to obtain the future trajectory of the target vehicle.

[0013] In some embodiments, obtaining the speed and acceleration of the target vehicle according to the historical trajectory information specifically includes:

[0014] Calculating a first speed and a first acceleration of the target vehicle according to the historical trajectory information, and obtaining a second speed and a second acceleration of the target vehicle detected by the vehicle perception module;

[0015] The speed of the target vehicle is obtained by weighted summing of the first speed and the second speed, and the acceleration of the target vehicle is obtained by weighted summing of the first acceleration and the second acceleration.

[0016] In some embodiments, calculating the first speed and the first acceleration of the target vehicle according to the historical trajectory information specifically includes:

[0017] Based on the least squares method, a quadratic polynomial function is fitted according to the multiple historical position coordinates and their corresponding times; wherein the input of the quadratic polynomial function is the time, and the output is the horizontal coordinate or the vertical coordinate;

[0018] Time resampling is performed at a preset frequency to obtain the latest m moments; m is a preset value;

[0019] Calculate the horizontal coordinates and vertical coordinates corresponding to the m moments according to the m moments and the fitted quadratic polynomial function, and obtain the historical trajectory according to the horizontal coordinates and vertical coordinates corresponding to the m moments;

[0020] A first speed and a first acceleration of the target vehicle are calculated according to the historical trajectory.

[0021] In some embodiments, determining the movement scene of the target vehicle according to the historical trajectory information specifically includes:

[0022] Fitting a circle according to the plurality of historical position coordinates and a least squares fitting circle function;

[0023] If the radius of the fitted circle is greater than a preset first threshold, it is determined that the movement scene of the target vehicle is straight driving or lane changing; if the radius of the fitted circle is less than or equal to the preset first threshold, the movement scene of the target vehicle is turning or U-turn.

[0024] In some embodiments, determining the movement scene of the target vehicle according to the historical trajectory information specifically includes:

[0025] When the number of historical position coordinates of the target vehicle obtained is less than a preset second threshold, the future trajectory of the target vehicle is not predicted;

[0026] When the number of acquired historical position coordinates of the target vehicle is greater than or equal to a preset second threshold, the future trajectory of the target vehicle is predicted.

[0027] In some embodiments, obtaining a multi-channel image according to the historical trajectory information and lane line information specifically includes:

[0028] Interpolating the multiple historical position coordinates to obtain a historical trajectory, and resampling n historical trajectory points of the historical trajectory at a preset frequency; n is a preset value;

[0029] A multi-channel image is generated according to the n historical trajectory points and the lane line information.

[0030] An embodiment of the present application also provides a vehicle trajectory prediction device, including a module for executing the vehicle trajectory prediction method as described above.

[0031] An embodiment of the present application further provides a computer-readable storage medium, wherein the computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the vehicle trajectory prediction method as described above is implemented.

[0032] An embodiment of the present application also provides an electronic device, including a processor, a memory, and a computer program stored in the memory and executable on the processor, wherein the processor implements the vehicle trajectory prediction method as described above when executing the computer program.

[0033] The embodiment of the present application provides a vehicle trajectory prediction method and its device, storage medium, and electronic device. When predicting the future trajectory of other target vehicles on the road, the motion scene of other target vehicles is judged according to the historical trajectory information of the target vehicle. If the motion scene of the target vehicle is straight or changing lanes, the scene of straight or changing lanes is relatively simple. Therefore, the embodiment of the present application predicts the future trajectory of the target vehicle according to the historical trajectory information and the preset rule model, and can accurately, quickly and stably predict the motion trajectory of the target vehicle; if the motion scene of the target vehicle is turning or turning around, the scene of turning or turning around is relatively complex. Therefore, the embodiment of the present application obtains lane line information, obtains multi-channel images according to the historical trajectory information and lane line information, and inputs the multi-channel images to be processed by a pre-trained deep learning neural network to predict the future trajectory of the target vehicle. The data-driven deep learning neural network learns a large number of real trajectory training samples through large-scale learnable parameters, and can well predict the motion trajectory in complex scenes. In summary, the embodiment of the present application proposes corresponding trajectory prediction algorithms for different motion scenes to optimize prediction accuracy and speed, which can effectively improve the accuracy and robustness of the trajectory prediction scheme and reduce the time consumption of reasoning. BRIEF DESCRIPTION OF THE DRAWINGS

[0034] In order to more clearly illustrate the technical solutions in the embodiments of the present application, the drawings required in the description of the embodiments will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.

[0035] Figure 1 This is a flow chart of a vehicle trajectory prediction method in one embodiment of the present application.

[0036] Figure 2 This is a flowchart for caching and updating perception information in one embodiment of the present application.

[0037] Figure 3 This is a flowchart of a vehicle trajectory prediction method in another embodiment of the present application.

[0038] Figure 4 This is a structural framework diagram of a vehicle trajectory prediction device in one embodiment of the present application. DETAILED DESCRIPTION

[0039] The detailed description of the drawings is intended as an illustration of the current embodiment of the present application, and is not intended to represent the only form in which the present application can be implemented. It should be understood that the same or equivalent functions can be accomplished by different embodiments intended to be included in the spirit and scope of the present application.

[0040] See also Figure 1 An embodiment of the present application provides a vehicle trajectory prediction method, comprising the following steps:

[0041] Step S10, obtaining historical trajectory information of the target vehicle, and determining the movement scene of the target vehicle according to the historical trajectory information; the historical trajectory information includes a plurality of historical position coordinates of the target vehicle in the world coordinate system and the corresponding time; the historical position coordinates include a horizontal coordinate and a vertical coordinate;

[0042] Specifically, the target vehicle refers to the vehicle in the surrounding environment of the vehicle. The movement law of the target vehicle can be inferred based on the historical trajectory information to determine the movement scene of the target vehicle. The movement scene includes simple scenes and complex scenes. The simple scene is straight driving or changing lanes, and the complex scene is turning or U-turning.

[0043] Step S20, predicting the future trajectory of the target vehicle according to the motion scene; wherein, when the motion scene is straight driving or lane change, predicting the future trajectory of the target vehicle according to the historical trajectory information and a preset rule model; when the motion scene is turning or U-turning, acquiring lane line information, obtaining a multi-channel image according to the historical trajectory information and the lane line information, and inputting the multi-channel image into a pre-trained deep learning neural network for processing to predict the future trajectory of the target vehicle;

[0044] Specifically, two trajectory prediction schemes are provided in step S20. First, if the target vehicle's motion scene is straight driving or changing lanes, the scenes of straight driving or changing lanes are relatively simple. Therefore, this embodiment predicts the future trajectory of the target vehicle based on the historical trajectory information and the preset rule model. The calculation time is short and the prediction accuracy can meet the requirements. Therefore, the motion trajectory of the target vehicle can be accurately, quickly and stably predicted; second, if the target vehicle's motion scene is turning or turning around, the scenes of turning or turning around are relatively complex. At this time, if the preset rule model is continued to be used for prediction, the prediction result accuracy is low. Therefore, this embodiment uses a pre-trained deep learning neural network for prediction. The data-driven deep learning neural network learns a large number of real trajectory training samples through large-scale learnable parameters, which can well predict the motion trajectory in complex scenes.

[0045] Among them, the rule model is a rule-based method for describing and processing knowledge and behaviors in a specific problem domain. The rule model contains a series of rules that are triggered under specific conditions and perform corresponding operations or reasoning. The rules are usually expressed in the form of condition-conclusion, where the condition (also called the premise) specifies the specific situation that triggers the rule, and the conclusion (also called the result) specifies the operation or reasoning performed under this condition; the preset rule model is, for example, a kinematic model, a Kalman filter model, etc.

[0046] It should be noted that in the scenarios of going straight or changing lanes, both the trajectory prediction based on the preset rule model and the trajectory prediction based on the deep learning neural network can achieve relatively good prediction results, but the deep learning neural network requires a huge amount of computing and real-time requirements, which places high demands on system hardware resources and higher requirements on the stability of upstream perception information. Therefore, this embodiment selects a trajectory prediction solution based on the preset rule model in the scenarios of going straight or changing lanes, which saves computing time and improves prediction efficiency. In the scenarios of turning or U-turning, the trajectory prediction based on the preset rule model cannot meet the prediction accuracy requirements. Therefore, in order to ensure the prediction accuracy, this embodiment selects a trajectory prediction solution based on a deep learning neural network.

[0047] In summary, this embodiment proposes corresponding trajectory prediction algorithms for different motion scenarios to optimize prediction accuracy and speed, which can effectively improve the accuracy and robustness of the trajectory prediction solution and reduce the time consumption of reasoning.

[0048] In some embodiments, the method further comprises:

[0049] Step S30, obtaining the ego vehicle posture, converting the predicted future trajectory of the target vehicle from the world coordinate system to the ego vehicle coordinate system according to the ego vehicle posture, and outputting it to the ego vehicle planning decision module.

[0050] Specifically, in the field of autonomous driving, the perception module of the vehicle detects the information of the surrounding environment of the vehicle and outputs the perception information. The prediction module of the vehicle receives the perception information and predicts the running trajectory of the surrounding target vehicles in the future and outputs it to the planning and decision module of the vehicle for path planning. For example, the collision risk between the vehicle and the target vehicle is calculated. If there is a collision risk between the vehicle and the target vehicle, the vehicle is controlled to slow down, change lanes, etc.; another example is to issue an early warning prompt. When making decisions and planning, the planning and decision module of the vehicle generally makes decisions and planning based on the coordinate system of the vehicle, while the future trajectory of the target vehicle predicted in this embodiment is based on the world coordinate system. Therefore, it needs to be converted to the coordinate system of the vehicle and then output to the planning and decision module of the vehicle for planning and decision making; specifically, the predicted trajectory is sent to the planning and decision module of the vehicle in the form of a point set.

[0051] In some embodiments, the step S20 predicts the future trajectory of the target vehicle according to the historical trajectory information and a preset rule model, specifically including:

[0052] Step S211, obtaining the speed and acceleration of the target vehicle according to the historical trajectory information;

[0053] Step S212, based on the kinematic model, the trajectory of the target vehicle in the future preset time is predicted according to the speed and acceleration of the target vehicle to obtain a first future trajectory, for example, a trajectory in the next 3 seconds, including 30 predicted trajectory point coordinates; the prediction principle based on the kinematic model is shown in the following formula:

[0054] x=x+(v x +a x ×0.1)×0.1

[0055] v x =v x +a x ×0.1

[0056] y=y+(v y +a y ×0.1)×0.1

[0057] v y =v y +a y ×0.1

[0058] Among them, v x and v y are the lateral component and longitudinal component of the target vehicle's velocity, respectively, and a x and a y are the lateral component and longitudinal component of the acceleration of the target vehicle, respectively; x is the lateral coordinate of the target vehicle, and y is the longitudinal coordinate of the target vehicle;

[0059] Assuming that the current position in the X direction is x at time t, then for the next time t+1, the speed in the X direction is v x =v x +a x ×0.1, so the X-direction position at time t+1 is x=x+(v x +a x ×0.1)×0.1, and then update the X-direction speed to the speed at time t+1. Similarly, calculate the speed and X-direction position at times t+2, t+3, ..., t+n. Similarly, the Y-direction position can be predicted.

[0060] Step S213, based on the Kalman filter model, the trajectory of the target vehicle in the future preset time is predicted according to the speed and acceleration of the target vehicle to obtain a second future trajectory, for example, a trajectory in the next 3 seconds, including 30 predicted trajectory point coordinates; specifically, Kalman filtering is an algorithm that uses a linear system state equation to optimally estimate the system state through system input and output observation data. In this embodiment, the speed and acceleration of the target vehicle are used as observation data;

[0061] Step S214: weighted smoothing the first future trajectory and the second future trajectory to obtain the future trajectory of the target vehicle.

[0062] Specifically, this embodiment combines two rule models, the kinematic model and the Kalman filter model, and performs weighted smoothing on the prediction results of the two rule models to obtain the future trajectory of the target vehicle, which can improve the reliability of the prediction results, effectively alleviate the noise and time-space jitter problems in the perception results, and improve the generalization and robustness of the algorithm.

[0063] In some embodiments, the step S211 specifically includes:

[0064] Calculating a first speed and a first acceleration of the target vehicle according to the historical trajectory information, and obtaining a second speed and a second acceleration of the target vehicle detected by the vehicle perception module;

[0065] The speed of the target vehicle is obtained by weighted summing the first speed and the second speed, and the acceleration of the target vehicle is obtained by weighted summing the first acceleration and the second acceleration, as shown in the following formula:

[0066] v=0.5×v s +0.5×v P

[0067] a=0.5×a s +0.5×a p

[0068] Among them, v is the final speed of the target vehicle, a is the final acceleration of the target vehicle, and v is the final acceleration of the target vehicle. s is the first speed, v P is the second speed, a s is the first acceleration, a p is the second acceleration;

[0069] Specifically, the speed v calculated based on the historical trajectory information in this embodiment s , acceleration a s , and the speed v directly output by the ego vehicle perception module P , acceleration a pPerforming weighted summation to obtain the speed v and acceleration a of the target vehicle can further effectively alleviate the noise and time-space jitter problems existing in the perception results and improve the generalization and robustness of the algorithm.

[0070] In some embodiments, the step S211 calculates the first speed and the first acceleration of the target vehicle according to the historical trajectory information, specifically including:

[0071] Step a, based on the least squares method, fitting a quadratic polynomial function according to the multiple historical position coordinates and their corresponding time; wherein the input of the quadratic polynomial function is the time, and the output is the horizontal coordinate or the vertical coordinate;

[0072] Specifically, the formula for the quadratic polynomial function is as follows:

[0073] x=a1t 2 +b1t+c1

[0074] y=a2t 2 +b2t+c2

[0075] Substituting the multiple historical position coordinates and their corresponding time points into the formula of the quadratic polynomial function, the parameters a1, b1, c1, a2, b2, and c2 of the quadratic polynomial function can be solved.

[0076] Step b, resampling the time at a preset frequency to obtain the latest m moments; m is a preset value;

[0077] Specifically, the 10 nearest neighbor moments can be sampled at a fixed frequency of 10 Hz, that is, m = 10;

[0078] Step c, calculating the horizontal coordinates and vertical coordinates corresponding to the m moments according to the m moments and the fitted quadratic polynomial function, and obtaining the historical trajectory according to the horizontal coordinates and vertical coordinates corresponding to the m moments;

[0079] Specifically, by substituting the m moments into the fitted quadratic polynomial function, the abscissa and ordinate corresponding to the m moments can be calculated.

[0080] Step d: calculating a first speed and a first acceleration of the target vehicle according to the historical trajectory.

[0081] Specifically, in the fitted historical trajectory, the time difference between two points has been fixed to 0.1s. The first velocity v can be calculated by the distance and time between the two points using the formula of the kinematic model. s With the first acceleration a s .

[0082] In some embodiments, the step S10 specifically includes:

[0083] Step S11, fitting a circle according to the plurality of historical position coordinates and a least squares fitting circle function;

[0084] Specifically, the least squares method fits the circular function as follows:

[0085] (x) 2 +(yb) 2 =r 2

[0086] Wherein, x is the horizontal coordinate of the historical position coordinate of the target vehicle, and y is the vertical coordinate of the historical position coordinate of the target vehicle;

[0087] Step S12: if the radius of the fitted circle is greater than a preset first threshold, it is determined that the movement scene of the target vehicle is straight or lane change; if the radius of the fitted circle is less than or equal to the preset first threshold, the movement scene of the target vehicle is turning or U-turn;

[0088] Specifically, this embodiment infers the target vehicle motion scene based on the radius r of the fitted circular function, and the first threshold is 100.

[0089] In some embodiments, the step S10 further includes:

[0090] Before determining the motion scene of the target vehicle according to the historical trajectory information, determine whether to predict the future trajectory of the target vehicle. When the number of historical position coordinates of the target vehicle obtained is less than a preset second threshold, the future trajectory of the target vehicle is not predicted, because the motion scene of the target vehicle cannot be accurately determined if the number of historical position coordinates is too small. When the number of historical position coordinates of the target vehicle obtained is greater than or equal to the preset second threshold, the motion scene of the target vehicle is determined according to the historical trajectory information, and the future trajectory of the target vehicle is predicted according to the motion scene of the target vehicle. The preset second threshold is, for example, 20.

[0091] In some embodiments, in order to facilitate the management of the perception information output by the vehicle perception module (including historical trajectory information, lane line information, vehicle posture information, etc.), before executing step S10, the method further includes:

[0092] Create a historical trajectory cache queue for each target vehicle to cache the historical trajectory information of the target vehicle. Each element of the historical trajectory cache queue includes the trajectory ID, the corresponding time, and the position coordinates in the world coordinate system;

[0093] Create a lane line cache queue for each lane line to cache lane line information, including lane line ID, position point set in the world coordinate system, and lane line attribute information;

[0094] Create an RTK information cache queue to cache the vehicle's position information (for coordinate transformation), including the corresponding time, position information, and orientation information.

[0095] During the trajectory prediction process, the perception information output by the ego vehicle perception module is cached and updated based on the created historical trajectory cache queue, lane line cache queue, and RTK information cache queue;

[0096] Among them, see Figure 2 , the update of the historical track cache queue is as follows:

[0097] When a new perception information (new element) is received, the trajectory perception information first obtains the corresponding trajectory id. If the historical trajectory cache queue corresponding to the trajectory id already exists and the historical trajectory cache queue is not full, the new element is inserted into the head; if the historical trajectory cache queue corresponding to the trajectory id already exists and the historical trajectory cache queue is full, the tail element of the queue is removed first, and then the new element is inserted into the head; if the historical trajectory cache queue corresponding to the trajectory id does not exist, a new cache queue corresponding to the trajectory id is created and the new element is inserted into the head; generally speaking, the ego vehicle perception module will detect all target vehicles within the ego vehicle detection range and output the corresponding trajectory information. If all historical trajectory cache queues are traversed, if the trajectory id of the historical trajectory cache queue does not appear in the received new trajectory perception message, the cache queue will be judged as expired data and deleted.

[0098] Among them, see Figure 2 , the lane line cache queue is updated as follows:

[0099] When a new perception information (new element) is received, the trajectory perception information first obtains the corresponding lane line id. If the lane line cache queue corresponding to the lane line id already exists and the lane line cache queue is not full, the new element is inserted into the opposite end; if the lane line cache queue corresponding to the lane line id already exists and the lane line cache queue is full, the element at the tail of the queue is removed first, and then the new element is inserted into the opposite end; if the lane line cache queue corresponding to the lane line id does not exist, a new cache queue corresponding to the lane line id is created and the new element is inserted into the opposite end; generally speaking, the ego vehicle perception module will detect all target vehicles within the ego vehicle detection range and output the corresponding lane line information. If all lane line cache queues are traversed, if the lane line id of the lane line cache queue does not appear in the new trajectory perception message received, the cache queue will be judged as expired data and deleted.

[0100] The update of the RTK information cache queue is specifically as follows:

[0101] When a new vehicle position information (new element) is received, the new element is inserted into the head of the queue if the RTK information cache queue is not full; when the RTK information cache queue is full, the data at the tail of the queue is removed first, and then the new element is inserted into the head of the queue; specifically, the number of caches in the RTK cache queue can be set to 200.

[0102] In some embodiments, obtaining a multi-channel image according to the historical trajectory information and lane line information in step S20 specifically includes:

[0103] The multiple historical position coordinates are interpolated to obtain a historical trajectory, and n historical trajectory points are resampled from the historical trajectory at a preset frequency; n is a preset value; and a multi-channel image is generated according to the n historical trajectory points and the lane line information.

[0104] For example, quadratic spline interpolation can be performed on the multiple historical position coordinates, and 10 historical trajectory points (constituting the historical trajectory) can be resampled at a fixed frequency of 10 Hz, that is, n=10; further, SG filtering (Savitzky-GolayFilter) can be performed on the historical trajectory to smooth the trajectory misalignment and jitter problems existing in the perceived input; based on the MotionCNN scheme, the historical trajectory and lane lines are rendered into multi-channel images; for example, the rendered image size is 224×224×23, the lane line rendering image size is 224×224×3, the target vehicle historical trajectory rendering image size is 224×224×10, and the surrounding vehicle historical trajectory rendering image size in the same scene is 224×224×10; the rendered multi-channel image is input into a trained deep convolutional neural network for trajectory prediction, and the corresponding predicted trajectory is output.

[0105] In some embodiments, when generating the multi-channel image, traffic light information at the intersection can also be added, and the historical trajectory, lane lines, and traffic lights at the intersection can be rendered into a multi-channel image, which is then input into a deep convolutional neural network for trajectory prediction, and the corresponding predicted trajectory is output, for example Figure 3 As shown in the vehicle trajectory prediction method flow chart, in this embodiment, the first threshold is set to 100, the second threshold is set to 20, the perception module of the vehicle performs 3D object detection and tracking, lane line and traffic light detection, outputs corresponding perception information, and caches and updates the perception information according to the perception information output by the perception module of the vehicle ( Figure 2Further, when the historical trajectory length is greater than 20 (the second threshold), the least squares method is used to fit the circular function. If the radius of the fitted circle is greater than 100 (the first threshold), it is determined that the target vehicle is in a straight / lane change scenario. If the radius of the fitted circle is less than or equal to 100 (the first threshold), it is determined that the target vehicle is in a turning / U-turn scenario. In different scenarios, different prediction strategies are used to predict the future trajectory of the target vehicle and then output it.

[0106] See also Figure 4 Another embodiment of the present application further provides a vehicle trajectory prediction device, comprising a module for executing the vehicle trajectory prediction method as described above, wherein the module comprises:

[0107] An information acquisition module, used to acquire historical track information of a target vehicle and determine a movement scene of the target vehicle according to the historical track information;

[0108] A trajectory prediction module is used to predict the future trajectory of the target vehicle according to the motion scene; when the motion scene is straight driving or lane change, the future trajectory of the target vehicle is predicted according to the historical trajectory information and a preset rule model; when the motion scene is turning or U-turning, lane line information is obtained, a multi-channel image is obtained according to the historical trajectory information and lane line information, and the multi-channel image is input into a pre-trained deep learning neural network for processing to predict the future trajectory of the target vehicle.

[0109] It should be noted that the vehicle trajectory prediction device of the above-mentioned embodiment corresponds to the vehicle trajectory prediction method of the above-mentioned embodiment. Therefore, the undescribed part of the vehicle trajectory prediction device of the above-mentioned embodiment can be obtained by referring to the content of the vehicle trajectory prediction method of the above-mentioned embodiment, that is, the specific steps recorded in the vehicle trajectory prediction method of the above-mentioned embodiment can be understood as the functions that can be realized by the information acquisition module and the trajectory prediction module of the above-mentioned embodiment, which will not be repeated here.

[0110] Furthermore, if the vehicle trajectory prediction device of the above embodiment is implemented in the form of a software function module and sold or used as an independent product, it can be stored in a computer-readable storage medium.

[0111] Another embodiment of the present application further proposes a computer-readable storage medium, wherein the computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the vehicle trajectory prediction method as described in the above embodiment is implemented.

[0112] Specifically, the computer-readable storage medium may include: any entity or recording medium that can carry the computer program instructions, a USB flash drive, a mobile hard disk, a magnetic disk, an optical disk, a computer memory, a read-only memory (ROM), a random access memory (RAM), an electrical carrier signal, a telecommunication signal, and a software distribution medium, etc.

[0113] Another embodiment of the present application provides an electronic device, including a processor, a memory, and a computer program stored in the memory and executable on the processor, wherein the processor implements the vehicle trajectory prediction method described in the above embodiment when executing the program.

[0114] Wherein, the electronic device may also include a bus connecting different components (including memory and processor). The memory may include a computer-readable medium in the form of a volatile memory, such as a random access memory (RAM) and / or a cache memory. The memory may also include at least one program product, which has a set of (e.g., at least one) program modules, which are configured to perform the functions of the various embodiments of the present application. The electronic device may also communicate with one or more external devices (e.g., keyboards, pointing devices, displays, etc.), may also communicate with one or more devices that enable a user to interact with the electronic device, and / or communicate with any device (e.g., a network card) that enables the electronic device to communicate with one or more other computing devices, such communication may be performed through an input / output (I / O) interface, and the electronic device may also communicate with one or more networks (e.g., local area networks (LANs), wide area networks (WANs) and / or public networks, such as the Internet) through a network adapter.

[0115] The embodiments of the present application have been described above, and the above description is exemplary, not exhaustive, and is not limited to the disclosed embodiments. Many modifications and changes will be apparent to those of ordinary skill in the art without departing from the scope and spirit of the described embodiments. The selection of terms used herein is intended to best explain the principles of the embodiments, practical applications, or technical improvements in the market, or to enable other persons of ordinary skill in the art to understand the embodiments disclosed herein.

Claims

1. A vehicle trajectory prediction method, characterized in that: The method comprises: Acquire historical trajectory information of the target vehicle, and determine the movement scene of the target vehicle according to the historical trajectory information; the historical trajectory information includes multiple historical position coordinates of the target vehicle in the world coordinate system and their corresponding moments; the historical position coordinates include a horizontal coordinate and a vertical coordinate; The future trajectory of the target vehicle is predicted according to the motion scene; when the motion scene is straight driving or lane change, the future trajectory of the target vehicle is predicted according to the historical trajectory information and a preset rule model; when the motion scene is turning or making a U-turn, lane line information is obtained, a multi-channel image is obtained according to the historical trajectory information and the lane line information, and the multi-channel image is input into a pre-trained deep learning neural network for processing to predict the future trajectory of the target vehicle.

2. The method according to claim 1, characterized in that The predicting the future trajectory of the target vehicle according to the historical trajectory information and a preset rule model specifically includes: Acquire the speed and acceleration of the target vehicle according to the historical trajectory information; Based on the kinematic model, predicting the trajectory of the target vehicle within a preset future time according to the speed and acceleration of the target vehicle to obtain a first future trajectory; Based on the Kalman filter model, the trajectory of the target vehicle within a preset future time is predicted according to the speed and acceleration of the target vehicle to obtain a second future trajectory; The first future trajectory and the second future trajectory are weighted and smoothed to obtain the future trajectory of the target vehicle.

3. The method according to claim 2, characterized in that The obtaining the speed and acceleration of the target vehicle according to the historical trajectory information specifically includes: Calculating a first speed and a first acceleration of the target vehicle according to the historical trajectory information, and obtaining a second speed and a second acceleration of the target vehicle detected by the vehicle perception module; The speed of the target vehicle is obtained by weighted summing of the first speed and the second speed, and the acceleration of the target vehicle is obtained by weighted summing of the first acceleration and the second acceleration.

4. The method according to claim 3, characterized in that The calculating the first speed and the first acceleration of the target vehicle according to the historical trajectory information specifically includes: Based on the least squares method, a quadratic polynomial function is fitted according to the multiple historical position coordinates and their corresponding times; wherein the input of the quadratic polynomial function is the time, and the output is the horizontal coordinate or the vertical coordinate; Time resampling is performed at a preset frequency to obtain the latest m moments; m is a preset value; Calculate the horizontal coordinates and vertical coordinates corresponding to the m moments according to the m moments and the fitted quadratic polynomial function, and obtain the historical trajectory according to the horizontal coordinates and vertical coordinates corresponding to the m moments; A first speed and a first acceleration of the target vehicle are calculated according to the historical trajectory.

5. The method according to claim 1, characterized in that Determining the movement scene of the target vehicle according to the historical trajectory information specifically includes: Fitting a circle according to the plurality of historical position coordinates and a least squares fitting circle function; If the radius of the fitted circle is greater than a preset first threshold, it is determined that the movement scene of the target vehicle is straight driving or lane changing; if the radius of the fitted circle is less than or equal to the preset first threshold, the movement scene of the target vehicle is turning or U-turn.

6. The method according to claim 5, characterized in that The determining the movement scene of the target vehicle according to the historical trajectory information specifically includes: When the number of historical position coordinates of the target vehicle obtained is less than a preset second threshold, the future trajectory of the target vehicle is not predicted; When the number of acquired historical position coordinates of the target vehicle is greater than or equal to a preset second threshold, the future trajectory of the target vehicle is predicted.

7. The method according to claim 1, characterized in that The obtaining of a multi-channel image according to the historical trajectory information and the lane line information specifically includes: Interpolating the multiple historical position coordinates to obtain a historical trajectory, and resampling n historical trajectory points of the historical trajectory at a preset frequency; n is a preset value; A multi-channel image is generated according to the n historical trajectory points and the lane line information.

8. A vehicle trajectory prediction device, characterized in that: The invention comprises a module for executing the vehicle trajectory prediction method according to any one of claims 1 to 7.

9. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the vehicle trajectory prediction method according to any one of claims 1 to 7 is implemented.

10. An electronic device comprising a processor, a memory, and a computer program stored in the memory and executable on the processor, characterized in that: When the processor executes the computer program, the vehicle trajectory prediction method according to any one of claims 1 to 7 is implemented.

Citation Information

Patent Citations

  • Obstacle trajectory prediction based auxiliary driving method and system

    CN109927719A

  • Vehicle trajectory prediction method and device based on historical information and storage medium

    CN110908379A

  • Vehicle trajectory prediction method and system based on automatic driving, vehicle and computer readable storage medium

    CN114426032A

  • Deep Learning-based Vehicle Trajectory Prediction Method and Apparatus using Rasterized Lane Information

    KR102176483B1

  • Trajectory prediction method and related device

    WO2021134169A1

Cited By

  • Trajectory prediction method, device, equipment, vehicle, medium and product

    CN121777978A

  • Trajectory prediction method, device, equipment, vehicle, medium and product

    CN121777978B