CN117698734A - Lane line information prediction method, device, equipment and computer readable storage medium - Google Patents
Lane line information prediction method, device, equipment and computer readable storage medium Download PDFInfo
- Publication number
- CN117698734A CN117698734A CN202311717328.0A CN202311717328A CN117698734A CN 117698734 A CN117698734 A CN 117698734A CN 202311717328 A CN202311717328 A CN 202311717328A CN 117698734 A CN117698734 A CN 117698734A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- lane line
- point
- trajectory point
- trajectory
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 42
- 101100394003 Butyrivibrio fibrisolvens end1 gene Proteins 0.000 claims description 51
- 238000004364 calculation method Methods 0.000 claims description 19
- 239000003550 marker Substances 0.000 claims description 19
- 230000015654 memory Effects 0.000 claims description 11
- 230000008859 change Effects 0.000 claims description 9
- 230000000694 effects Effects 0.000 abstract description 2
- 230000003111 delayed effect Effects 0.000 abstract 1
- 230000008447 perception Effects 0.000 abstract 1
- 238000005516 engineering process Methods 0.000 description 8
- 238000010586 diagram Methods 0.000 description 7
- 230000008569 process Effects 0.000 description 6
- 238000004891 communication Methods 0.000 description 5
- 230000006870 function Effects 0.000 description 4
- 238000013461 design Methods 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 101100533615 Schizosaccharomyces pombe (strain 972 / ATCC 24843) end4 gene Proteins 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000001311 chemical methods and process Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 239000013307 optical fiber Substances 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
- B60W40/06—Road conditions
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W50/0097—Predicting future conditions
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2552/00—Input parameters relating to infrastructure
- B60W2552/53—Road markings, e.g. lane marker or crosswalk
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Traffic Control Systems (AREA)
Abstract
Description
技术领域Technical field
本申请涉及自动驾驶技术领域,具体涉及一种车道线信息预测方法、装置、设备及计算机可读存储介质。This application relates to the field of autonomous driving technology, and specifically to a lane line information prediction method, device, equipment and computer-readable storage medium.
背景技术Background technique
随着自动驾驶技术的发展,车道线识别技术的应用也越来越广,如车道线定位、车道保持等功能都会用到车道线信息。因此,对于车道线识别精度的要求也越来越高。With the development of autonomous driving technology, the application of lane line recognition technology is becoming more and more widespread. For example, lane line positioning, lane keeping and other functions will use lane line information. Therefore, the requirements for lane line recognition accuracy are getting higher and higher.
相关技术中,车辆智能驾驶辅助功能通常会将传感器检测到的车道线作为决策控制算法输入,但是传感器检测与决策控制算法的执行之间不可避免的存在时间偏差,因此对车辆进行控制时的车道线信息是滞后于实际场景的,导致对车辆的控制效果较差。In related technologies, vehicle intelligent driving assistance functions usually use lane lines detected by sensors as input to decision-making control algorithms. However, there is an inevitable time deviation between sensor detection and the execution of decision-making control algorithms. Therefore, the lane line when controlling the vehicle Line information lags behind the actual scene, resulting in poor vehicle control.
发明内容Contents of the invention
本申请提供一种车道线信息预测方法、装置、设备及计算机可读存储介质,可以解决现有技术中存在的对车辆进行控制时的车道线信息滞后于实际场景,导致对车辆的控制效果较差的技术问题。The present application provides a lane line information prediction method, device, equipment and computer-readable storage medium, which can solve the problem in the existing technology that the lane line information lags behind the actual scene when controlling the vehicle, resulting in poor control effect on the vehicle. Poor technical issues.
第一方面,本申请实施例提供一种车道线信息预测方法,所述车道线信息预测方法包括:In a first aspect, embodiments of the present application provide a method for predicting lane line information. The method for predicting lane line information includes:
当当前时刻满足执行车道线信息预测条件且当前时刻对应的轨迹点之前存在至少一个轨迹点时,确定上一次预测车道线信息的时刻对应的车辆行驶轨迹点为第一标记点,与当前时刻最近的真实车道线信息更新时刻对应的车辆行驶轨迹点为第二标记点;When the current moment satisfies the conditions for executing lane line information prediction and there is at least one track point before the trajectory point corresponding to the current moment, the vehicle driving trajectory point corresponding to the last time when lane line information was predicted is determined to be the first marking point, which is closest to the current moment. The vehicle driving trajectory point corresponding to the real lane line information update time is the second marking point;
计算车辆在所述第一标记点处与车辆在第一轨迹点处之间的第一轨迹偏差信息,其中,第一轨迹点为第一标记点的前一轨迹点;Calculate first trajectory deviation information between the vehicle at the first marking point and the vehicle at a first trajectory point, where the first trajectory point is a trajectory point preceding the first marking point;
计算车辆在所述第二标记点处与车辆在第二轨迹点处之间的第二轨迹偏差信息,其中,第二轨迹点为第二标记点的前一轨迹点;Calculate second trajectory deviation information between the vehicle at the second marking point and the vehicle at a second trajectory point, where the second trajectory point is a trajectory point preceding the second marking point;
基于所述第一轨迹偏差信息、所述第二轨迹偏差信息以及与当前时刻最近的真实车道线信息更新时刻对应的车道线信息得到当前时刻的车道线预测信息。The lane line prediction information at the current time is obtained based on the first trajectory deviation information, the second trajectory deviation information and the lane line information corresponding to the latest real lane line information update time at the current time.
第二方面,本申请实施例提供了一种车道线信息预测装置,所述车道线信息预测装置包括:In a second aspect, embodiments of the present application provide a device for predicting lane line information. The device for predicting lane line information includes:
确定模块,用于当当前时刻满足执行车道线信息预测条件且当前时刻对应的轨迹点之前存在至少一个轨迹点时,确定上一次预测车道线信息的时刻对应的车辆行驶轨迹点为第一标记点,与当前时刻最近的真实车道线信息更新时刻对应的车辆行驶轨迹点为第二标记点;A determination module configured to determine the vehicle driving trajectory point corresponding to the last time the lane line information was predicted as the first marking point when the current moment meets the conditions for executing lane line information prediction and there is at least one trajectory point before the trajectory point corresponding to the current moment. , the vehicle driving trajectory point corresponding to the latest real lane line information update time at the current moment is the second marking point;
第一计算模块,用于计算车辆在所述第一标记点处与车辆在第一轨迹点处之间的第一轨迹偏差信息,其中,第一轨迹点为第一标记点的前一轨迹点;The first calculation module is used to calculate the first trajectory deviation information between the vehicle at the first marking point and the vehicle at the first trajectory point, where the first trajectory point is the trajectory point preceding the first marking point. ;
第二计算模块,用于计算车辆在所述第二标记点处与车辆在第二轨迹点处之间的第二轨迹偏差信息,其中,第二轨迹点为第二标记点的前一轨迹点;The second calculation module is used to calculate the second trajectory deviation information between the vehicle at the second marking point and the vehicle at the second trajectory point, where the second trajectory point is the previous trajectory point of the second marking point. ;
车道线信息预测模块,用于基于所述第一轨迹偏差信息、所述第二轨迹偏差信息以及与当前时刻最近的真实车道线信息更新时刻对应的车道线信息得到当前时刻的车道线预测信息。The lane line information prediction module is configured to obtain the lane line prediction information at the current moment based on the first trajectory deviation information, the second trajectory deviation information and the lane line information corresponding to the latest real lane line information update time at the current time.
第三方面,本申请实施例提供了一种车道线信息预测设备,所述车道线信息预测设备包括处理器、存储器、以及存储在所述存储器上并可被所述处理器执行的车道线信息预测程序,其中所述车道线信息预测程序被所述处理器执行时,实现如上所述的车道线信息预测方法的步骤。In a third aspect, embodiments of the present application provide a lane line information prediction device. The lane line information prediction device includes a processor, a memory, and lane line information stored on the memory and executable by the processor. Prediction program, wherein when the lane line information prediction program is executed by the processor, the steps of the lane line information prediction method as described above are implemented.
第四方面,本申请实施例提供了一种计算机可读存储介质,所述计算机可读存储介质上存储有车道线信息预测程序,其中所述车道线信息预测程序被处理器执行时,实现如上所述的车道线信息预测方法的步骤。In a fourth aspect, embodiments of the present application provide a computer-readable storage medium. A lane line information prediction program is stored on the computer-readable storage medium. When the lane line information prediction program is executed by a processor, the above is implemented. The steps of the lane line information prediction method.
本申请实施例提供的技术方案带来的有益效果包括:The beneficial effects brought by the technical solutions provided by the embodiments of this application include:
通过当当前时刻满足执行车道线信息预测条件且当前时刻对应的轨迹点之前存在至少一个轨迹点时,确定上一次预测车道线信息的时刻对应的车辆行驶轨迹点为第一标记点,与当前时刻最近的真实车道线信息更新时刻对应的车辆行驶轨迹点为第二标记点;计算车辆在所述第一标记点处与车辆在第一轨迹点处之间的第一轨迹偏差信息,其中,第一轨迹点为第一标记点的前一轨迹点;计算车辆在所述第二标记点处与车辆在第二轨迹点处之间的第二轨迹偏差信息,其中,第二轨迹点为第二标记点的前一轨迹点;基于所述第一轨迹偏差信息、所述第二轨迹偏差信息以及与当前时刻最近的真实车道线信息更新时刻对应的车道线信息得到当前时刻的车道线预测信息,利用车辆运动偏差对车道线信息进行预测,弥补了感知信息与车辆控制间的时间偏差问题,解决了相关技术中存在的对车辆进行控制时的车道线信息滞后于实际场景,导致对车辆的控制效果较差的技术问题。When the current time satisfies the conditions for executing lane line information prediction and there is at least one track point before the track point corresponding to the current time, it is determined that the vehicle driving track point corresponding to the last time the lane line information was predicted is the first marking point, which is the same as the current time. The vehicle driving trajectory point corresponding to the latest real lane line information update time is the second marking point; the first trajectory deviation information between the vehicle at the first marking point and the vehicle at the first trajectory point is calculated, where, One trajectory point is the previous trajectory point of the first marker point; calculate the second trajectory deviation information between the vehicle at the second marker point and the vehicle at the second trajectory point, where the second trajectory point is the second trajectory point. The previous trajectory point of the marker point; obtain the lane line prediction information at the current moment based on the first trajectory deviation information, the second trajectory deviation information and the lane line information corresponding to the latest real lane line information update time at the current time, The use of vehicle motion deviations to predict lane line information makes up for the time deviation problem between sensing information and vehicle control, and solves the problem in related technologies that the lane line information lags behind the actual scene when controlling the vehicle, resulting in poor control of the vehicle. Technical issues with poor results.
附图说明Description of the drawings
图1为本申请车道线信息预测方法一实施例的流程示意图;Figure 1 is a schematic flow chart of an embodiment of the lane line information prediction method of the present application;
图2为本申请车道线信息预测方法时间和轨迹点匹配示意图;Figure 2 is a schematic diagram of time and trajectory point matching of the lane line information prediction method of this application;
图3为本申请图1中步骤S20的细化流程示意图;Figure 3 is a detailed flow chart of step S20 in Figure 1 of the present application;
图4为本申请车道线信息预测装置一实施例的功能模块示意图;Figure 4 is a functional module schematic diagram of an embodiment of the lane line information prediction device of the present application;
图5为本申请实施例方案中涉及的车道线信息预测设备的硬件结构示意图。Figure 5 is a schematic diagram of the hardware structure of the lane line information prediction device involved in the embodiment of the present application.
具体实施方式Detailed ways
为了使本技术领域的人员更好地理解本申请方案,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。In order to enable those in the technical field to better understand the solutions of the present application, the technical solutions in the embodiments of the present application will be clearly and completely described below in conjunction with the accompanying drawings in the embodiments of the present application. Obviously, the described embodiments are only These are part of the embodiments of this application, but not all of them. Based on the embodiments in this application, all other embodiments obtained by those of ordinary skill in the art without creative efforts fall within the scope of protection of this application.
为使本申请的目的、技术方案和优点更加清楚,下面将结合附图对本申请实施方式作详细描述。In order to make the purpose, technical solutions, and advantages of the present application clearer, the embodiments of the present application will be described in detail below with reference to the accompanying drawings.
第一方面,本申请实施例提供一种车道线信息预测方法。In a first aspect, embodiments of the present application provide a method for predicting lane line information.
一实施例中,参照图1,图1为本申请车道线信息预测方法一实施例的流程示意图。如图1所示,车道线信息预测方法包括:In one embodiment, refer to FIG. 1 , which is a schematic flow chart of an embodiment of the lane line information prediction method of the present application. As shown in Figure 1, lane line information prediction methods include:
步骤S10,当当前时刻满足执行车道线信息预测条件且当前时刻对应的轨迹点之前存在至少一个轨迹点时,确定上一次预测车道线信息的时刻对应的车辆行驶轨迹点为第一标记点,与当前时刻最近的真实车道线信息更新时刻对应的车辆行驶轨迹点为第二标记点;Step S10, when the current moment meets the conditions for executing lane line information prediction and there is at least one trajectory point before the trajectory point corresponding to the current moment, determine the vehicle driving trajectory point corresponding to the last time the lane line information was predicted as the first marker point, and The vehicle driving trajectory point corresponding to the latest real lane line information update time at the current moment is the second marking point;
本实施例中,当当前时刻对应的轨迹点之前存在至少一个轨迹点时,说明车辆有历史轨迹点,避免当前时刻车辆还未开始运动,在运动起点的情况,当当前时刻满足执行车道线信息预测条件时,执行车道线信息预测步骤,保证预测结果的合理性。因此,当当前时刻满足执行车道线信息预测条件且当前时刻对应的轨迹点之前存在至少一个轨迹点时,参照图2,图2为本申请车道线信息预测方法时间和轨迹点匹配示意图。如图2所示,确定上一次预测车道线信息的时刻Tend对应的车辆行驶轨迹点为第一标记点,确定与当前时刻最近的真实车道线信息更新时刻Td对应的车辆行驶轨迹点为第二标记点,容易理解的是,当当前时刻满足执行车道线信息预测条件且当前时刻对应的轨迹点之前存在至少一个轨迹点时,上一次预测车道线信息的时刻为上一次得到虚拟的车道线信息的时刻,与当前时刻最近的真实车道线信息更新时刻为当前时刻之前最后有新的实际车道线信息输入进行真实车道线信息更新的时刻。In this embodiment, when there is at least one trajectory point before the trajectory point corresponding to the current moment, it means that the vehicle has a historical trajectory point to avoid the situation where the vehicle has not started moving at the current moment and is at the starting point of movement. When the current moment satisfies the execution lane line information When predicting conditions, the lane line information prediction step is performed to ensure the rationality of the prediction results. Therefore, when the current moment satisfies the conditions for executing lane line information prediction and there is at least one trajectory point before the trajectory point corresponding to the current moment, refer to Figure 2, which is a schematic diagram of time and trajectory point matching of the lane line information prediction method of the present application. As shown in Figure 2, the vehicle driving trajectory point corresponding to the last predicted lane line information time T end is determined as the first marking point, and the vehicle driving trajectory point corresponding to the latest real lane line information update time T d at the current time is determined as The second marker point is easy to understand. When the current moment meets the conditions for executing lane line information prediction and there is at least one track point before the track point corresponding to the current moment, the last time the lane line information is predicted is the last time the virtual lane is obtained. At the time of line information, the latest real lane line information update time to the current time is the last time before the current time when new actual lane line information is input to update the real lane line information.
进一步地,一实施例中,所述车道线信息预测条件为:Further, in one embodiment, the lane line information prediction condition is:
a、当前时刻在上一次预测车道线信息的时刻之后;a. The current time is after the last time when lane line information was predicted;
b、当前时刻减去上一次预测车道线信息的时刻的差值小于第一预设时长;b. The difference between the current time and the time of the last predicted lane line information is less than the first preset duration;
c、当前时刻大于上上次预测车道线信息的时刻加上第二预设时长的和,且小于上上次预测车道线信息的时刻加上第三预设时长的和,其中,第二预设时长小于第三预设时长;c. The current time is greater than the sum of the time of the last predicted lane line information plus the second preset duration, and smaller than the sum of the last time of the last predicted lane line information plus the third preset duration, where the second preset time is The duration is set to be less than the third preset duration;
d、当前时刻和上一次预测车道线信息的时刻之间存在真实车道线信息更新时刻。d. There is a real lane line information update time between the current time and the last time the lane line information was predicted.
本实施例中,为了保证预测的连续性,当前时刻要在上一次预测车道线信息的时刻之后且当前时刻与上一次预测车道线信息的时刻不能间隔太长,即当前时刻减去上一次预测车道线信息的时刻的差值要小于第一预设时长,而且当前时刻离上上次预测车道线信息的时刻也要不远不近,即当前时刻大于上上次预测车道线信息的时刻加上第二预设时长的和,且小于上上次预测车道线信息的时刻加上第三预设时长的和,其中,第二预设时长小于第三预设时长。由于不能一直使用上一次预测的车道线信息,因此当前时刻和上一次预测车道线信息的时刻之间必须存在真实车道线信息更新时刻,才能再次对车道线信息进行预测。In this embodiment, in order to ensure the continuity of prediction, the current time must be after the last time the lane line information was predicted, and the gap between the current time and the last time the lane line information was predicted cannot be too long, that is, the current time minus the last prediction The difference in time between the lane line information should be less than the first preset duration, and the current time should not be far or near the time when the lane line information was last predicted, that is, the current time is greater than the time when the lane line information was last predicted plus The sum of the second preset duration is smaller than the sum of the last predicted lane line information time plus the third preset duration, where the second preset duration is smaller than the third preset duration. Since the last predicted lane line information cannot always be used, there must be a real lane line information update time between the current moment and the last time the lane line information was predicted, so that the lane line information can be predicted again.
步骤S20,计算车辆在所述第一标记点处与车辆在第一轨迹点处之间的第一轨迹偏差信息,其中,第一轨迹点为第一标记点的前一轨迹点;Step S20: Calculate the first trajectory deviation information between the vehicle at the first marking point and the vehicle at the first trajectory point, where the first trajectory point is the trajectory point preceding the first marking point;
本实施例中,第一轨迹偏差信息包括第一纵向距离偏差、第一横向距离偏差以及第一朝向角偏差。计算车辆在第一标记点处相对于车辆在第一轨迹点处的第一纵向距离偏差、第一横向距离偏差以及第一朝向角偏差,其中,第一轨迹点为第一标记点的前一轨迹点,朝向角为车辆与车道中心线之间的夹角。In this embodiment, the first trajectory deviation information includes a first longitudinal distance deviation, a first lateral distance deviation and a first orientation angle deviation. Calculate the first longitudinal distance deviation, the first lateral distance deviation and the first orientation angle deviation of the vehicle at the first marking point relative to the vehicle at the first trajectory point, where the first trajectory point is the previous one of the first marking point Track point, heading angle is the angle between the vehicle and the lane centerline.
步骤S30,计算车辆在所述第二标记点处与车辆在第二轨迹点处之间的第二轨迹偏差信息,其中,第二轨迹点为第二标记点的前一轨迹点;Step S30: Calculate the second trajectory deviation information between the vehicle at the second marker point and the vehicle at the second trajectory point, where the second trajectory point is the trajectory point preceding the second marker point;
本实施例中,第二轨迹偏差信息包括第二纵向距离偏差、第二横向距离偏差以及第二朝向角偏差。计算车辆在第二标记点处相对于车辆在第二轨迹点处的第二纵向距离偏差、第二横向距离偏差以及第二朝向角偏差,其中,第二轨迹点为第二标记点的前一轨迹点。In this embodiment, the second trajectory deviation information includes a second longitudinal distance deviation, a second lateral distance deviation, and a second orientation angle deviation. Calculate the second longitudinal distance deviation, the second lateral distance deviation and the second orientation angle deviation of the vehicle at the second marking point relative to the vehicle at the second trajectory point, where the second trajectory point is the previous one of the second marking point track points.
具体地,获取与第二标记点相邻且在第二标记点之后的第四轨迹点。继续参照图2,图2中tend2这一时刻对应的轨迹点即为与第二标记点相邻且在第二标记点之后的第四轨迹点。将车辆在第二轨迹点的速度、车辆在第二轨迹点的朝向角以及当前时刻对应的轨迹点的前一轨迹点对应的时刻与当前时刻之间的时长代入第四预设公式,计算得到车辆在第二轨迹点处与车辆在第二轨迹点的前一轨迹点处之间的第五纵向距离偏差Δxstart2,第四预设公式如下:Specifically, a fourth trajectory point adjacent to the second marker point and behind the second marker point is obtained. Continuing to refer to Figure 2, the trajectory point corresponding to the moment t end2 in Figure 2 is the fourth trajectory point adjacent to the second marking point and after the second marking point. Substituting the vehicle's speed at the second trajectory point, the vehicle's heading angle at the second trajectory point, and the time between the moment corresponding to the previous trajectory point of the trajectory point corresponding to the current moment and the current moment into the fourth preset formula, the calculation is obtained The fifth longitudinal distance deviation Δx start2 between the vehicle at the second trajectory point and the vehicle at the previous trajectory point of the second trajectory point, the fourth preset formula is as follows:
Δxstart2=(tcur-tE)*(Vxstart2cosθstart2-Vystart2sinθstart2)Δx start2 = (t cur -t E )*(V xstart2 cosθ start2 -V ystart2 sinθ start2 )
其中,tcur用于表示当前时刻,tE用于表示当前时刻对应的轨迹点的前一轨迹点对应的时刻,Vxstart2用于表示车辆在第二轨迹点的纵向速度,Vystart2用于表示车辆在第二轨迹点的横向速度,θstart2用于表示车辆在第二轨迹点的朝向角。Among them, t cur is used to represent the current moment, t E is used to represent the moment corresponding to the previous trajectory point of the trajectory point corresponding to the current moment, V xstart2 is used to represent the longitudinal speed of the vehicle at the second trajectory point, and V ystart2 is used to represent The lateral speed of the vehicle at the second trajectory point, θ start2, is used to represent the heading angle of the vehicle at the second trajectory point.
将车辆在第四轨迹点的速度、车辆在第四轨迹点的朝向角以及当前时刻对应的轨迹点的前一轨迹点对应的时刻与当前时刻之间的时长代入第四预设公式,计算得到车辆在第四轨迹点处与车辆在第四轨迹点的前一轨迹点处之间的第六纵向距离偏差Δxend2,即Δxend2=(tcur-tE)*(Vxend2cosθend2-Vyend2sinθend2)Substituting the vehicle's speed at the fourth trajectory point, the vehicle's heading angle at the fourth trajectory point, and the time between the moment corresponding to the previous trajectory point of the trajectory point corresponding to the current moment and the current moment into the fourth preset formula, the calculation is obtained The sixth longitudinal distance deviation Δx end2 between the vehicle at the fourth trajectory point and the vehicle at the previous trajectory point of the fourth trajectory point, that is, Δx end2 = (t cur -t E )*(V xend2 cosθ end2 -V yend2 sinθ end2 )
其中,tcur用于表示当前时刻,tE用于表示当前时刻对应的轨迹点的前一轨迹点对应的时刻,Vxend2用于表示车辆在第四轨迹点的纵向速度,Vyend2用于表示车辆在第四轨迹点的横向速度,θend4用于表示车辆在第四轨迹点的朝向角。Among them, t cur is used to represent the current moment, t E is used to represent the moment corresponding to the previous trajectory point of the trajectory point corresponding to the current moment, V xend2 is used to represent the longitudinal speed of the vehicle at the fourth trajectory point, and V yend2 is used to represent The lateral speed of the vehicle at the fourth trajectory point, θ end4, is used to represent the heading angle of the vehicle at the fourth trajectory point.
将第五纵向距离偏差Δxstart2、第六纵向距离偏差Δxend2、与当前时刻最近的真实车道线信息更新时刻td、第四轨迹点对应的时刻tend2、第一轨迹点对应的时刻tstart1以及第二轨迹点对应的时刻tstart2代入预设公式The fifth longitudinal distance deviation Δx start2 , the sixth longitudinal distance deviation Δx end2 , the latest real lane information update time t d to the current time, the time t end2 corresponding to the fourth trajectory point, and the time t start1 corresponding to the first trajectory point And the time t start2 corresponding to the second trajectory point is substituted into the preset formula
计算得到车辆在第二标记点处与车辆在第二轨迹点处之间的第二纵向距离偏差,其中,ΔX2用于表示车辆在第二标记点处与车辆在第二轨迹点处之间的第二纵向距离偏差。 The second longitudinal distance deviation between the vehicle at the second marking point and the vehicle at the second trajectory point is calculated, where ΔX 2 is used to represent the distance between the vehicle at the second marking point and the vehicle at the second trajectory point The second longitudinal distance deviation.
将车辆在第二轨迹点的速度、车辆在第二轨迹点的朝向角以及当前时刻对应的轨迹点的前一轨迹点对应的时刻与当前时刻之间的时长代入第五预设公式,计算得到车辆在第二轨迹点处与车辆在第二轨迹点的前一轨迹点处之间的第五横向距离偏差Δystart2,第五预设公式如下:Substituting the speed of the vehicle at the second trajectory point, the heading angle of the vehicle at the second trajectory point, and the time between the moment corresponding to the previous trajectory point of the trajectory point corresponding to the current moment and the current moment into the fifth preset formula, the calculation is obtained The fifth lateral distance deviation Δy start2 between the vehicle at the second trajectory point and the vehicle at the previous trajectory point of the second trajectory point, the fifth preset formula is as follows:
Δystart2=(tcur-tE)*(Vystart2sinθstart2+Vystart2cosθstart2)Δy start2 = (t cur -t E )*(V ystart2 sinθ start2 +V ystart2 cosθ start2 )
其中,tcur用于表示当前时刻,tE用于表示当前时刻对应的轨迹点的前一轨迹点对应的时刻,Vystart2用于表示车辆在第二轨迹点的横向速度,θstart2用于表示车辆在第二轨迹点的朝向角。Among them, t cur is used to represent the current moment, t E is used to represent the moment corresponding to the previous trajectory point of the trajectory point corresponding to the current moment, V ystart2 is used to represent the lateral speed of the vehicle at the second trajectory point, and θ start2 is used to represent The heading angle of the vehicle at the second trajectory point.
将车辆在第四轨迹点的速度、车辆在第四轨迹点的朝向角以及当前时刻对应的轨迹点的前一轨迹点对应的时刻与当前时刻之间的时长代入第五预设公式,计算得到车辆在第四轨迹点处与车辆在第四轨迹点的前一轨迹点处之间的第六横向距离偏差Δyend2,即Δyend2=(tcur-tE)*(Vyend2sinθend2+Vyend2cosθend2)Substituting the speed of the vehicle at the fourth trajectory point, the heading angle of the vehicle at the fourth trajectory point, and the time between the moment corresponding to the previous trajectory point of the trajectory point corresponding to the current moment and the current moment into the fifth preset formula, the calculation is obtained The sixth lateral distance deviation Δy end2 between the vehicle at the fourth trajectory point and the vehicle at the previous trajectory point of the fourth trajectory point, that is, Δy end2 = (t cur -t E )*(V yend2 sinθ end2 +V yend2 cosθ end2 )
其中,tcur用于表示当前时刻,tE用于表示当前时刻对应的轨迹点的前一轨迹点对应的时刻,Vyend2用于表示车辆在第四轨迹点的横向速度,θend2用于表示车辆在第四轨迹点的朝向角。Among them, t cur is used to represent the current moment, t E is used to represent the moment corresponding to the previous trajectory point of the trajectory point corresponding to the current moment, V yend2 is used to represent the lateral speed of the vehicle at the fourth trajectory point, and θ end2 is used to represent The heading angle of the vehicle at the fourth trajectory point.
将第五横向距离偏差Δystart2、第六横向距离偏差Δyend2、与当前时刻最近的真实车道线信息更新时刻td、第四轨迹点对应的时刻tend2以及第二轨迹点对应的时刻tstart2代入预设公式计算得到车辆在第二标记点处与车辆在第二轨迹点处之间的第二横向距离偏差,其中,ΔY2用于表示车辆在第二标记点处与车辆在第二轨迹点处之间的第二横向距离偏差。The fifth lateral distance deviation Δy start2 , the sixth lateral distance deviation Δy end2 , the latest real lane information update time t d to the current time, the time t end2 corresponding to the fourth trajectory point and the time t start2 corresponding to the second trajectory point Substitute into the default formula The second lateral distance deviation between the vehicle at the second marking point and the vehicle at the second trajectory point is calculated, where ΔY 2 is used to represent the distance between the vehicle at the second marking point and the vehicle at the second trajectory point second lateral distance deviation.
计算当前时刻对应的轨迹点的前一轨迹点对应的时刻与当前时刻之间的时长乘以车辆在第二轨迹点处的角速度的乘积,以得到的乘积作为车辆在第二轨迹点处与车辆在第二轨迹点的前一轨迹点处之间的第六朝向角偏差Δθstart2,即Δθstart2=(tcur-tE)*ωstart2,其中,tcur用于表示当前时刻,tE用于表示当前时刻对应的轨迹点的前一轨迹点对应的时刻,ωstart2用于表示车辆在第二轨迹点处的角速度。Calculate the product of the time between the time corresponding to the previous trajectory point of the trajectory point corresponding to the current time and the current time multiplied by the angular velocity of the vehicle at the second trajectory point, and use the resulting product as the distance between the vehicle at the second trajectory point and the vehicle The sixth orientation angle deviation Δθ start2 between the second trajectory point and the previous trajectory point, that is, Δθ start2 = (t cur -t E )*ω start2 , where t cur is used to represent the current moment, and t E is represented by At the time corresponding to the previous trajectory point representing the trajectory point corresponding to the current time, ω start2 is used to represent the angular velocity of the vehicle at the second trajectory point.
计算当前时刻对应的轨迹点的前一轨迹点对应的时刻与当前时刻之间的时长乘以车辆在第四轨迹点处的角速度的乘积,以得到的乘积作为车辆在第四轨迹点处与车辆在第二标记点处之间的第七朝向角偏差Δθend2,即Δθend2=(tcur-tE)*ωend2,其中,ωend2用于表示车辆在第四轨迹点处的角速度。Calculate the product of the time between the time corresponding to the previous trajectory point of the trajectory point corresponding to the current time and the current time multiplied by the angular velocity of the vehicle at the fourth trajectory point, and use the resulting product as the distance between the vehicle at the fourth trajectory point and the vehicle The seventh orientation angle deviation Δθ end2 between the second mark points is Δθ end2 = (t cur -t E )*ω end2 , where ω end2 is used to represent the angular velocity of the vehicle at the fourth trajectory point.
将第六朝向角偏差Δθstart2、第七朝向角偏差Δθend2、与当前时刻最近的真实车道线信息更新时刻td、第四轨迹点对应的时刻tend2、第一轨迹点对应的时刻tstart1以及第二轨迹点对应的时刻tstart2代入预设公式The sixth heading angle deviation Δθ start2 , the seventh heading angle deviation Δθ end2 , the latest real lane information update time t d to the current time, the time t end2 corresponding to the fourth trajectory point, and the time t start1 corresponding to the first trajectory point And the time t start2 corresponding to the second trajectory point is substituted into the preset formula
即可计算得到车辆在第二标记点处与车辆在第二轨迹点处之间的第二朝向角偏差,其中,Δθ2用于表示车辆在第二标记点处与车辆在第二轨迹点处之间的第二朝向角偏差。 That is, the second orientation angle deviation between the vehicle at the second marking point and the vehicle at the second trajectory point can be calculated, where Δθ 2 is used to represent the vehicle at the second marking point and the vehicle at the second trajectory point. The second orientation angle deviation between
步骤S40,基于所述第一轨迹偏差信息、所述第二轨迹偏差信息以及与当前时刻最近的真实车道线信息更新时刻对应的车道线信息得到当前时刻的车道线预测信息。Step S40: Obtain lane line prediction information at the current time based on the first trajectory deviation information, the second trajectory deviation information and the lane line information corresponding to the latest real lane line information update time at the current time.
本实施例中,基于第一轨迹偏差信息、第二轨迹偏差信息以及与当前时刻最近的真实车道线信息更新时刻对应的车道线信息对当前时刻的车道线信息进行预测,即可得到当前时刻的车道线预测信息。In this embodiment, the lane line information at the current moment is predicted based on the first trajectory deviation information, the second trajectory deviation information and the lane line information corresponding to the latest real lane line information update time at the current moment, and the lane line information at the current moment can be obtained. Lane prediction information.
本实施例中,通过当当前时刻满足执行车道线信息预测条件且当前时刻对应的轨迹点之前存在至少一个轨迹点时,确定上一次预测车道线信息的时刻对应的车辆行驶轨迹点为第一标记点,与当前时刻最近的真实车道线信息更新时刻对应的车辆行驶轨迹点为第二标记点;计算车辆在所述第一标记点处与车辆在第一轨迹点处之间的第一轨迹偏差信息,其中,第一轨迹点为第一标记点的前一轨迹点;计算车辆在所述第二标记点处与车辆在第二轨迹点处之间的第二轨迹偏差信息,其中,第二轨迹点为第二标记点的前一轨迹点;基于所述第一轨迹偏差信息、所述第二轨迹偏差信息以及与当前时刻最近的真实车道线信息更新时刻对应的车道线信息得到当前时刻的车道线预测信息,利用车辆运动偏差对车道线信息进行预测,弥补了感知信息与车辆控制间的时间偏差问题,解决了相关技术中存在的对车辆进行控制时的车道线信息滞后于实际场景,导致对车辆的控制效果较差的技术问题。In this embodiment, when the current time satisfies the conditions for executing lane line information prediction and there is at least one trajectory point before the trajectory point corresponding to the current time, it is determined that the vehicle driving trajectory point corresponding to the time when lane line information was last predicted is the first mark. point, the vehicle driving trajectory point corresponding to the latest real lane line information update time at the current moment is the second marking point; calculate the first trajectory deviation between the vehicle at the first marking point and the vehicle at the first trajectory point Information, wherein the first trajectory point is the previous trajectory point of the first marking point; calculate the second trajectory deviation information between the vehicle at the second marking point and the vehicle at the second trajectory point, wherein the second The trajectory point is the previous trajectory point of the second marker point; the current time is obtained based on the first trajectory deviation information, the second trajectory deviation information and the lane line information corresponding to the latest real lane line information update time at the current time. Lane line prediction information uses vehicle motion deviation to predict lane line information, which makes up for the time deviation problem between sensing information and vehicle control, and solves the problem in related technologies that the lane line information lags behind the actual scene when controlling the vehicle. Technical problems that result in less effective control of the vehicle.
进一步地,一实施例中,所述第一轨迹偏差信息包括第一纵向距离偏差、第一横向距离偏差以及第一朝向角偏差,参照图3,图3为本申请图1中步骤S20的细化流程示意图。如图3所示,所述计算车辆在所述第一标记点处与车辆在第一轨迹点处之间的第一轨迹偏差信息的步骤,包括:Further, in one embodiment, the first trajectory deviation information includes a first longitudinal distance deviation, a first lateral distance deviation and a first orientation angle deviation. Refer to Figure 3. Figure 3 is the details of step S20 in Figure 1 of this application. chemical process diagram. As shown in Figure 3, the step of calculating the first trajectory deviation information between the vehicle at the first marker point and the vehicle at the first trajectory point includes:
步骤S201,获取与所述第一标记点相邻且在所述第一标记点之后的第三轨迹点;Step S201, obtain a third trajectory point adjacent to the first marker point and after the first marker point;
步骤S202,计算车辆在所述第一轨迹点处与车辆在所述第一轨迹点的前一轨迹点处之间的第三纵向距离偏差Δxstart1;Step S202: Calculate the third longitudinal distance deviation Δx start1 between the vehicle at the first trajectory point and the vehicle at the previous trajectory point of the first trajectory point;
步骤S203,计算车辆在所述第三轨迹点处与车辆在所述第一标记点处之间的第四纵向距离偏差Δxend1;Step S203: Calculate the fourth longitudinal distance deviation Δx end1 between the vehicle at the third trajectory point and the vehicle at the first mark point;
步骤S204,基于所述第三纵向距离偏差Δxstart1、所述第四纵向距离偏差Δxend1、上一次预测车道线信息的时刻tend、第三轨迹点对应的时刻tend1以及第一轨迹点对应的时刻tstart1通过第一预设公式,计算得到车辆在所述第一标记点处与车辆在第一轨迹点处之间的第一纵向距离偏差,第一预设公式如下:Step S204, based on the third longitudinal distance deviation Δx start1 , the fourth longitudinal distance deviation Δx end1 , the time t end of the last predicted lane line information, the time t end1 corresponding to the third trajectory point, and the corresponding time t end1 of the first trajectory point. At the time t start1 , the first longitudinal distance deviation between the vehicle at the first marking point and the vehicle at the first trajectory point is calculated through the first preset formula. The first preset formula is as follows:
其中,ΔX1用于表示车辆在所述第一标记点处与车辆在第一轨迹点处之间的第一纵向距离偏差;Wherein, ΔX 1 is used to represent the first longitudinal distance deviation between the vehicle at the first mark point and the vehicle at the first trajectory point;
步骤S205,计算车辆在所述第一轨迹点处与车辆在所述第一轨迹点的前一轨迹点处之间的第三横向距离偏差Δystart1;Step S205: Calculate the third lateral distance deviation Δy start1 between the vehicle at the first trajectory point and the vehicle at the previous trajectory point of the first trajectory point;
步骤S206,计算车辆在所述第三轨迹点处与车辆在所述第一标记点处之间的第四横向距离偏差Δyend1;Step S206: Calculate the fourth lateral distance deviation Δy end1 between the vehicle at the third trajectory point and the vehicle at the first mark point;
步骤S207,基于所述第三横向距离偏差Δystart1、所述第四横向距离偏差Δyend1、上一次预测车道线信息的时刻tend、第三轨迹点对应的时刻tend1以及第一轨迹点对应的时刻tstart1通过第二预设公式,计算得到车辆在所述第一标记点处与车辆在第一轨迹点处之间的第一横向距离偏差,第二预设公式如下:Step S207, based on the third lateral distance deviation Δy start1 , the fourth lateral distance deviation Δy end1 , the time t end of the last predicted lane line information, the time t end1 corresponding to the third trajectory point and the corresponding first trajectory point At the time t start1 , the first lateral distance deviation between the vehicle at the first marking point and the vehicle at the first trajectory point is calculated through the second preset formula. The second preset formula is as follows:
其中,ΔY1用于表示车辆在所述第一标记点处与车辆在第一轨迹点处之间的第一横向距离偏差;Wherein, ΔY 1 is used to represent the first lateral distance deviation between the vehicle at the first mark point and the vehicle at the first trajectory point;
步骤S208,计算当前时刻对应的轨迹点的前一轨迹点对应的时刻与当前时刻之间的时长乘以车辆在所述第一轨迹点处的角速度的乘积,以所述乘积作为车辆在所述第一轨迹点处与车辆在所述第一轨迹点的前一轨迹点处之间的第三朝向角偏差Δθstart1;Step S208: Calculate the product of the time length between the time corresponding to the previous trajectory point of the trajectory point corresponding to the current time and the current time multiplied by the angular velocity of the vehicle at the first trajectory point, and use the product as the vehicle's angular velocity at the first trajectory point. The third orientation angle deviation Δθ start1 between the first trajectory point and the vehicle at the previous trajectory point of the first trajectory point;
步骤S209,计算当前时刻对应的轨迹点的前一轨迹点对应的时刻与当前时刻之间的时长乘以车辆在所述第三轨迹点处的角速度的乘积,以所述乘积作为车辆在所述第三轨迹点处与车辆在所述第一标记点处之间的第四朝向角偏差Δθend1;Step S209: Calculate the product of the duration between the time corresponding to the previous trajectory point of the trajectory point corresponding to the current time and the current time multiplied by the angular velocity of the vehicle at the third trajectory point, and use the product as the vehicle's angular velocity at the third trajectory point. The fourth orientation angle deviation Δθ end1 between the third trajectory point and the vehicle at the first mark point;
步骤S210,基于所述第三朝向角偏差Δθstart1、所述第四朝向角偏差Δθend1、上一次预测车道线信息的时刻tend、第三轨迹点对应的时刻tend1以及第一轨迹点对应的时刻tstart1通过第三预设公式,计算得到车辆在所述第一标记点处与车辆在第一轨迹点处之间的第一朝向角偏差,第三预设公式如下:Step S210, based on the third orientation angle deviation Δθ start1 , the fourth orientation angle deviation Δθ end1 , the time t end of the last predicted lane line information, the time t end1 corresponding to the third trajectory point, and the corresponding time t end1 of the first trajectory point. At the time t start1 , the first orientation angle deviation between the vehicle at the first marking point and the vehicle at the first trajectory point is calculated through the third preset formula. The third preset formula is as follows:
其中,Δθ1用于表示车辆在所述第一标记点处与车辆在第一轨迹点处之间的第一朝向角偏差,所述朝向角为车辆与车道中心线之间的夹角。Wherein, Δθ 1 is used to represent the first orientation angle deviation between the vehicle at the first mark point and the vehicle at the first trajectory point, and the orientation angle is the angle between the vehicle and the lane centerline.
本实施例中,继续参照图2,图2中tend1这一时刻对应的轨迹点即为与第一标记点相邻且在第一标记点之后的第三轨迹点。计算车辆在第一轨迹点处时相对于前一轨迹点的第三纵向距离偏差,以及车辆在第三轨迹点时相对于前一轨迹点的第四纵向距离偏差。In this embodiment, continuing to refer to FIG. 2 , the trajectory point corresponding to the moment t end1 in FIG. 2 is the third trajectory point adjacent to the first marking point and after the first marking point. A third longitudinal distance deviation of the vehicle relative to the previous trajectory point when the vehicle is at the first trajectory point is calculated, and a fourth longitudinal distance deviation of the vehicle relative to the previous trajectory point when the vehicle is at the third trajectory point is calculated.
将第三纵向距离偏差Δxstart1、第四纵向距离偏差Δxend1、上一次预测车道线信息的时刻tend、第三轨迹点对应的时刻tend1以及第一轨迹点对应的时刻tstart1代入第一预设公式,计算得到车辆在第一标记点处与车辆在第一轨迹点处之间的第一纵向距离偏差,第一预设公式如下:Substitute the third longitudinal distance deviation Δx start1 , the fourth longitudinal distance deviation Δx end1 , the time t end of the last predicted lane line information, the time t end1 corresponding to the third trajectory point and the time t start1 corresponding to the first trajectory point into the first A preset formula is used to calculate the first longitudinal distance deviation between the vehicle at the first marking point and the vehicle at the first trajectory point. The first preset formula is as follows:
其中,ΔX1用于表示车辆在第一标记点处与车辆在第一轨迹点处之间的第一纵向距离偏差。Among them, ΔX 1 is used to represent the first longitudinal distance deviation between the vehicle at the first mark point and the vehicle at the first trajectory point.
计算车辆在第一轨迹点处相对于车辆在前一轨迹点处的第三横向距离偏差Δystart1,计算车辆在第三轨迹点处相对于车辆在前一轨迹点,即第一标记点处的第四横向距离偏差Δyend1。Calculate the third lateral distance deviation Δy start1 of the vehicle at the first trajectory point relative to the vehicle at the previous trajectory point, and calculate the distance deviation Δy start1 of the vehicle at the third trajectory point relative to the vehicle at the previous trajectory point, that is, the first mark point. The fourth lateral distance deviation Δy end1 .
将第三横向距离偏差Δystart1、第四横向距离偏差Δyend1、上一次预测车道线信息的时刻tend、第三轨迹点对应的时刻tend1以及第一轨迹点对应的时刻tstart1代入第二预设公式,计算得到车辆在第一标记点处与车辆在第一轨迹点处之间的第一横向距离偏差,第二预设公式如下:Substitute the third lateral distance deviation Δy start1 , the fourth lateral distance deviation Δy end1 , the time t end of the last predicted lane line information, the time t end1 corresponding to the third trajectory point and the time t start1 corresponding to the first trajectory point into the second The preset formula is used to calculate the first lateral distance deviation between the vehicle at the first marking point and the vehicle at the first trajectory point. The second preset formula is as follows:
其中,ΔY1用于表示车辆在第一标记点处与车辆在第一轨迹点处之间的第一横向距离偏差。Among them, ΔY 1 is used to represent the first lateral distance deviation between the vehicle at the first mark point and the vehicle at the first trajectory point.
计算当前时刻对应的轨迹点的前一轨迹点对应的时刻与当前时刻之间的时长乘以车辆在第一轨迹点处的角速度的乘积,以得到的乘积作为车辆在第一轨迹点处与车辆在第一轨迹点的前一轨迹点处之间的第三朝向角偏差Δθstart1,即Δθstart1=(tcur-tE)*ωstart1,其中,tcur用于表示当前时刻,tE用于表示当前时刻对应的轨迹点的前一轨迹点对应的时刻,ωstart1用于表示车辆在第一轨迹点处的角速度。Calculate the product of the time between the time corresponding to the previous trajectory point of the trajectory point corresponding to the current time and the current time multiplied by the angular velocity of the vehicle at the first trajectory point, and use the obtained product as the distance between the vehicle at the first trajectory point and the vehicle The third orientation angle deviation Δθ start1 between the first trajectory point and the previous trajectory point, that is, Δθ start1 = (t cur -t E )*ω start1 , where t cur is used to represent the current moment, and t E is represented by At the time corresponding to the previous trajectory point of the trajectory point corresponding to the current time, ω start1 is used to represent the angular velocity of the vehicle at the first trajectory point.
计算当前时刻对应的轨迹点的前一轨迹点对应的时刻与当前时刻之间的时长乘以车辆在第三轨迹点处的角速度的乘积,以得到的乘积作为车辆在第三轨迹点处与车辆在第一标记点处之间的第四朝向角偏差Δθend1,即Δθend1=(tcur-tE)*ωend1,其中,ωend1用于表示车辆在第三轨迹点处的角速度。Calculate the product of the time between the time corresponding to the previous trajectory point of the trajectory point corresponding to the current time and the current time multiplied by the angular velocity of the vehicle at the third trajectory point, and use the resulting product as the distance between the vehicle at the third trajectory point and the vehicle The fourth orientation angle deviation Δθ end1 between the first marking points is Δθ end1 =(t cur -t E )*ω end1 , where ω end1 is used to represent the angular velocity of the vehicle at the third trajectory point.
将第三朝向角偏差Δθstart1、第四朝向角偏差Δθend1、上一次预测车道线信息的时刻tend、第三轨迹点对应的时刻tend1以及第一轨迹点对应的时刻tstart1代入第三预设公式,即可计算得到车辆在第一标记点处与车辆在第一轨迹点处之间的第一朝向角偏差,第三预设公式如下:Substitute the third heading angle deviation Δθ start1 , the fourth heading angle deviation Δθ end1 , the time t end of the last predicted lane line information, the time t end1 corresponding to the third trajectory point and the time t start1 corresponding to the first trajectory point into the third The preset formula can be used to calculate the first orientation angle deviation between the vehicle at the first marking point and the vehicle at the first trajectory point. The third preset formula is as follows:
其中,Δθ1用于表示车辆在第一标记点处与车辆在第一轨迹点处之间的第一朝向角偏差,朝向角为车辆与车道中心线之间的夹角。Among them, Δθ 1 is used to represent the first orientation angle deviation between the vehicle at the first marking point and the vehicle at the first trajectory point, and the orientation angle is the angle between the vehicle and the lane centerline.
进一步地,一实施例中,所述计算车辆在所述第一轨迹点处与车辆在所述第一轨迹点的前一轨迹点处之间的第三纵向距离偏差的步骤,包括:Further, in one embodiment, the step of calculating the third longitudinal distance deviation between the vehicle at the first trajectory point and the vehicle at a trajectory point preceding the first trajectory point includes:
将车辆在所述第一轨迹点的速度、朝向角以及当前时刻对应的轨迹点的前一轨迹点对应的时刻与当前时刻之间的时长代入第四预设公式,计算得到车辆在所述第一轨迹点处与车辆在所述第一轨迹点的前一轨迹点处之间的第三纵向距离偏差Δxstart1,第四预设公式如下:Substituting the speed and heading angle of the vehicle at the first trajectory point and the time period between the time corresponding to the previous trajectory point of the trajectory point corresponding to the current time and the current time into the fourth preset formula, the calculation result is that the vehicle is at the first trajectory point. The third longitudinal distance deviation Δx start1 between a trajectory point and the vehicle at the previous trajectory point of the first trajectory point, the fourth preset formula is as follows:
Δxstart1=(tcur-tE)*(Vxstart1cosθstart1-Vystart1sinθstart1)Δx start1 = (t cur -t E )*(V xstart1 cosθ start1 -V ystart1 sinθ start1 )
其中,tcur用于表示当前时刻,tE用于表示当前时刻对应的轨迹点的前一轨迹点对应的时刻,Vxstart1用于表示车辆在第一轨迹点的横向速度,Vystart1用于表示车辆在第一轨迹点的纵向速度,θstart1用于表示车辆在第一轨迹点的朝向角。Among them, t cur is used to represent the current moment, t E is used to represent the moment corresponding to the previous trajectory point of the trajectory point corresponding to the current moment, V xstart1 is used to represent the lateral speed of the vehicle at the first trajectory point, and V ystart1 is used to represent The longitudinal velocity of the vehicle at the first trajectory point, θ start1, is used to represent the heading angle of the vehicle at the first trajectory point.
本实施例中,将车辆在第一轨迹点的速度、车辆在第一轨迹点的朝向角以及当前时刻对应的轨迹点的前一轨迹点对应的时刻与当前时刻之间的时长代入第四预设公式,计算得到车辆在第一轨迹点处与车辆在第一轨迹点的前一轨迹点处之间的第三纵向距离偏差Δxstart1,第四预设公式如下:In this embodiment, the speed of the vehicle at the first trajectory point, the heading angle of the vehicle at the first trajectory point, and the time between the time corresponding to the previous trajectory point of the trajectory point corresponding to the current time and the current time are substituted into the fourth predetermined time. Set up a formula to calculate the third longitudinal distance deviation Δx start1 between the vehicle at the first trajectory point and the vehicle at the previous trajectory point of the first trajectory point. The fourth preset formula is as follows:
Δxstart1=(tcur-tE)*(Vxstart1cosθstart1-Vystart1sinθstart1)Δx start1 = (t cur -t E )*(V xstart1 cosθ start1 -V ystart1 sinθ start1 )
其中,tcur用于表示当前时刻,tE用于表示当前时刻对应的轨迹点的前一轨迹点对应的时刻,Vxstart1用于表示车辆在第一轨迹点的横向速度,Vystart1用于表示车辆在第一轨迹点的纵向速度,θstart1用于表示车辆在第一轨迹点的朝向角。容易想到的是,当前时刻对应的轨迹点的前一轨迹点对应的时刻即为历史轨迹点中的最后轨迹点对应的时刻。需要说明的是,历史轨迹点中,按照先进先出的原则仅保存预设数量的轨迹点。Among them, t cur is used to represent the current moment, t E is used to represent the moment corresponding to the previous trajectory point of the trajectory point corresponding to the current moment, V xstart1 is used to represent the lateral speed of the vehicle at the first trajectory point, and V ystart1 is used to represent The longitudinal velocity of the vehicle at the first trajectory point, θ start1, is used to represent the heading angle of the vehicle at the first trajectory point. It is easy to think that the time corresponding to the previous trajectory point of the trajectory point corresponding to the current time is the time corresponding to the last trajectory point in the historical trajectory points. It should be noted that among the historical track points, only a preset number of track points are saved on a first-in, first-out basis.
进一步地,一实施例中,将车辆在第三轨迹点的速度、车辆在第三轨迹点的朝向角以及当前时刻对应的轨迹点的前一轨迹点对应的时刻与当前时刻之间的时长代入第四预设公式,计算得到车辆在第三轨迹点处与车辆在第三轨迹点的前一轨迹点处之间的第四纵向距离偏差Δxend1,即Further, in one embodiment, the speed of the vehicle at the third trajectory point, the heading angle of the vehicle at the third trajectory point, and the time period between the time corresponding to the previous trajectory point of the trajectory point corresponding to the current time and the current time are substituted into The fourth preset formula calculates the fourth longitudinal distance deviation Δx end1 between the vehicle at the third trajectory point and the vehicle at the previous trajectory point of the third trajectory point, that is
Δxend1=(tcur-tE)*(Vxend1cosθend1-Vyend1sinθend1)Δx end1 = (t cur -t E )*(V xend1 cosθ end1 -V yend1 sinθ end1 )
其中,tcur用于表示当前时刻,tE用于表示当前时刻对应的轨迹点的前一轨迹点对应的时刻,Vxend1用于表示车辆在第三轨迹点的横向速度,Vyend1用于表示车辆在第三轨迹点的纵向速度,θend1用于表示车辆在第三轨迹点的朝向角。Among them, t cur is used to represent the current moment, t E is used to represent the moment corresponding to the previous trajectory point of the trajectory point corresponding to the current moment, V xend1 is used to represent the lateral speed of the vehicle at the third trajectory point, and V yend1 is used to represent The longitudinal velocity of the vehicle at the third trajectory point, θ end1, is used to represent the heading angle of the vehicle at the third trajectory point.
进一步地,一实施例中,所述计算车辆在所述第一轨迹点处与车辆在所述第一轨迹点的前一轨迹点处之间的第三横向距离偏差的步骤,包括:Further, in one embodiment, the step of calculating the third lateral distance deviation between the vehicle at the first trajectory point and the vehicle at the trajectory point preceding the first trajectory point includes:
将车辆在所述第一轨迹点的速度、朝向角以及当前时刻对应的轨迹点的前一轨迹点对应的时刻与当前时刻之间的时长代入第五预设公式,计算得到车辆在所述第一轨迹点处与车辆在所述第一轨迹点的前一轨迹点处之间的第三横向距离偏差Δystart1,第五预设公式如下:Substituting the vehicle's speed and heading angle at the first trajectory point and the time period between the time corresponding to the previous trajectory point of the current time and the current time into the fifth preset formula, the vehicle's speed at the first trajectory is calculated. The third lateral distance deviation Δy start1 between a trajectory point and the vehicle at the previous trajectory point of the first trajectory point, the fifth preset formula is as follows:
Δystart1=(tcur-tE)*(Vystart1sinθstart1+Vystart1cosθstart1)Δy start1 = (t cur -t E )*(V ystart1 sinθ start1 +V ystart1 cosθ start1 )
其中,tcur用于表示当前时刻,tE用于表示当前时刻对应的轨迹点的前一轨迹点对应的时刻,Vystart1用于表示车辆在第一轨迹点的纵向速度,θstart1用于表示车辆在第一轨迹点的朝向角。Among them, t cur is used to represent the current moment, t E is used to represent the moment corresponding to the previous trajectory point of the trajectory point corresponding to the current moment, V ystart1 is used to represent the longitudinal speed of the vehicle at the first trajectory point, and θ start1 is used to represent The heading angle of the vehicle at the first trajectory point.
本实施例中,将车辆在第一轨迹点的速度、车辆在第一轨迹点的朝向角以及当前时刻对应的轨迹点的前一轨迹点对应的时刻与当前时刻之间的时长代入第五预设公式,计算得到车辆在第一轨迹点处与车辆在第一轨迹点的前一轨迹点处之间的第三横向距离偏差Δystart1,第五预设公式如下:In this embodiment, the speed of the vehicle at the first trajectory point, the heading angle of the vehicle at the first trajectory point, and the time between the time corresponding to the previous trajectory point of the trajectory point corresponding to the current time and the current time are substituted into the fifth predetermined time. Set up a formula to calculate the third lateral distance deviation Δy start1 between the vehicle at the first trajectory point and the vehicle at the previous trajectory point of the first trajectory point. The fifth preset formula is as follows:
Δystart1=(tcur-tE)*(Vystart1sinθstart1+Vystart1cosθstart1)Δy start1 = (t cur -t E )*(V ystart1 sinθ start1 +V ystart1 cosθ start1 )
其中,tcur用于表示当前时刻,tE用于表示当前时刻对应的轨迹点的前一轨迹点对应的时刻,Vystart1用于表示车辆在第一轨迹点的纵向速度,θstart1用于表示车辆在第一轨迹点的朝向角。Among them, t cur is used to represent the current moment, t E is used to represent the moment corresponding to the previous trajectory point of the trajectory point corresponding to the current moment, V ystart1 is used to represent the longitudinal speed of the vehicle at the first trajectory point, and θ start1 is used to represent The heading angle of the vehicle at the first trajectory point.
进一步地,一实施例中,将车辆在第三轨迹点的速度、车辆在第三轨迹点的朝向角以及当前时刻对应的轨迹点的前一轨迹点对应的时刻与当前时刻之间的时长代入第五预设公式,计算得到车辆在第三轨迹点处与车辆在第三轨迹点的前一轨迹点处之间的第四横向距离偏差Δyend1,即Further, in one embodiment, the speed of the vehicle at the third trajectory point, the heading angle of the vehicle at the third trajectory point, and the time period between the time corresponding to the previous trajectory point of the trajectory point corresponding to the current time and the current time are substituted into The fifth preset formula calculates the fourth lateral distance deviation Δy end1 between the vehicle at the third trajectory point and the vehicle at the previous trajectory point of the third trajectory point, that is
Δyend1=(tcur-tE)*(Vyend1sinθend1+Vyend1cosθend1)Δy end1 = (t cur -t E )*(V yend1 sinθ end1 +V yend1 cosθ end1 )
其中,tcur用于表示当前时刻,tE用于表示当前时刻对应的轨迹点的前一轨迹点对应的时刻,Vyend1用于表示车辆在第三轨迹点的纵向速度,θend1用于表示车辆在第三轨迹点的朝向角。Among them, t cur is used to represent the current moment, t E is used to represent the moment corresponding to the previous trajectory point of the trajectory point corresponding to the current moment, V yend1 is used to represent the longitudinal speed of the vehicle at the third trajectory point, and θ end1 is used to represent The heading angle of the vehicle at the third trajectory point.
进一步地,一实施例中,所述第一轨迹偏差信息包括第一纵向距离偏差、第一横向距离偏差以及第一朝向角偏差,所述第二轨迹偏差信息包括第二纵向距离偏差、第二横向距离偏差以及第二朝向角偏差,所述基于所述第一轨迹偏差信息、所述第二轨迹偏差信息以及与当前时刻最近的真实车道线信息更新时刻对应的车道线信息得到当前时刻的车道线预测信息的步骤包括:Further, in one embodiment, the first trajectory deviation information includes a first longitudinal distance deviation, a first lateral distance deviation, and a first orientation angle deviation, and the second trajectory deviation information includes a second longitudinal distance deviation, a second longitudinal distance deviation, and a first orientation angle deviation. lateral distance deviation and second orientation angle deviation, the lane at the current moment is obtained based on the first trajectory deviation information, the second trajectory deviation information and the lane line information corresponding to the latest real lane line information update time at the current time The steps for line prediction information include:
基于所述第一纵向距离偏差、第一横向距离偏差、第二纵向距离偏差以及第二横向距离偏差通过两点间距离计算公式计算得到车辆在当前时刻的轨迹点处与车辆在当前时刻轨迹点的前一轨迹点处之间的距离偏差;Based on the first longitudinal distance deviation, the first lateral distance deviation, the second longitudinal distance deviation and the second lateral distance deviation, the distance calculation formula between two points is used to calculate the trajectory point of the vehicle at the current moment and the trajectory point of the vehicle at the current moment. The distance deviation between the previous trajectory points;
计算第二朝向角偏差减去第一朝向角偏差的差值,以所述差值作为车辆在当前时刻的轨迹点处与车辆在当前时刻轨迹点的前一轨迹点处之间的第五朝向角偏差;Calculate the difference of the second orientation angle deviation minus the first orientation angle deviation, and use the difference as the fifth orientation between the vehicle's trajectory point at the current moment and the vehicle's previous trajectory point at the current moment's trajectory point. Angular deviation;
基于所述距离偏差、所述第五朝向角偏差以及与当前时刻最近的真实车道线信息更新时刻对应的车道线信息得到当前时刻的车道线预测信息。The lane line prediction information at the current time is obtained based on the distance deviation, the fifth orientation angle deviation, and the lane line information corresponding to the latest real lane line information update time at the current time.
本实施例中,第一轨迹偏差信息包括第一纵向距离偏差、第一横向距离偏差以及第一朝向角偏差,第二轨迹偏差信息包括第二纵向距离偏差、第二横向距离偏差以及第二朝向角偏差。基于第一纵向距离偏差ΔX1、第一横向距离偏差ΔY1、第二纵向距离偏差ΔX2以及第二横向距离偏差ΔY2通过两点间距离计算公式计算得到车辆在当前时刻的轨迹点处与车辆在当前时刻轨迹点的前一轨迹点处之间的距离偏差,即距离偏差 In this embodiment, the first trajectory deviation information includes a first longitudinal distance deviation, a first lateral distance deviation and a first orientation angle deviation, and the second trajectory deviation information includes a second longitudinal distance deviation, a second lateral distance deviation and a second orientation. Angular deviation. Based on the first longitudinal distance deviation ΔX 1 , the first lateral distance deviation ΔY 1 , the second longitudinal distance deviation ΔX 2 and the second lateral distance deviation ΔY 2 , the vehicle’s trajectory point at the current moment and The distance deviation between the vehicle at the previous trajectory point of the current trajectory point, that is, the distance deviation
以第二朝向角偏差减去第一朝向角偏差的差值作为车辆在当前时刻的轨迹点处与车辆在当前时刻轨迹点的前一轨迹点处之间的第五朝向角偏差Δθ,即Δθ=Δθ2-Δθ1。The difference between the second orientation angle deviation minus the first orientation angle deviation is used as the fifth orientation angle deviation Δθ between the vehicle's trajectory point at the current time and the vehicle's previous trajectory point at the current time trajectory point, that is, Δθ =Δθ 2 -Δθ 1 .
基于距离偏差Δd、第五朝向角偏差Δθ以及与当前时刻最近的真实车道线信息更新时刻对应的车道线信息即可得到当前时刻的车道线预测信息。The lane line prediction information at the current moment can be obtained based on the distance deviation Δd, the fifth orientation angle deviation Δθ, and the lane line information corresponding to the latest real lane line information update time at the current time.
进一步地,一实施例中,所述基于所述距离偏差、所述第五朝向角偏差以及与当前时刻最近的真实车道线信息更新时刻对应的车道线信息得到当前时刻的车道线预测信息的步骤,包括:Further, in one embodiment, the step of obtaining the lane line prediction information at the current time based on the distance deviation, the fifth orientation angle deviation and the lane line information corresponding to the latest real lane line information update time at the current time ,include:
将所述距离偏差、所述第五朝向角偏差以及与当前时刻最近的真实车道线信息更新时刻对应的车道线信息代入第六预设公式,计算得到当前时刻的车道线预测信息,第六预设公式如下:The distance deviation, the fifth orientation angle deviation and the lane line information corresponding to the latest real lane line information update time at the current time are substituted into the sixth preset formula to calculate the lane line prediction information at the current time. The sixth preset formula Let the formula be as follows:
其中,c0、c1、c2以及c3为当前时刻的车道线预测信息,c0用于表示当前时刻车辆与车道线之间的横向距离,c1用于表示当前时刻车辆的朝向角,c2用于表示当前时刻道路的曲率,c3用于表示当前时刻道路的曲率变化率, 以及/>为与当前时刻最近的真实车道线信息更新时刻对应的车道线信息,/>用于表示与当前时刻最近的真实车道线信息更新时刻对应的车辆与车道线之间的横向距离,/>用于表示与当前时刻最近的真实车道线信息更新时刻对应的车辆的朝向角,/>用于表示与当前时刻最近的真实车道线信息更新时刻对应的道路的曲率,/>用于表示与当前时刻最近的真实车道线信息更新时刻对应的道路的曲率变化率。Among them, c 0 , c 1 , c 2 and c 3 are the lane line prediction information at the current moment, c 0 is used to represent the lateral distance between the vehicle and the lane line at the current moment, and c 1 is used to represent the heading angle of the vehicle at the current moment. , c 2 is used to represent the curvature of the road at the current moment, c 3 is used to represent the curvature change rate of the road at the current moment, and/> It is the lane line information corresponding to the latest real lane line information update time at the current time,/> Used to represent the lateral distance between the vehicle and the lane line corresponding to the latest real lane line information update time at the current moment,/> Used to represent the heading angle of the vehicle corresponding to the latest real lane line information update time at the current moment,/> Used to represent the curvature of the road corresponding to the latest real lane information update time at the current moment,/> Used to represent the curvature change rate of the road corresponding to the latest real lane line information update time at the current time.
本实施例中,将距离偏差Δd、第五朝向角偏差Δθ以及与当前时刻最近的真实车道线信息更新时刻对应的车道线信息代入第六预设公式,即可计算得到当前时刻的车道线预测信息,第六预设公式如下:In this embodiment, the distance deviation Δd, the fifth orientation angle deviation Δθ and the lane line information corresponding to the latest real lane line information update time at the current time are substituted into the sixth preset formula to calculate the lane line prediction at the current time. Information, the sixth default formula is as follows:
其中,c0、c1、c2以及c3为当前时刻的车道线预测信息,c0用于表示当前时刻车辆与车道线之间的横向距离,c1用于表示当前时刻车辆的朝向角,c2用于表示当前时刻道路的曲率,c3用于表示当前时刻道路的曲率变化率, 以及/>为与当前时刻最近的真实车道线信息更新时刻对应的车道线信息,/>用于表示与当前时刻最近的真实车道线信息更新时刻对应的车辆与车道线之间的横向距离,/>用于表示与当前时刻最近的真实车道线信息更新时刻对应的车辆的朝向角,/>用于表示与当前时刻最近的真实车道线信息更新时刻对应的道路的曲率,/>用于表示与当前时刻最近的真实车道线信息更新时刻对应的道路的曲率变化率。Among them, c 0 , c 1 , c 2 and c 3 are the lane line prediction information at the current moment, c 0 is used to represent the lateral distance between the vehicle and the lane line at the current moment, and c 1 is used to represent the heading angle of the vehicle at the current moment. , c 2 is used to represent the curvature of the road at the current moment, c 3 is used to represent the curvature change rate of the road at the current moment, and/> It is the lane line information corresponding to the latest real lane line information update time at the current time,/> Used to represent the lateral distance between the vehicle and the lane line corresponding to the latest real lane line information update time at the current moment,/> Used to represent the heading angle of the vehicle corresponding to the latest real lane line information update time at the current moment,/> Used to represent the curvature of the road corresponding to the latest real lane information update time at the current moment,/> Used to represent the curvature change rate of the road corresponding to the latest real lane line information update time at the current time.
进一步地,一实施例中,得到当前时刻的车道线预测信息之后,基于车辆与车道线之间的纵向距离以及当前时刻的车道线预测信息通过车道线信息线性方程得到当前时刻车辆与车道线之间的横向距离,以便基于当前时刻车辆与车道线之间的横向距离对车辆进行控制。车道线信息线性方程如下:Further, in one embodiment, after obtaining the lane line prediction information at the current moment, the relationship between the vehicle and the lane line at the current moment is obtained through the lane line information linear equation based on the longitudinal distance between the vehicle and the lane line and the lane line prediction information at the current moment. The lateral distance between the vehicle and the lane line is used to control the vehicle based on the lateral distance between the vehicle and the lane line at the current moment. The linear equation of lane line information is as follows:
f=c3s3+c2s2+c1s+c0 f=c 3 s 3 +c 2 s 2 +c 1 s+c 0
其中,其中,f用于表示车道线上的点投影到自车纵向中心线方向上的垂线段长度变化,s用于表示车辆当前时刻位置与各个投影点之间的纵向距离。Among them, f is used to represent the length change of the vertical line segment projected from the point on the lane line to the direction of the vehicle's longitudinal centerline, and s is used to represent the longitudinal distance between the vehicle's current position and each projected point.
第二方面,本申请实施例还提供一种车道线信息预测装置。In a second aspect, embodiments of the present application also provide a device for predicting lane line information.
一实施例中,参照图4,图4为本申请车道线信息预测装置一实施例的功能模块示意图。如图4所示,车道线信息预测装置包括:In one embodiment, refer to FIG. 4 , which is a functional module schematic diagram of an embodiment of the lane line information prediction device of the present application. As shown in Figure 4, the lane line information prediction device includes:
确定模块10,用于当当前时刻满足执行车道线信息预测条件且当前时刻对应的轨迹点之前存在至少一个轨迹点时,确定上一次预测车道线信息的时刻对应的车辆行驶轨迹点为第一标记点,与当前时刻最近的真实车道线信息更新时刻对应的车辆行驶轨迹点为第二标记点;The determination module 10 is configured to determine the vehicle driving trajectory point corresponding to the last time when lane line information was predicted as the first mark when the current moment meets the conditions for executing lane line information prediction and there is at least one trajectory point before the trajectory point corresponding to the current moment. point, the vehicle driving trajectory point corresponding to the latest real lane line information update time at the current moment is the second marking point;
第一计算模块20,用于计算车辆在所述第一标记点处与车辆在第一轨迹点处之间的第一轨迹偏差信息,其中,第一轨迹点为第一标记点的前一轨迹点;The first calculation module 20 is used to calculate the first trajectory deviation information between the vehicle at the first marking point and the vehicle at the first trajectory point, where the first trajectory point is the previous trajectory of the first marking point. point;
第二计算模块30,用于计算车辆在所述第二标记点处与车辆在第二轨迹点处之间的第二轨迹偏差信息,其中,第二轨迹点为第二标记点的前一轨迹点;The second calculation module 30 is used to calculate the second trajectory deviation information between the vehicle at the second marking point and the vehicle at the second trajectory point, where the second trajectory point is the previous trajectory of the second marking point. point;
车道线信息预测模块40,用于基于所述第一轨迹偏差信息、所述第二轨迹偏差信息以及与当前时刻最近的真实车道线信息更新时刻对应的车道线信息得到当前时刻的车道线预测信息。The lane line information prediction module 40 is configured to obtain lane line prediction information at the current time based on the first trajectory deviation information, the second trajectory deviation information, and the lane line information corresponding to the latest real lane line information update time at the current time. .
进一步地,一实施例中,所述车道线信息预测条件为:Further, in one embodiment, the lane line information prediction condition is:
a、当前时刻在上一次预测车道线信息的时刻之后;a. The current time is after the last time when lane line information was predicted;
b、当前时刻减去上一次预测车道线信息的时刻的差值小于第一预设时长;b. The difference between the current time and the time of the last predicted lane line information is less than the first preset duration;
c、当前时刻大于上上次预测车道线信息的时刻加上第二预设时长的和,且小于上上次预测车道线信息的时刻加上第三预设时长的和,其中,第二预设时长小于第三预设时长;c. The current time is greater than the sum of the time of the last predicted lane line information plus the second preset duration, and smaller than the sum of the last time of the last predicted lane line information plus the third preset duration, where the second preset time is The duration is set to be less than the third preset duration;
d、当前时刻和上一次预测车道线信息的时刻之间存在真实车道线信息更新时刻。d. There is a real lane line information update time between the current time and the last time the lane line information was predicted.
进一步地,一实施例中,所述第一轨迹偏差信息包括第一纵向距离偏差、第一横向距离偏差以及第一朝向角偏差,第一计算模块20,用于:Further, in one embodiment, the first trajectory deviation information includes a first longitudinal distance deviation, a first lateral distance deviation and a first orientation angle deviation. The first calculation module 20 is used to:
获取与所述第一标记点相邻且在所述第一标记点之后的第三轨迹点;Obtain a third trajectory point adjacent to the first marker point and after the first marker point;
计算车辆在所述第一轨迹点处与车辆在所述第一轨迹点的前一轨迹点处之间的第三纵向距离偏差Δxstart1;Calculate the third longitudinal distance deviation Δx start1 between the vehicle at the first trajectory point and the vehicle at a trajectory point preceding the first trajectory point;
计算车辆在所述第三轨迹点处与车辆在所述第一标记点处之间的第四纵向距离偏差Δxend1;Calculate the fourth longitudinal distance deviation Δx end1 between the vehicle at the third trajectory point and the vehicle at the first mark point;
基于所述第三纵向距离偏差Δxstart1、所述第四纵向距离偏差Δxend1、上一次预测车道线信息的时刻tend、第三轨迹点对应的时刻tend1以及第一轨迹点对应的时刻tstart1通过第一预设公式,计算得到车辆在所述第一标记点处与车辆在第一轨迹点处之间的第一纵向距离偏差,第一预设公式如下:Based on the third longitudinal distance deviation Δx start1 , the fourth longitudinal distance deviation Δx end1 , the time t end of the last predicted lane line information, the time t end1 corresponding to the third trajectory point and the time t corresponding to the first trajectory point start1 calculates the first longitudinal distance deviation between the vehicle at the first marking point and the vehicle at the first trajectory point through the first preset formula. The first preset formula is as follows:
其中,ΔX1用于表示车辆在所述第一标记点处与车辆在第一轨迹点处之间的第一纵向距离偏差;Wherein, ΔX 1 is used to represent the first longitudinal distance deviation between the vehicle at the first mark point and the vehicle at the first trajectory point;
计算车辆在所述第一轨迹点处与车辆在所述第一轨迹点的前一轨迹点处之间的第三横向距离偏差Δystart1;Calculate a third lateral distance deviation Δy start1 between the vehicle at the first trajectory point and the vehicle at a trajectory point preceding the first trajectory point;
计算车辆在所述第三轨迹点处与车辆在所述第一标记点处之间的第四横向距离偏差Δyend1;Calculate the fourth lateral distance deviation Δy end1 between the vehicle at the third trajectory point and the vehicle at the first mark point;
基于所述第三横向距离偏差Δystart1、所述第四横向距离偏差Δyend1、上一次预测车道线信息的时刻tend、第三轨迹点对应的时刻tend1以及第一轨迹点对应的时刻tstart1通过第二预设公式,计算得到车辆在所述第一标记点处与车辆在第一轨迹点处之间的第一横向距离偏差,第二预设公式如下:Based on the third lateral distance deviation Δy start1 , the fourth lateral distance deviation Δy end1 , the time t end of the last predicted lane line information, the time t end1 corresponding to the third trajectory point and the time t corresponding to the first trajectory point start1 calculates the first lateral distance deviation between the vehicle at the first marking point and the vehicle at the first trajectory point through the second preset formula. The second preset formula is as follows:
其中,ΔY1用于表示车辆在所述第一标记点处与车辆在第一轨迹点处之间的第一横向距离偏差;Wherein, ΔY 1 is used to represent the first lateral distance deviation between the vehicle at the first mark point and the vehicle at the first trajectory point;
计算当前时刻对应的轨迹点的前一轨迹点对应的时刻与当前时刻之间的时长乘以车辆在所述第一轨迹点处的角速度的乘积,以所述乘积作为车辆在所述第一轨迹点处与车辆在所述第一轨迹点的前一轨迹点处之间的第三朝向角偏差Δθstart1;Calculate the product of the time length between the time corresponding to the previous trajectory point of the trajectory point corresponding to the current time and the current time multiplied by the angular velocity of the vehicle at the first trajectory point, and use the product as the vehicle's angular velocity at the first trajectory The third orientation angle deviation Δθ start1 between the point and the vehicle at the previous trajectory point of the first trajectory point;
计算当前时刻对应的轨迹点的前一轨迹点对应的时刻与当前时刻之间的时长乘以车辆在所述第三轨迹点处的角速度的乘积,以所述乘积作为车辆在所述第三轨迹点处与车辆在所述第一标记点处之间的第四朝向角偏差Δθend1;Calculate the product of the time length between the time corresponding to the previous trajectory point of the trajectory point corresponding to the current time and the current time multiplied by the angular velocity of the vehicle at the third trajectory point, and use the product as the vehicle's angular velocity at the third trajectory The fourth orientation angle deviation Δθ end1 between the point and the vehicle at the first mark point;
基于所述第三朝向角偏差Δθstart1、所述第四朝向角偏差Δθend1、上一次预测车道线信息的时刻tend、第三轨迹点对应的时刻tend1以及第一轨迹点对应的时刻tstart1通过第三预设公式,计算得到车辆在所述第一标记点处与车辆在第一轨迹点处之间的第一朝向角偏差,第三预设公式如下:Based on the third orientation angle deviation Δθ start1 , the fourth orientation angle deviation Δθ end1 , the time t end of the last predicted lane line information, the time t end1 corresponding to the third trajectory point, and the time t corresponding to the first trajectory point start1 calculates the first orientation angle deviation between the vehicle at the first marking point and the vehicle at the first trajectory point through the third preset formula. The third preset formula is as follows:
其中,Δθ1用于表示车辆在所述第一标记点处与车辆在第一轨迹点处之间的第一朝向角偏差,所述朝向角为车辆与车道中心线之间的夹角。Wherein, Δθ 1 is used to represent the first orientation angle deviation between the vehicle at the first mark point and the vehicle at the first trajectory point, and the orientation angle is the angle between the vehicle and the lane centerline.
进一步地,一实施例中,第一计算模块20,用于:Further, in one embodiment, the first calculation module 20 is used for:
将车辆在所述第一轨迹点的速度、朝向角以及当前时刻对应的轨迹点的前一轨迹点对应的时刻与当前时刻之间的时长代入第四预设公式,计算得到车辆在所述第一轨迹点处与车辆在所述第一轨迹点的前一轨迹点处之间的第三纵向距离偏差Δxstart1,第四预设公式如下:Substituting the speed and heading angle of the vehicle at the first trajectory point and the time period between the time corresponding to the previous trajectory point of the trajectory point corresponding to the current time and the current time into the fourth preset formula, the calculation result is that the vehicle is at the first trajectory point. The third longitudinal distance deviation Δx start1 between a trajectory point and the vehicle at the previous trajectory point of the first trajectory point, the fourth preset formula is as follows:
Δxstart1=(tcur-tE)*(Vxstart1cosθstart1-Vystart1sinθstart1)Δx start1 = (t cur -t E )*(V xstart1 cosθ start1 -V ystart1 sinθ start1 )
其中,tcur用于表示当前时刻,tE用于表示当前时刻对应的轨迹点的前一轨迹点对应的时刻,Vxstart1用于表示车辆在第一轨迹点的横向速度,Vystart1用于表示车辆在第一轨迹点的纵向速度,θstart1用于表示车辆在第一轨迹点的朝向角。Among them, t cur is used to represent the current moment, t E is used to represent the moment corresponding to the previous trajectory point of the trajectory point corresponding to the current moment, V xstart1 is used to represent the lateral speed of the vehicle at the first trajectory point, and V ystart1 is used to represent The longitudinal velocity of the vehicle at the first trajectory point, θ start1, is used to represent the heading angle of the vehicle at the first trajectory point.
进一步地,一实施例中,第一计算模块20,用于:Further, in one embodiment, the first calculation module 20 is used for:
将车辆在所述第一轨迹点的速度、朝向角以及当前时刻对应的轨迹点的前一轨迹点对应的时刻与当前时刻之间的时长代入第五预设公式,计算得到车辆在所述第一轨迹点处与车辆在所述第一轨迹点的前一轨迹点处之间的第三横向距离偏差Δystart1,第五预设公式如下:Substituting the vehicle's speed and heading angle at the first trajectory point and the time period between the time corresponding to the previous trajectory point of the current time and the current time into the fifth preset formula, the vehicle's speed at the first trajectory is calculated. The third lateral distance deviation Δy start1 between a trajectory point and the vehicle at the previous trajectory point of the first trajectory point, the fifth preset formula is as follows:
Δystart1=(tcur-tE)*(Vystart1sinθstart1+Vystart1cosθstart1)Δy start1 = (t cur -t E )*(V ystart1 sinθ start1 +V ystart1 cosθ start1 )
其中,tcur用于表示当前时刻,tE用于表示当前时刻对应的轨迹点的前一轨迹点对应的时刻,Vystart1用于表示车辆在第一轨迹点的纵向速度,θstart1用于表示车辆在第一轨迹点的朝向角。Among them, t cur is used to represent the current moment, t E is used to represent the moment corresponding to the previous trajectory point of the trajectory point corresponding to the current moment, V ystart1 is used to represent the longitudinal speed of the vehicle at the first trajectory point, and θ start1 is used to represent The heading angle of the vehicle at the first trajectory point.
进一步地,一实施例中,所述第一轨迹偏差信息包括第一纵向距离偏差、第一横向距离偏差以及第一朝向角偏差,所述第二轨迹偏差信息包括第二纵向距离偏差、第二横向距离偏差以及第二朝向角偏差,所述车道线信息预测模块40,用于:Further, in one embodiment, the first trajectory deviation information includes a first longitudinal distance deviation, a first lateral distance deviation, and a first orientation angle deviation, and the second trajectory deviation information includes a second longitudinal distance deviation, a second longitudinal distance deviation, and a first orientation angle deviation. The lateral distance deviation and the second orientation angle deviation, the lane line information prediction module 40 is used for:
基于所述第一纵向距离偏差、第一横向距离偏差、第二纵向距离偏差以及第二横向距离偏差通过两点间距离计算公式计算得到车辆在当前时刻的轨迹点处与车辆在当前时刻轨迹点的前一轨迹点处之间的距离偏差;Based on the first longitudinal distance deviation, the first lateral distance deviation, the second longitudinal distance deviation and the second lateral distance deviation, the distance calculation formula between two points is used to calculate the trajectory point of the vehicle at the current moment and the trajectory point of the vehicle at the current moment. The distance deviation between the previous trajectory points;
计算第二朝向角偏差减去第一朝向角偏差的差值,以所述差值作为车辆在当前时刻的轨迹点处与车辆在当前时刻轨迹点的前一轨迹点处之间的第五朝向角偏差;Calculate the difference of the second orientation angle deviation minus the first orientation angle deviation, and use the difference as the fifth orientation between the vehicle's trajectory point at the current moment and the vehicle's previous trajectory point at the current moment's trajectory point. Angular deviation;
基于所述距离偏差、所述第五朝向角偏差以及与当前时刻最近的真实车道线信息更新时刻对应的车道线信息得到当前时刻的车道线预测信息。The lane line prediction information at the current time is obtained based on the distance deviation, the fifth orientation angle deviation, and the lane line information corresponding to the latest real lane line information update time at the current time.
进一步地,一实施例中,所述车道线信息预测模块40,用于:Further, in one embodiment, the lane line information prediction module 40 is used for:
将所述距离偏差、所述第五朝向角偏差以及与当前时刻最近的真实车道线信息更新时刻对应的车道线信息代入第六预设公式,计算得到当前时刻的车道线预测信息,第六预设公式如下:The distance deviation, the fifth orientation angle deviation and the lane line information corresponding to the latest real lane line information update time at the current time are substituted into the sixth preset formula to calculate the lane line prediction information at the current time. The sixth preset formula Let the formula be as follows:
其中,c0、c1、c2以及c3为当前时刻的车道线预测信息,c0用于表示当前时刻车辆与车道线之间的横向距离,c1用于表示当前时刻车辆的朝向角,c2用于表示当前时刻道路的曲率,c3用于表示当前时刻道路的曲率变化率, 以及/>为与当前时刻最近的真实车道线信息更新时刻对应的车道线信息,/>用于表示与当前时刻最近的真实车道线信息更新时刻对应的车辆与车道线之间的横向距离,/>用于表示与当前时刻最近的真实车道线信息更新时刻对应的车辆的朝向角,/>用于表示与当前时刻最近的真实车道线信息更新时刻对应的道路的曲率,/>用于表示与当前时刻最近的真实车道线信息更新时刻对应的道路的曲率变化率。Among them, c 0 , c 1 , c 2 and c 3 are the lane line prediction information at the current moment, c 0 is used to represent the lateral distance between the vehicle and the lane line at the current moment, and c 1 is used to represent the heading angle of the vehicle at the current moment. , c 2 is used to represent the curvature of the road at the current moment, c 3 is used to represent the curvature change rate of the road at the current moment, and/> It is the lane line information corresponding to the latest real lane line information update time at the current time,/> Used to represent the lateral distance between the vehicle and the lane line corresponding to the latest real lane line information update time at the current moment,/> Used to represent the heading angle of the vehicle corresponding to the latest real lane line information update time at the current moment,/> Used to represent the curvature of the road corresponding to the latest real lane information update time at the current moment,/> Used to represent the curvature change rate of the road corresponding to the latest real lane line information update time at the current time.
其中,上述车道线信息预测装置装置中各个模块的功能实现与上述车道线信息预测装置方法实施例中各步骤相对应,其功能和实现过程在此处不再一一赘述。The functional implementation of each module in the above-mentioned lane line information prediction device corresponds to each step in the embodiment of the above-mentioned lane line information prediction device method, and their functions and implementation processes will not be described in detail here.
第三方面,本申请实施例提供一种车道线信息预测装置设备,车道线信息预测装置设备可以是个人计算机(personal computer,PC)、笔记本电脑、服务器等具有数据处理功能的设备。In a third aspect, embodiments of the present application provide a lane line information prediction device. The lane line information prediction device may be a personal computer (PC), laptop, server, or other device with data processing functions.
参照图5,图5为本申请实施例方案中涉及的车道线信息预测装置设备的硬件结构示意图。本申请实施例中,车道线信息预测装置设备可以包括处理器、存储器、通信接口以及通信总线。Referring to Figure 5, Figure 5 is a schematic diagram of the hardware structure of the lane line information prediction device involved in the embodiment of the present application. In this embodiment of the present application, the lane line information prediction device may include a processor, a memory, a communication interface, and a communication bus.
其中,通信总线可以是任何类型的,用于实现处理器、存储器以及通信接口互连。The communication bus can be of any type and is used to interconnect processors, memories and communication interfaces.
通信接口包括输入/输出(input/output,I/O)接口、物理接口和逻辑接口等用于实现车道线信息预测装置设备内部的器件互连的接口,以及用于实现车道线信息预测装置设备与其他设备(例如其他计算设备或用户设备)互连的接口。物理接口可以是以太网接口、光纤接口、ATM接口等;用户设备可以是显示屏(Display)、键盘(Keyboard)等。The communication interface includes an input/output (I/O) interface, a physical interface, a logical interface, and other interfaces used to realize device interconnection within the lane line information prediction device, as well as interfaces used to realize the lane line information prediction device An interface that interconnects with other devices, such as other computing devices or user devices. The physical interface can be an Ethernet interface, an optical fiber interface, an ATM interface, etc.; the user equipment can be a display screen (Display), keyboard (Keyboard), etc.
存储器可以是各种类型的存储介质,例如随机存取存储器(randomaccessmemory,RAM)、只读存储器(read-only memory,ROM)、非易失性RAM(non-volatileRAM,NVRAM)、闪存、光存储器、硬盘、可编程ROM(programmable ROM,PROM)、可擦除PROM(erasable PROM,EPROM)、电可擦除PROM(electrically erasable PROM,EEPROM)等。Memory can be various types of storage media, such as random access memory (RAM), read-only memory (ROM), non-volatile RAM (NVRAM), flash memory, optical memory , hard disk, programmable ROM (PROM), erasable PROM (erasable PROM, EPROM), electrically erasable PROM (electrically erasable PROM, EEPROM), etc.
处理器可以是通用处理器,通用处理器可以调用存储器中存储的车道线信息预测装置程序,并执行本申请实施例提供的车道线信息预测装置方法。例如,通用处理器可以是中央处理器(central processing unit,CPU)。其中,车道线信息预测装置程序被调用时所执行的方法可参照本申请车道线信息预测装置方法的各个实施例,此处不再赘述。The processor may be a general-purpose processor, and the general-purpose processor may call the lane line information prediction device program stored in the memory and execute the lane line information prediction device method provided by the embodiment of the present application. For example, the general-purpose processor may be a central processing unit (CPU). For the method executed when the lane line information prediction device program is called, reference can be made to various embodiments of the lane line information prediction device method of this application, and will not be described again here.
本领域技术人员可以理解,图5中示出的硬件结构并不构成对本申请的限定,可以包括比图示更多或更少的部件,或者组合某些部件,或者不同的部件布置。Those skilled in the art can understand that the hardware structure shown in Figure 5 does not limit the present application, and may include more or fewer components than shown, or combine certain components, or arrange different components.
第四方面,本申请实施例还提供一种计算机可读存储介质。In a fourth aspect, embodiments of the present application further provide a computer-readable storage medium.
本申请计算机可读存储介质上存储有车道线信息预测装置程序,其中所述车道线信息预测装置程序被处理器执行时,实现如上述的车道线信息预测装置方法的步骤。The computer-readable storage medium of the present application stores a lane line information prediction device program, wherein when the lane line information prediction device program is executed by a processor, the steps of the lane line information prediction device method as described above are implemented.
其中,车道线信息预测装置程序被执行时所实现的方法可参照本申请车道线信息预测装置方法的各个实施例,此处不再赘述。For the method implemented when the lane line information prediction device program is executed, reference can be made to various embodiments of the lane line information prediction device method of the present application, and will not be described again here.
需要说明的是,上述本申请实施例序号仅仅为了描述,不代表实施例的优劣。It should be noted that the above serial numbers of the embodiments of the present application are only for description and do not represent the advantages and disadvantages of the embodiments.
本申请的说明书和权利要求书及上述附图中的术语“包括”和“具有”以及它们任何变形,意图在于覆盖不排他的包含。例如包含了一系列步骤或单元的过程、方法、系统、产品或设备没有限定于已列出的步骤或单元,而是可选地还包括没有列出的步骤或单元,或可选地还包括对于这些过程、方法、产品或设备固有的其他步骤或单元。术语“第一”、“第二”和“第三”等描述,是用于区分不同的对象等,其不代表先后顺序,也不限定“第一”、“第二”和“第三”是不同的类型。The terms "including" and "having" and any variations thereof in the description and claims of this application and the above-described drawings are intended to cover non-exclusive inclusion. For example, a process, method, system, product or device that includes a series of steps or units is not limited to the listed steps or units, but optionally also includes steps or units that are not listed, or optionally also includes Other steps or units inherent to such processes, methods, products or devices. The terms "first", "second" and "third" are used to distinguish different objects, etc. They do not represent a sequence, nor do they limit "first", "second" and "third" are different types.
在本申请实施例的描述中,“示例性的”、“例如”或者“举例来说”等用于表示作例子、例证或说明。本申请实施例中被描述为“示例性的”、“例如”或者“举例来说”的任何实施例或设计方案不应被解释为比其它实施例或设计方案更优选或更具优势。确切而言,使用“示例性的”、“例如”或者“举例来说”等词旨在以具体方式呈现相关概念。In the description of the embodiments of this application, "exemplary", "such as" or "for example" are used to represent examples, illustrations or explanations. Any embodiment or design described as "exemplary," "such as," or "for example" in the embodiments of the present application is not to be construed as preferred or advantageous over other embodiments or designs. Rather, use of the words "exemplary," "such as," or "for example" is intended to present the concepts in a concrete manner.
在本申请实施例的描述中,除非另有说明,“/”表示或的意思,例如,A/B可以表示A或B;文本中的“和/或”仅仅是一种描述关联对象的关联关系,表示可以存在三种关系,例如,A和/或B,可以表示:单独存在A,同时存在A和B,单独存在B这三种情况,另外,在本申请实施例的描述中,“多个”是指两个或多于两个。In the description of the embodiments of this application, unless otherwise stated, "/" means or, for example, A/B can mean A or B; "and/or" in the text is just a way to describe the association of associated objects. Relationship means that there can be three relationships. For example, A and/or B can mean: A exists alone, A and B exist simultaneously, and B exists alone. In addition, in the description of the embodiment of this application, " "Plural" means two or more than two.
在本申请实施例描述的一些流程中,包含了按照特定顺序出现的多个操作或步骤,但是应该理解,这些操作或步骤可以不按照其在本申请实施例中出现的顺序来执行或并行执行,操作的序号仅用于区分开各个不同的操作,序号本身不代表任何的执行顺序。另外,这些流程可以包括更多或更少的操作,并且这些操作或步骤可以按顺序执行或并行执行,并且这些操作或步骤可以进行组合。Some of the processes described in the embodiments of this application include multiple operations or steps that appear in a specific order. However, it should be understood that these operations or steps may be performed out of the order in which they appear in the embodiments of this application or in parallel. , the sequence number of the operation is only used to distinguish different operations, the sequence number itself does not represent any execution order. Additionally, these processes may include more or fewer operations, and these operations or steps may be performed sequentially or in parallel, and these operations or steps may be combined.
通过以上的实施方式的描述,本领域的技术人员可以清楚地了解到上述实施例方法可借助软件加必需的通用硬件平台的方式来实现,当然也可以通过硬件,但很多情况下前者是更佳的实施方式。基于这样的理解,本申请的技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的行驶体现出来,该计算机软件产品存储在如上所述的一个存储介质(如ROM/RAM、磁碟、光盘)中,包括若干指令用以使得一台终端设备执行本申请各个实施例所述的方法。Through the above description of the embodiments, those skilled in the art can clearly understand that the methods of the above embodiments can be implemented by means of software plus the necessary general hardware platform. Of course, it can also be implemented by hardware, but in many cases the former is better. implementation. Based on this understanding, the technical solution of the present application is essentially or the part that contributes to the existing technology can be embodied in the form of a software product. The computer software product is stored in a storage medium (such as ROM/RAM) as mentioned above. , magnetic disk, optical disk), including several instructions to cause a terminal device to execute the methods described in various embodiments of the present application.
以上仅为本申请的优选实施例,并非因此限制本申请的专利范围,凡是利用本申请说明书及附图内容所作的等效结构或等效流程变换,或直接或间接运用在其他相关的技术领域,均同理包括在本申请的专利保护范围内。The above are only preferred embodiments of the present application, and are not intended to limit the patent scope of the present application. Any equivalent structure or equivalent process transformation made using the contents of the description and drawings of the present application may be directly or indirectly used in other related technical fields. , are all equally included in the patent protection scope of this application.
Claims (10)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202311717328.0A CN117698734B (en) | 2023-12-12 | 2023-12-12 | Lane line information prediction method, device, equipment and computer readable storage medium |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202311717328.0A CN117698734B (en) | 2023-12-12 | 2023-12-12 | Lane line information prediction method, device, equipment and computer readable storage medium |
Publications (2)
Publication Number | Publication Date |
---|---|
CN117698734A true CN117698734A (en) | 2024-03-15 |
CN117698734B CN117698734B (en) | 2025-01-28 |
Family
ID=90161808
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202311717328.0A Active CN117698734B (en) | 2023-12-12 | 2023-12-12 | Lane line information prediction method, device, equipment and computer readable storage medium |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN117698734B (en) |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111123952A (en) * | 2019-12-31 | 2020-05-08 | 华为技术有限公司 | A kind of trajectory planning method and device |
CN112733270A (en) * | 2021-01-08 | 2021-04-30 | 浙江大学 | System and method for predicting vehicle running track and evaluating risk degree of track deviation |
CN113665589A (en) * | 2021-09-18 | 2021-11-19 | 广州小鹏自动驾驶科技有限公司 | Vehicle longitudinal control method and device, vehicle-mounted terminal and storage medium |
WO2021259000A1 (en) * | 2020-06-24 | 2021-12-30 | 中国第一汽车股份有限公司 | Method and apparatus for controlling vehicle following, vehicle, and storage medium |
CN114228741A (en) * | 2021-11-16 | 2022-03-25 | 智道网联科技(北京)有限公司 | Lane keeping method and apparatus for autonomous vehicle |
CN115731269A (en) * | 2022-11-28 | 2023-03-03 | 重庆长安汽车股份有限公司 | Method and device for predicting road lane line, vehicle and storage medium |
CN116215546A (en) * | 2022-12-23 | 2023-06-06 | 知行汽车科技(苏州)股份有限公司 | Lane center line prediction method and related device |
CN116767186A (en) * | 2023-07-18 | 2023-09-19 | 北京斯年智驾科技有限公司 | A vehicle control method, device, computer equipment and readable storage medium |
-
2023
- 2023-12-12 CN CN202311717328.0A patent/CN117698734B/en active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111123952A (en) * | 2019-12-31 | 2020-05-08 | 华为技术有限公司 | A kind of trajectory planning method and device |
WO2021259000A1 (en) * | 2020-06-24 | 2021-12-30 | 中国第一汽车股份有限公司 | Method and apparatus for controlling vehicle following, vehicle, and storage medium |
CN112733270A (en) * | 2021-01-08 | 2021-04-30 | 浙江大学 | System and method for predicting vehicle running track and evaluating risk degree of track deviation |
CN113665589A (en) * | 2021-09-18 | 2021-11-19 | 广州小鹏自动驾驶科技有限公司 | Vehicle longitudinal control method and device, vehicle-mounted terminal and storage medium |
CN114228741A (en) * | 2021-11-16 | 2022-03-25 | 智道网联科技(北京)有限公司 | Lane keeping method and apparatus for autonomous vehicle |
CN115731269A (en) * | 2022-11-28 | 2023-03-03 | 重庆长安汽车股份有限公司 | Method and device for predicting road lane line, vehicle and storage medium |
CN116215546A (en) * | 2022-12-23 | 2023-06-06 | 知行汽车科技(苏州)股份有限公司 | Lane center line prediction method and related device |
CN116767186A (en) * | 2023-07-18 | 2023-09-19 | 北京斯年智驾科技有限公司 | A vehicle control method, device, computer equipment and readable storage medium |
Also Published As
Publication number | Publication date |
---|---|
CN117698734B (en) | 2025-01-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113715814B (en) | Collision detection method, device, electronic equipment, medium and automatic driving vehicle | |
US10279806B2 (en) | Lane estimating apparatus and method | |
JP7314213B2 (en) | Vehicle positioning method, apparatus, electronic device, storage medium and program | |
JP2021152906A (en) | Method, device, appliance and storage medium for predicting vehicle locus | |
CN112526999B (en) | Speed planning method, device, electronic equipment and storage medium | |
CN111213195B (en) | System and method for vehicle lane change detection | |
CN111209361A (en) | Car following target selection method and device, electronic equipment and readable storage medium | |
US10260895B2 (en) | Apparatus and method for controlling path of vehicle | |
CN114030483B (en) | Vehicle control method, device, electronic equipment and medium | |
CN109991963A (en) | Speed planning method and terminal device | |
CN109684944B (en) | Obstacle detection method, obstacle detection device, computer device, and storage medium | |
CN112528927A (en) | Confidence determination method based on trajectory analysis, roadside equipment and cloud control platform | |
CN117360530A (en) | Speed planning method, device, equipment and storage medium | |
CN113454640A (en) | Method and system for object tracking using online learning | |
CN117053818A (en) | Method and device for positioning intersection where vehicle is in driving process and electronic equipment | |
CN117698734A (en) | Lane line information prediction method, device, equipment and computer readable storage medium | |
CN112489450B (en) | Traffic intersection vehicle flow control method, road side equipment and cloud control platform | |
EP3868625B1 (en) | Bend driving control method and apparatus for autonomous vehicle | |
CN117491963A (en) | A tunnel scene recognition method and device based on 4D millimeter wave radar point cloud | |
JPWO2019053789A1 (en) | Information processing systems, control methods, and programs | |
CN114494391A (en) | An EVO-based SLAM Map Accuracy Confirmation Method and System | |
CN104820822A (en) | Vehicle-mounted road offset identification method and system based on OpenCv Kalman filter | |
CN116563319A (en) | Lane boundary generation method and equipment in vehicle truth value system | |
CN116597417B (en) | Obstacle movement track determining method, device, equipment and storage medium | |
CN119188718A (en) | A robot control method, device, robot and storage medium |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |