Track generation method and device, equipment, program product and storage medium

By determining reference points and angles from turn signals and calculating lateral deviation, the method improves the accuracy of vehicle trajectory generation to reflect driving paths and road conditions during lane changes and turns.

CN119063737APending Publication Date: 2024-12-03DATANG GOHIGH INTELLIGENT & CONNECTED TECH (CHONGQING) CO LTD
View PDF 0 Cites 1 Cited by

Patent Information

Application Number
CN202411281915.4
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-09-13
Publication Date
2024-12-03

AI Technical Summary

Technical Problem

Existing trajectory generation methods struggle to accurately reflect vehicle driving paths and road conditions, particularly during lane changes and turns.

Method used

Determine the reference point and reference heading angle based on the vehicle's turn signal state, calculate lateral deviation, and add current position information to historical trajectory data when the deviation exceeds a threshold.

Benefits of technology

Accurately records vehicle trajectory points during lane changes and turns, enhancing the reflection of driving paths and road conditions.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119063737A_ABST
    Figure CN119063737A_ABST
Patent Text Reader

Abstract

The invention provides a track generation method, device and equipment, a program product and a storage medium, and relates to the technical field of Internet of Vehicles, and the method comprises the steps: determining a reference point and a reference course angle corresponding to a target vehicle according to the state of a steering lamp of the target vehicle; determining the lateral deviation of the target vehicle according to the reference point and the reference course angle; and under the condition that the lateral deviation is greater than a deviation threshold value, adding the information of the current position point of the target vehicle to historical track information corresponding to the target vehicle. The scheme of the invention solves the problem that the existing track generation method is difficult to accurately reflect the vehicle driving path and the road condition.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of vehicle networking technology, and in particular to a trajectory generation method, device, equipment, program product and storage medium. Background Art

[0002] The vehicle's historical trajectory information uses a reference trajectory point information and a series of trajectory record (Path History, PH) points based on the reference information to give a vehicle PH. The vehicle PH can truly reflect the vehicle's driving status at the time, and also indirectly reflect the road and traffic environment where the vehicle was at the time.

[0003] That is, PH can use a series of concise data to characterize the real path of the vehicle, and the concise data is essentially a sampled subset of the real data. Figure 1 As shown in the figure, the solid line path points represent the real data, the dotted line path points represent the concise path points after sampling, and the box represents the current position of the vehicle. The principle of sampling concise path points is: the vertical distance (H1) from any point on the real path to the chord length between two points is less than the threshold.

[0004] The historical trajectory sequence recorded by the above rules can accurately reflect the road conditions when the vehicle passes through a curve with a larger angle. However, when the vehicle is driving on a ramp with a smaller angle or when the vehicle changes lanes, the historical trajectory sequence recorded by the above rules is difficult to accurately reflect the road and traffic conditions when the vehicle is driving. Summary of the invention

[0005] The present invention provides a trajectory generation method, device, equipment, program product and storage medium, which solves the problem that the existing trajectory generation method is difficult to accurately reflect the vehicle driving path and road conditions.

[0006] In a first aspect, an embodiment of the present invention provides a trajectory generation method, comprising:

[0007] Determine the reference point and reference heading angle corresponding to the target vehicle according to the state of the turn signal lamp of the target vehicle;

[0008] Determining the lateral deviation of the target vehicle according to the reference point and the reference heading angle;

[0009] When the lateral deviation is greater than a deviation threshold, information about the current position of the target vehicle is added to historical trajectory information corresponding to the target vehicle.

[0010] In a second aspect, an embodiment of the present invention provides a trajectory generating device, comprising:

[0011] A first processing module, used for determining a reference point and a reference heading angle corresponding to the target vehicle according to a state of a turn signal lamp of the target vehicle;

[0012] A second processing module, used for determining the lateral deviation of the target vehicle according to the reference point and the reference heading angle;

[0013] The first updating module is used to add the information of the current position point of the target vehicle to the historical trajectory information corresponding to the target vehicle when the lateral deviation is greater than the deviation threshold.

[0014] In a third aspect, an embodiment of the present invention provides a device, including: a transceiver, a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein when the processor executes the computer program, the steps of the trajectory generation method described in the first aspect are implemented.

[0015] In a fourth aspect, an embodiment of the present invention provides a computer program product, comprising computer instructions, which implement the steps of the above method when executed by a processor.

[0016] In a fifth aspect, an embodiment of the present invention provides a computer-readable storage medium having a computer program stored thereon, and when the computer program is executed by a processor, the steps of the trajectory generation method described in the first aspect are implemented.

[0017] The beneficial effects of the above technical solution of the present invention are:

[0018] In the embodiment of the present invention, according to the state of the turn signal of the target vehicle, the reference point and reference heading angle corresponding to the target vehicle are determined, and the lateral deviation of the target vehicle is further determined according to the reference point and the reference heading angle. When the lateral deviation is greater than the deviation threshold, the information of the current position point of the target vehicle is added to the historical trajectory information corresponding to the target vehicle. In this way, the trajectory points of the target vehicle when changing lanes and turning can be recorded, and the obtained trajectory can accurately reflect the vehicle's driving path and road conditions. BRIEF DESCRIPTION OF THE DRAWINGS

[0019] Figure 1 A schematic diagram showing the simplified path and the actual path in the prior art;

[0020] Figure 2 A flow chart showing a trajectory generation method according to an embodiment of the present invention;

[0021] Figure 3 A flowchart showing the recording of historical track information according to an embodiment of the present invention;

[0022] Figure 4 A structural block diagram showing a trajectory generating device according to an embodiment of the present invention;

[0023] Figure 5 A block diagram showing the structure of a device according to an embodiment of the present invention. DETAILED DESCRIPTION

[0024] In order to make the technical problems, technical solutions and advantages to be solved by the present invention clearer, the following will be described in detail in conjunction with the accompanying drawings and specific embodiments. In the following description, specific details such as specific configurations and components are provided only to help fully understand the embodiments of the present invention. Therefore, it should be clear to those skilled in the art that various changes and modifications can be made to the embodiments described herein without departing from the scope and spirit of the present invention. In addition, for clarity and brevity, the description of known functions and structures is omitted.

[0025] It should be understood that the references to "one embodiment" or "an embodiment" throughout the specification mean that the specific features, structures, or characteristics associated with the embodiment are included in at least one embodiment of the present invention. Therefore, the references to "in one embodiment" or "in an embodiment" appearing throughout the specification do not necessarily refer to the same embodiment. In addition, these specific features, structures, or characteristics may be combined in any suitable manner in one or more embodiments.

[0026] In various embodiments of the present invention, it should be understood that the size of the serial numbers of the following processes does not mean the order of execution. The execution order of each process should be determined by its function and internal logic, and should not constitute any limitation on the implementation process of the embodiments of the present invention.

[0027] Additionally, the terms "system" and "network" are often used interchangeably herein.

[0028] In the embodiments provided in the present application, it should be understood that "B corresponding to A" means that B is associated with A, and B can be determined according to A. However, it should also be understood that determining B according to A does not mean determining B only according to A, and B can also be determined according to A and / or other information.

[0029] In the embodiment of the present invention, the form of the access network is not limited, and may be an access network including a macro base station (Macro Base Station), a micro base station (Pico Base Station), a Node B (the name of a 3G mobile base station), an enhanced base station (eNB), a home enhanced base station (Femto eNB or Home eNode B or Home eNB or HeNB), a relay station, an access point, an RRU (Remote Radio Unit), an RRH (Remote Radio Head), etc. The user terminal may be a mobile phone (or mobile phone), or other equipment capable of sending or receiving wireless signals, including user equipment, a personal digital assistant (PDA), a wireless modem, a wireless communication device, a handheld device, a laptop computer, a cordless phone, a wireless local loop (WLL) station, a CPE (Customer Premise Equipment) capable of converting a mobile signal into a WiFi signal, or a mobile smart hotspot, a smart home appliance, or other equipment that can spontaneously communicate with a mobile communication network without human operation.

[0030] Related technology introduction:

[0031] Vehicle-to-Everything (V2X) is a communication method for vehicles to exchange information with the outside world, including: direct communication between vehicles (Vehicle-to-Vehicle, V2V), communication between vehicles and pedestrians (Vehicle-to-Pedestrian, V2P), communication between vehicles and road infrastructure (Vehicle-to-Infrastructure, V2I), and communication between vehicles and the cloud through mobile networks (Vehicle-to-Network, V2N). Among them, V2X is a key technology for future intelligent transportation systems, which can effectively obtain a series of traffic information such as real-time road conditions, road information and pedestrian information, thereby improving driving safety, reducing congestion and improving traffic efficiency.

[0032] In the current industry, the information exchange between vehicles and the outside world is generally achieved through Cellular-Vehicle to Everything (C-V2X) based on cellular technology. The host vehicle (Host Vehicle) receives the Basic Safety Message (BSM) (including the vehicle's position, speed, acceleration, steering and driving direction, etc.) sent by other vehicles, combined with the MAP (map) sent by the Road Side Unit (RSU), to calculate the collision risk. When calculating the collision risk, it is usually necessary to predict the vehicle's trajectory, and trajectory prediction often requires reference to the vehicle's historical trajectory information, but the existing trajectory generation method is difficult to accurately reflect the vehicle's driving path and road conditions.

[0033] Specifically, the embodiments of the present invention provide a trajectory generation method, apparatus, device, program product and storage medium, which solve the problem that the existing trajectory generation method is difficult to accurately reflect the vehicle driving path and road conditions.

[0034] First embodiment

[0035] like Figure 2 As shown, an embodiment of the present invention provides a trajectory generation method, which specifically includes the following steps:

[0036] Step 21: According to the state of the turn signal lamp of the target vehicle, determine the reference point and reference heading angle corresponding to the target vehicle.

[0037] It should be noted that the state of the turn signal includes a lit state and an off state. When the driver turns on the left turn signal, the left turn signal becomes lit, and when the driver turns on the right turn signal, the right turn signal becomes lit. As the steering wheel returns to the center or the driver manually resets the turn signal lever, the turn signal will become off. In step 21, how to determine the reference point and the reference heading angle can be determined by monitoring the state of the turn signal of the target vehicle.

[0038] Step 22: Determine the lateral deviation of the target vehicle based on the reference point and the reference heading angle.

[0039] Here, the lateral deviation of the target vehicle is calculated according to the reference point and the reference heading angle selected in step 21, so that a more accurate lateral deviation value can be obtained.

[0040] Step 23: When the lateral deviation is greater than the deviation threshold, the information of the current position point of the target vehicle is added to the historical trajectory information corresponding to the target vehicle.

[0041] It should be noted that the reference point is first confirmed based on the change in the turn signal state when the vehicle is driving, and then the lateral offset (lateral deviation) of the vehicle is calculated based on the reference point to determine whether it is necessary to record the current location of the target vehicle. When the lateral deviation is greater than the deviation threshold, it means that the vehicle may have changed lanes or turned. At this time, the historical trajectory information corresponding to the target vehicle should be updated to record the trajectory points that can accurately reflect the vehicle's driving path and road conditions. In this way, the historical trajectory information obtained can more completely express the driving path and road characteristics of the target vehicle.

[0042] Here, the historical trajectory information corresponding to the target vehicle is the historical trajectory sequence of the target vehicle, which includes information of at least one trajectory point (that is, relevant information when the target vehicle is at a certain position point). For example, the historical trajectory information may specifically include at least one of the following information of the trajectory point: timestamp, lat (latitude), long (longitude), speed (vehicle speed), heading (vehicle heading angle), angle (vehicle steering wheel angle), lights (vehicle body lighting status), accelSet (vehicle four-axis acceleration), transmission (vehicle gear status), etc.

[0043] It should be noted that the trajectory generation method of the present invention can be executed by an on-board unit (OBU), which can periodically record the historical trajectory information of the vehicle and broadcast the historical trajectory of the vehicle as part of the BSM message to other V2X devices through PC5. In this way, the historical trajectory information can provide sufficient information to other vehicles to support the implementation of related algorithms (such as trajectory prediction, etc.).

[0044] In this embodiment, according to the state of the turn signal of the target vehicle, the reference point and reference heading angle corresponding to the target vehicle are determined, and the lateral deviation of the target vehicle is further determined according to the reference point and the reference heading angle. When the lateral deviation is greater than the deviation threshold, the information of the current position point of the target vehicle is added to the historical trajectory information corresponding to the target vehicle. In this way, the trajectory points of the target vehicle when changing lanes and turning can be recorded, and the obtained trajectory can accurately reflect the vehicle's driving path and road conditions.

[0045] In some embodiments, step 21, determining the reference point and reference heading angle corresponding to the target vehicle according to the state of the turn signal lamp of the target vehicle, includes:

[0046] Acquire the position information of a first position point where the target vehicle is currently located; determine a first distance between the first position point and a first historical trajectory point according to the position information of the first position point and the historical trajectory information, wherein the first historical trajectory point is: a historical trajectory point closest to the time corresponding to the first position point among at least one historical trajectory point of the historical trajectory information; when the first distance is less than or equal to a chord length threshold, determine a target chord error according to the position information of the first position point and the position information of the first historical trajectory point, wherein the target chord error is a vertical distance between a position point on a first driving path and a target line, wherein the first driving path is a path taken by the target vehicle from the first historical trajectory point to the first position point, and the target line is a line between the first historical trajectory point and the first position point; when the target chord error is less than or equal to the error threshold, determine a reference point and a reference heading angle corresponding to the target vehicle according to the state of a turn signal of the target vehicle.

[0047] It should be noted that there may be multiple position points on the first driving path, and the vertical distances between the multiple position points and the target line can be calculated respectively to obtain the chord error corresponding to each position point. Further, these chord errors can be used as target chord errors and compared with the error threshold, or the largest one can be selected from these chord errors as the target chord error, and the target chord error can be compared with the error threshold. Here, the target chord error is compared with the error threshold, that is, it is determined whether the target chord error is less than or equal to the error threshold.

[0048] In this embodiment, before determining the reference point and reference heading angle corresponding to the target vehicle according to the state of the turn signal of the target vehicle, the first distance and the target chord error may be calculated and compared with the corresponding thresholds. If the first distance is less than or equal to the chord length threshold, and the target chord error is less than or equal to the error threshold, the reference point and reference heading angle corresponding to the target vehicle are determined according to the state of the turn signal of the target vehicle; otherwise, the historical track information is updated, that is, the information of the second position point is added to the historical track information.

[0049] Specifically, in some embodiments, the method further includes: when the first distance is greater than a chord length threshold or the target chord error is greater than an error threshold, adding information of a second position point to the historical trajectory information, the second position point being the position point where the target vehicle was located at a previous moment before the first position point was located.

[0050] In other words, as long as the first distance is greater than the chord length threshold, or the vertical distance between a position point on the first driving path and the target line is greater than the error threshold, it indicates that the driving state of the target vehicle has changed significantly since the last update of the historical trajectory information. It may be that the driving direction of the target vehicle has changed significantly, or it may be that the target vehicle has traveled a long distance. The information of the second position point can be added to the historical trajectory information.

[0051] In some other embodiments, step 21, determining the reference point and reference heading angle corresponding to the target vehicle according to the state of the turn signal lamp of the target vehicle, includes at least one of the following:

[0052] (1) When the first target condition is met, the first historical trajectory point is determined as the reference point, and the heading angle of the first historical trajectory point is determined as the reference heading angle; the first historical trajectory point is: the historical trajectory point closest to the time corresponding to the current location of the target vehicle among at least one historical trajectory point of the historical trajectory information. The first target condition includes at least one of the following: (1) the state of the turn signal has not undergone the first change; (2) the state of the turn signal has undergone the first change, and the value of the first angle is greater than or equal to the angle threshold. The first angle is the angle between the current heading of the target vehicle and the heading of the target vehicle at the first historical trajectory point; the first change is from an off state to a lit state.

[0053] (ii) When a second target condition is met, the current position of the target vehicle is determined as the reference point, and the heading angle of the current position of the target vehicle is determined as the reference heading angle; wherein the second target condition includes: a first change occurs in the state of the turn signal and the value of the first angle is less than an angle threshold.

[0054] In this embodiment, the method of determining the reference point and the reference heading angle can be selected according to whether the state of the turn signal lamp has undergone the first change and the size of the first angle. In this way, a more accurate reference point and reference heading angle can be obtained as a reference, so that a more accurate lateral deviation value can be obtained later, thereby more accurately determining whether the historical track information needs to be updated to avoid adding redundant track points.

[0055] In some embodiments, when the first historical track point is determined as the reference point and the heading angle of the first historical track point is determined as the reference heading angle, step 22, determining the lateral deviation of the target vehicle according to the reference point and the reference heading angle, includes:

[0056] Determine whether a second change has occurred in the state of the turn signal, the second change being from the lit state to the off state; if it is determined that the second change has not occurred in the state of the turn signal, determine the lateral deviation of the target vehicle based on the reference point and the reference heading angle.

[0057] That is to say, if the heading angle of the first historical track point is determined as the reference heading angle, it is possible to continue to determine whether the state of the turn signal has undergone a second change, in order to determine whether it is necessary to determine an erroneous operation. If the state of the turn signal has not undergone the second change, it is not necessary to determine an erroneous operation, and the lateral deviation can be determined based on the reference point; if the state of the turn signal has undergone a second change, it is necessary to determine an erroneous operation.

[0058] Specifically, regarding misoperation, in some embodiments, the method further includes:

[0059] (1) When it is determined that the state of the turn signal lamp undergoes the second change, determining whether there is an erroneous operation.

[0060] It should be noted that in order to accurately reflect the vehicle's driving path and road conditions with relatively concise trajectory points, the present invention adds misoperation judgment, so as to avoid recording trajectory points that are not very useful in reflecting the vehicle's driving path and road conditions.

[0061] In some embodiments, the determining whether there is an erroneous operation includes:

[0062] (1) determining whether a target duration is greater than or equal to a duration threshold, wherein the target duration is the duration during which the turn signal lamp remains in the lighting state within a preset time period before the state of the turn signal lamp undergoes the second change.

[0063] It is understandable that if the target duration is less than the duration threshold, it means that the driver turned off the turn signal shortly after turning on the turn signal. In this case, it can be inferred that the driver turned on the turn signal by mistake and he actually had no intention of turning or changing lanes.

[0064] (2) When the target duration is greater than or equal to a duration threshold, determine whether the absolute value of the lateral acceleration of the target vehicle is greater than or equal to an acceleration threshold.

[0065] (3) When the absolute value of the lateral acceleration is greater than or equal to the acceleration threshold, it is determined that there is no erroneous operation.

[0066] Here, the lateral acceleration of the target vehicle is used to further determine whether there is any misoperation, effectively avoiding misjudgment.

[0067] It should be noted that, in some embodiments, if at least one of the following exists, it is determined that there is an erroneous operation:

[0068] (1) The target duration is less than the duration threshold;

[0069] (2) The target duration is greater than or equal to the duration threshold, and the absolute value of the lateral acceleration of the target vehicle is less than the acceleration threshold.

[0070] (ii) when it is determined that there is no misoperation, adding information of the location point where the target vehicle is located when the state of the turn signal undergoes the second change to the historical trajectory information.

[0071] It should be noted that, here, it is also possible to determine whether the position point at which the vehicle is located when the first change occurs has been added to the historical track information. If not, the position point at which the vehicle is located when the first change occurs is added to the historical track sequence. Here, the position point at which the vehicle is located when the first change occurs refers to: the vehicle position corresponding to the first change closest to the current moment of the vehicle.

[0072] In this embodiment, by judging wrong operation, it is possible to avoid recording trajectory points that are not very useful for reflecting the vehicle's driving path and road conditions.

[0073] In some other embodiments, step 22, determining the lateral deviation of the target vehicle according to the reference point and the reference heading angle, includes:

[0074] The reference point is used as the coordinate origin, and the heading corresponding to the reference heading angle is used as the x-axis direction to establish a vehicle body coordinate system; the vertical coordinate corresponding to the current position point of the target vehicle in the vehicle body coordinate system is determined; and the absolute value of the vertical coordinate is determined as the lateral deviation of the target vehicle.

[0075] like Figure 3 As shown, in a specific embodiment of the present invention, the trajectory generation method may specifically include the following steps:

[0076] Step 301: Calculate a first distance between a first position point where the vehicle is currently located and a first historical trajectory point (that is, the last trajectory point in the historical trajectory sequence of the vehicle), and determine whether the first distance is greater than a chord length threshold.

[0077] If yes, then execute step 310 to add the second position point (ie, the trajectory point of the vehicle at the last moment) to the historical trajectory sequence; if no, then execute step 302 .

[0078] Step 302: Calculate the target chord error (i.e., calculate the vertical distance between the position point on the first driving path and the target line), and determine whether the target chord error is greater than the error threshold. Here, the first driving path refers to the path that the vehicle travels from the last track point in the historical track sequence (i.e., the first historical track point) to the first position point where the vehicle is currently located.

[0079] If yes (that is, the target chord error is greater than the error threshold), step 310 is executed to add the trajectory point of the vehicle at the last moment (that is, the second position point) into the historical trajectory sequence; if no, step 303 is executed.

[0080] Step 303: Determine whether the turn signal lamp undergoes a first change (ie, changes from an off state to a lit state), that is, determine whether the main vehicle lamp state changes from going straight to turning left or right.

[0081] If yes, execute step 304; if no, execute step 305.

[0082] Step 304: Calculate a first angle between the first historical trajectory point (the last point in the historical trajectory sequence) and the heading of the vehicle's current trajectory point, and determine whether the first angle is less than an angle threshold.

[0083] If yes, go to step 305; if no, go to step 306.

[0084] Step 305: Take the current position of the vehicle as the reference point and its heading angle as the reference heading angle, and execute step 308.

[0085] Step 306: The last point in the historical trajectory sequence is used as a reference point, and the heading angle of the vehicle's current position point is used as a reference heading angle.

[0086] Step 307: Determine whether the turn signal lamp undergoes a second change (ie, changes from a lit state to an off state), that is, determine whether the main vehicle lamp state changes from turning left or right to going straight.

[0087] If yes, execute step 308, that is, make an erroneous operation judgment; otherwise, execute step 309.

[0088] Step 308: Determine the duration (i.e., target duration) of the main vehicle light state being the turn signal state, and determine whether the target duration is less than a duration threshold:

[0089] If yes, it is judged that there is an erroneous operation and the process ends;

[0090] If not (i.e. the target duration is greater than or equal to the duration threshold), it is further determined whether the absolute value of the lateral acceleration of the vehicle is less than the acceleration threshold:

[0091] If yes, it is judged that there is an erroneous operation and the process ends;

[0092] If not, then the trajectory point at the moment when the main vehicle light state changes from turning left or right to going straight (that is, the position point where the vehicle is located when the second change occurs) is added to the historical trajectory sequence.

[0093] Step 309: Use the reference point as the coordinate origin and the heading angle of the reference point as the x-axis direction to establish a vehicle body coordinate system, convert the vehicle's current trajectory point to the vehicle body coordinate system, and assume that the converted coordinates are {x0, y0}, then the lateral deviation = |y0|, and determine whether the lateral deviation is greater than the offset threshold.

[0094] If yes, then execute step 310 to add the current trajectory point of the vehicle into the historical trajectory sequence; if no, then end.

[0095] It should be noted that, before step 308 and step 309, it is also possible to determine whether the position point at which the vehicle is located when the first change occurs has been added to the historical trajectory sequence. If not, the position point at which the vehicle is located when the first change occurs is added to the historical trajectory sequence. Here, the position point at which the vehicle is located when the first change occurs refers to the vehicle position corresponding to the first change closest to the current moment of the vehicle.

[0096] In this way, by recording the two trajectory points corresponding to the start of turning on the turn signal and the return of the turn signal, the trajectory points of the vehicle changing lanes and turning can be recorded more accurately.

[0097] The trajectory generation method of the embodiment of the present invention can record the trajectory points of the target vehicle when it changes lanes and turns, and the obtained trajectory can accurately reflect the vehicle's driving path and road conditions.

[0098] Second embodiment

[0099] like Figure 4 As shown, an embodiment of the present invention provides a trajectory generating device 400, comprising:

[0100] The first processing module 401 is used to determine the reference point and reference heading angle corresponding to the target vehicle according to the state of the turn signal lamp of the target vehicle;

[0101] A second processing module 402 is used to determine the lateral deviation of the target vehicle according to the reference point and the reference heading angle;

[0102] The first updating module 403 is used to add the information of the current position point of the target vehicle to the historical trajectory information corresponding to the target vehicle when the lateral deviation is greater than the deviation threshold.

[0103] In this embodiment, according to the state of the turn signal of the target vehicle, the reference point and reference heading angle corresponding to the target vehicle are determined, and the lateral deviation of the target vehicle is further determined according to the reference point and the reference heading angle. When the lateral deviation is greater than the deviation threshold, the information of the current position point of the target vehicle is added to the historical trajectory information corresponding to the target vehicle. In this way, the trajectory points of the target vehicle when changing lanes and turning can be recorded, and the obtained trajectory can accurately reflect the vehicle's driving path and road conditions.

[0104] Optionally, the first processing module 401 includes:

[0105] A first acquisition submodule is used to acquire the position information of a first position point where the target vehicle is currently located;

[0106] a first processing submodule, configured to determine a first distance between the first position point and a first historical trajectory point according to the position information of the first position point and the historical trajectory information, wherein the first historical trajectory point is: a historical trajectory point closest to a time corresponding to the first position point among at least one historical trajectory point in the historical trajectory information;

[0107] a second processing submodule, for determining a target chord error according to the position information of the first position point and the position information of the first historical trajectory point when the first distance is less than or equal to the chord length threshold, wherein the target chord error is a vertical distance between the position point on the first driving path and a target line, the first driving path is a path taken by the target vehicle from the first historical trajectory point to the first position point, and the target line is a line between the first historical trajectory point and the first position point;

[0108] The third processing submodule is used to determine the reference point and reference heading angle corresponding to the target vehicle according to the state of the turn signal of the target vehicle when the target chord error is less than or equal to the error threshold.

[0109] Optionally, the first processing module 401 includes:

[0110] a fourth processing submodule, configured to, when the first target condition is met, determine the first historical track point as the reference point, and determine the heading angle of the first historical track point as the reference heading angle;

[0111] a fifth processing submodule, configured to, when the second target condition is met, determine the current position of the target vehicle as the reference point, and determine the heading angle of the current position of the target vehicle as the reference heading angle;

[0112] The first historical track point is: the historical track point closest to the time corresponding to the current position of the target vehicle among the at least one historical track point of the historical track information;

[0113] The first target condition includes at least one of the following:

[0114] The state of the turn signal lamp does not undergo a first change;

[0115] The state of the turn signal lamp undergoes the first change, and the value of the first angle is greater than or equal to the angle threshold;

[0116] The second target condition includes: a first change occurs to the state of the turn signal lamp and the value of the first angle is less than an angle threshold;

[0117] The first angle is the angle between the current heading of the target vehicle and the heading of the target vehicle at the first historical trajectory point;

[0118] The first change is from an off state to a lit state.

[0119] Optionally, the second processing module 402 includes:

[0120] a sixth processing submodule, configured to determine whether a second change occurs to the state of the turn signal lamp, the second change being from the on state to the off state;

[0121] The seventh processing submodule is used to determine the lateral deviation of the target vehicle according to the reference point and the reference heading angle when it is determined that the state of the turn signal has not undergone the second change.

[0122] Optionally, the second processing module 402 further includes:

[0123] An eighth processing submodule, configured to determine whether there is an erroneous operation when it is determined that the state of the turn signal lamp undergoes the second change;

[0124] The ninth processing submodule is used to add information of the location point where the target vehicle is located when the state of the turn signal undergoes the second change to the historical trajectory information when it is determined that there is no misoperation.

[0125] Optionally, the eighth processing submodule includes:

[0126] a first processing unit, configured to determine whether a target duration is greater than or equal to a duration threshold, wherein the target duration is the duration during which the turn signal lamp remains in the lighting state within a preset time period before the state of the turn signal lamp undergoes the second change;

[0127] a second processing unit, configured to determine whether an absolute value of a lateral acceleration of the target vehicle is greater than or equal to an acceleration threshold value when the target duration is greater than or equal to the duration threshold value;

[0128] The third processing unit is configured to determine that there is no erroneous operation when the absolute value of the lateral acceleration is greater than or equal to an acceleration threshold.

[0129] Optionally, the seventh processing submodule includes:

[0130] A fourth processing unit, configured to establish a vehicle body coordinate system by taking the reference point as a coordinate origin and the heading corresponding to the reference heading angle as an x-axis direction;

[0131] A fifth processing unit, used to determine the ordinate corresponding to the current position point of the target vehicle in the vehicle body coordinate system;

[0132] The sixth processing unit is used to determine the absolute value of the longitudinal coordinate as the lateral deviation of the target vehicle.

[0133] Optionally, the first processing module 401 further includes:

[0134] a tenth processing submodule, configured to add information of a second position point to the historical trajectory information when the first distance is greater than a chord length threshold or the target chord error is greater than an error threshold, wherein the second position point is a position point at which the target vehicle was located at a previous moment before the first position point.

[0135] The second embodiment of the present invention corresponds to the method of the first embodiment. All implementation means in the first embodiment are applicable to the embodiment of the trajectory generating device and can achieve the same technical effect.

[0136] Third embodiment

[0137] In order to better achieve the above goals, Figure 5 As shown, the third embodiment of the present invention further provides a device, including:

[0138] A processor 500; and a memory 520 connected to the processor 500 via a bus interface, the memory 520 being used to store programs and data used by the processor 500 when performing operations, and the processor 500 calling and executing the programs and data stored in the memory 520.

[0139] The transceiver 510 is connected to the bus interface and is used to receive and send data under the control of the processor 500; the processor 500 is used to read the program in the memory 520 to perform the following steps:

[0140] Determine the reference point and reference heading angle corresponding to the target vehicle according to the state of the turn signal lamp of the target vehicle;

[0141] Determining the lateral deviation of the target vehicle according to the reference point and the reference heading angle;

[0142] When the lateral deviation is greater than a deviation threshold, information about the current position of the target vehicle is added to historical trajectory information corresponding to the target vehicle.

[0143] In this embodiment, according to the state of the turn signal of the target vehicle, the reference point and reference heading angle corresponding to the target vehicle are determined, and the lateral deviation of the target vehicle is further determined according to the reference point and the reference heading angle. When the lateral deviation is greater than the deviation threshold, the information of the current position point of the target vehicle is added to the historical trajectory information corresponding to the target vehicle. In this way, the trajectory points of the target vehicle when changing lanes and turning can be recorded, and the obtained trajectory can accurately reflect the vehicle's driving path and road conditions.

[0144] Among them, Figure 5 In the embodiment, the bus architecture may include any number of interconnected buses and bridges, specifically one or more processors represented by processor 500 and various circuits of memory represented by memory 520 are linked together. The bus architecture may also link together various other circuits such as peripherals, voltage regulators, and power management circuits, which are well known in the art and are therefore not further described herein. The bus interface provides an interface. The transceiver 510 may be a plurality of components, namely, a transmitter and a transceiver, providing a unit for communicating with various other devices on a transmission medium. For different terminals, the user interface 530 may also be an interface capable of externally connecting to required internal devices, and the connected devices include but are not limited to a keypad, a display, a speaker, a microphone, a joystick, and the like. The processor 500 is responsible for managing the bus architecture and general processing, and the memory 520 may store data used by the processor 500 when performing operations.

[0145] Optionally, when determining the reference point and reference heading angle corresponding to the target vehicle according to the state of the turn signal lamp of the target vehicle, the processor 500 is specifically configured to:

[0146] Acquire the position information of the first position point where the target vehicle is currently located;

[0147] Determine, according to the position information of the first position point and the historical trajectory information, a first distance between the first position point and a first historical trajectory point, wherein the first historical trajectory point is: a historical trajectory point closest to a time corresponding to the first position point among at least one historical trajectory point in the historical trajectory information;

[0148] In the case where the first distance is less than or equal to the chord length threshold, determining a target chord error according to the position information of the first position point and the position information of the first historical trajectory point, the target chord error being the vertical distance between the position point on the first driving path and a target line, the first driving path being the path that the target vehicle travels from the first historical trajectory point to the first position point, and the target line being the line between the first historical trajectory point and the first position point;

[0149] When the target chord error is less than or equal to the error threshold, the reference point and reference heading angle corresponding to the target vehicle are determined according to the state of the turn signal lamp of the target vehicle.

[0150] Optionally, when determining the reference point and reference heading angle corresponding to the target vehicle according to the state of the turn signal lamp of the target vehicle, the processor 500 is specifically configured to perform at least one of the following:

[0151] In the case where the first target condition is met, determining the first historical track point as the reference point, and determining the heading angle of the first historical track point as the reference heading angle;

[0152] In the case where the second target condition is met, the current position point of the target vehicle is determined as the reference point, and the heading angle of the current position point of the target vehicle is determined as the reference heading angle;

[0153] The first historical track point is: the historical track point closest to the time corresponding to the current position of the target vehicle among the at least one historical track point of the historical track information;

[0154] The first target condition includes at least one of the following:

[0155] The state of the turn signal lamp does not undergo a first change;

[0156] The state of the turn signal lamp undergoes the first change, and the value of the first angle is greater than or equal to the angle threshold;

[0157] The second target condition includes: a first change occurs to the state of the turn signal lamp and the value of the first angle is less than an angle threshold;

[0158] The first angle is the angle between the current heading of the target vehicle and the heading of the target vehicle at the first historical trajectory point;

[0159] The first change is from an off state to a lit state.

[0160] Optionally, when the first historical trajectory point is determined as the reference point and the heading angle of the first historical trajectory point is determined as the reference heading angle, the processor 500, when determining the lateral deviation of the target vehicle according to the reference point and the reference heading angle, is specifically configured to:

[0161] Determining whether a second change occurs in the state of the turn signal lamp, the second change being from the lighting state to the off state;

[0162] When it is determined that the state of the turn signal lamp has not undergone the second change, the lateral deviation of the target vehicle is determined according to the reference point and the reference heading angle.

[0163] Optionally, the processor 500 is further configured to:

[0164] When it is determined that the state of the turn signal lamp undergoes the second change, determining whether there is an erroneous operation;

[0165] When it is determined that there is no misoperation, the information of the position point where the target vehicle is located when the state of the turn signal undergoes the second change is added to the historical trajectory information.

[0166] Optionally, when determining whether there is an erroneous operation, the processor 500 is specifically configured to:

[0167] Determining whether a target duration is greater than or equal to a duration threshold, the target duration being: the duration during which the turn signal lamp remains in the lighting state within a preset time period before the state of the turn signal lamp undergoes the second change;

[0168] When the target duration is greater than or equal to the duration threshold, determining whether the absolute value of the lateral acceleration of the target vehicle is greater than or equal to the acceleration threshold;

[0169] When the absolute value of the lateral acceleration is greater than or equal to the acceleration threshold, it is determined that there is no erroneous operation.

[0170] Optionally, when determining the lateral deviation of the target vehicle according to the reference point and the reference heading angle, the processor 500 is specifically configured to:

[0171] Taking the reference point as the coordinate origin and the heading corresponding to the reference heading angle as the x-axis direction, a vehicle body coordinate system is established;

[0172] Determine the ordinate corresponding to the current position of the target vehicle in the vehicle body coordinate system;

[0173] The absolute value of the ordinate is determined as the lateral deviation of the target vehicle.

[0174] Optionally, the processor 500 is further configured to:

[0175] When the first distance is greater than the chord length threshold or the target chord error is greater than the error threshold, information of a second position point is added to the historical trajectory information, where the second position point is the position point of the target vehicle at the previous moment before the first position point.

[0176] It should be noted that the above-mentioned device provided in the embodiment of the present invention can implement all the method steps implemented in the above-mentioned trajectory generation method embodiment, and can achieve the same technical effect. The parts and beneficial effects that are the same as those in the method embodiment will not be described in detail here.

[0177] The present application also provides a computer program product, including computer instructions, which, when executed by a processor, implement the above Figure 2 The various processes of the method embodiment shown can achieve the same technical effect, and will not be described again here to avoid repetition.

[0178] Those skilled in the art will understand that all or part of the steps to implement the above embodiments may be accomplished by hardware, or may be accomplished by instructing relevant hardware through a computer program, wherein the computer program includes instructions for executing part or all of the steps of the above method; and the computer program may be stored in a readable storage medium, and the storage medium may be any form of storage medium.

[0179] In addition, a specific embodiment of the present invention further provides a computer-readable storage medium on which a computer program is stored, and when the program is executed by a processor, the steps of the method in the first embodiment described above are implemented. The same technical effect can be achieved, and to avoid repetition, it will not be described here.

[0180] In addition, it should be noted that in the apparatus and method of the present invention, it is obvious that each component or each step can be decomposed and / or recombined. These decompositions and / or recombinations should be regarded as equivalent schemes of the present invention. Moreover, the steps of performing the above-mentioned series of processing can naturally be performed in chronological order according to the order of description, but it is not necessary to perform them in chronological order, and some steps can be performed in parallel or independently of each other. For those of ordinary skill in the art, it is understood that all or any steps or components of the method and apparatus of the present invention can be implemented in any computing device (including processors, storage media, etc.) or a network of computing devices in hardware, firmware, software or a combination thereof, which can be achieved by those of ordinary skill in the art using their basic programming skills after reading the description of the present invention.

[0181] Therefore, the purpose of the present invention can also be achieved by running a program or a group of programs on any computing device. The computing device can be a well-known general device. Therefore, the purpose of the present invention can also be achieved by simply providing a program product containing a program code that implements the method or device. That is to say, such a program product also constitutes the present invention, and the storage medium storing such a program product also constitutes the present invention. Obviously, the storage medium can be any well-known storage medium or any storage medium developed in the future. It should also be pointed out that in the device and method of the present invention, it is obvious that each component or each step can be decomposed and / or recombined. These decompositions and / or recombinations should be regarded as equivalent schemes of the present invention. In addition, the steps of performing the above-mentioned series of processing can naturally be performed in chronological order according to the order of description, but it is not necessary to perform them in chronological order. Some steps can be performed in parallel or independently of each other.

[0182] The above is a preferred embodiment of the present invention. It should be pointed out that for ordinary technicians in this technical field, several improvements and modifications can be made without departing from the principles of the present invention. These improvements and modifications should also be regarded as the scope of protection of the present invention.

Claims

1. A trajectory generation method, characterized in that: include: Determine the reference point and reference heading angle corresponding to the target vehicle according to the state of the turn signal lamp of the target vehicle; Determining the lateral deviation of the target vehicle according to the reference point and the reference heading angle; When the lateral deviation is greater than a deviation threshold, information about the current position of the target vehicle is added to historical trajectory information corresponding to the target vehicle.

2. The method according to claim 1, characterized in that The step of determining a reference point and a reference heading angle corresponding to the target vehicle according to a state of a turn signal lamp of the target vehicle comprises: Acquire the position information of the first position point where the target vehicle is currently located; Determine, according to the position information of the first position point and the historical trajectory information, a first distance between the first position point and a first historical trajectory point, wherein the first historical trajectory point is: a historical trajectory point closest to a time corresponding to the first position point among at least one historical trajectory point in the historical trajectory information; In the case where the first distance is less than or equal to the chord length threshold, determining a target chord error according to the position information of the first position point and the position information of the first historical trajectory point, the target chord error being the vertical distance between the position point on the first driving path and a target line, the first driving path being the path that the target vehicle travels from the first historical trajectory point to the first position point, and the target line being the line between the first historical trajectory point and the first position point; When the target chord error is less than or equal to the error threshold, the reference point and reference heading angle corresponding to the target vehicle are determined according to the state of the turn signal lamp of the target vehicle.

3. The method according to claim 1 or 2, characterized in that: Determining the reference point and reference heading angle corresponding to the target vehicle according to the state of the turn signal lamp of the target vehicle includes at least one of the following: In the case where the first target condition is met, determining the first historical track point as the reference point, and determining the heading angle of the first historical track point as the reference heading angle; In the case where the second target condition is met, the current position point of the target vehicle is determined as the reference point, and the heading angle of the current position point of the target vehicle is determined as the reference heading angle; The first historical track point is: the historical track point closest to the time corresponding to the current position of the target vehicle among the at least one historical track point of the historical track information; The first target condition includes at least one of the following: The state of the turn signal lamp does not undergo a first change; The state of the turn signal lamp undergoes the first change, and the value of the first angle is greater than or equal to the angle threshold; The second target condition includes: a first change occurs to the state of the turn signal lamp and the value of the first angle is less than an angle threshold; The first angle is the angle between the current heading of the target vehicle and the heading of the target vehicle at the first historical trajectory point; The first change is from an off state to a lit state.

4. The method according to claim 3, characterized in that In a case where a first historical track point is determined as the reference point, and the heading angle of the first historical track point is determined as the reference heading angle, determining the lateral deviation of the target vehicle according to the reference point and the reference heading angle includes: Determining whether a second change occurs in the state of the turn signal lamp, the second change being from the lighting state to the off state; When it is determined that the state of the turn signal lamp has not undergone the second change, the lateral deviation of the target vehicle is determined according to the reference point and the reference heading angle.

5. The method according to claim 4, characterized in that Also includes: When it is determined that the state of the turn signal lamp undergoes the second change, determining whether there is an erroneous operation; When it is determined that there is no misoperation, the information of the position point where the target vehicle is located when the state of the turn signal undergoes the second change is added to the historical trajectory information.

6. The method according to claim 5, characterized in that The determining whether there is an erroneous operation includes: Determining whether a target duration is greater than or equal to a duration threshold, the target duration being: the duration during which the turn signal lamp remains in the lighting state within a preset time period before the state of the turn signal lamp undergoes the second change; When the target duration is greater than or equal to the duration threshold, determining whether the absolute value of the lateral acceleration of the target vehicle is greater than or equal to the acceleration threshold; When the absolute value of the lateral acceleration is greater than or equal to the acceleration threshold, it is determined that there is no erroneous operation.

7. The method according to claim 1, characterized in that Determining the lateral deviation of the target vehicle according to the reference point and the reference heading angle includes: Taking the reference point as the coordinate origin and the heading corresponding to the reference heading angle as the x-axis direction, a vehicle body coordinate system is established; Determine the ordinate corresponding to the current position of the target vehicle in the vehicle body coordinate system; The absolute value of the ordinate is determined as the lateral deviation of the target vehicle.

8. The method according to claim 2, characterized in that: The method further comprises: When the first distance is greater than the chord length threshold or the target chord error is greater than the error threshold, information of a second position point is added to the historical trajectory information, where the second position point is the position point of the target vehicle at the previous moment before the first position point.

9. A trajectory generating device, characterized in that: include: A first processing module, used for determining a reference point and a reference heading angle corresponding to the target vehicle according to a state of a turn signal lamp of the target vehicle; A second processing module, used for determining the lateral deviation of the target vehicle according to the reference point and the reference heading angle; The first updating module is used to add the information of the current position point of the target vehicle to the historical trajectory information corresponding to the target vehicle when the lateral deviation is greater than the deviation threshold.

10. A device comprising: A transceiver, a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor implements the steps of the trajectory generation method according to any one of claims 1 to 8 when executing the computer program.

11. A computer program product, characterized in that The method comprises computer instructions, which, when executed by a processor, implement the steps of the method according to any one of claims 1 to 8.

12. A computer-readable storage medium having a computer program stored thereon, characterized in that: When the computer program is executed by a processor, the steps of the trajectory generation method according to any one of claims 1 to 8 are implemented.

Citation Information

Cited By

  • Path recarving method, self-moving device, medium and program product

    CN121187307A