Vehicle intersection speed planning method and device, vehicle and storage medium

By calculating vehicle spacing and consulting a safe speedometer, and combining vehicle speed and predicted trajectory to determine the intersection point range, the safety risks in vehicle intersection scenarios are solved, improving the safety and comfort of driving.

CN119018178APending Publication Date: 2024-11-26BEIQI FOTON MOTOR CO LTD
View PDF 0 Cites 1 Cited by

Patent Information

Application Number
CN202410940465.9
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-12
Publication Date
2024-11-26

AI Technical Summary

Technical Problem

Existing technologies do not adequately consider factors such as the speed of oncoming vehicles and road width in scenarios where vehicles meet, leading to an increased risk of traffic accidents.

Method used

By calculating the lateral distance between the current vehicle and the oncoming vehicle, the target safe speed is determined by referring to the preset safe speed table. Combined with the current vehicle speed and the predicted trajectory of the oncoming vehicle, the intersection point interval is determined, and speed planning is performed.

Benefits of technology

It improves vehicle safety and user comfort in intersection scenarios, and ensures safe distances between vehicles and driving reliability.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119018178A_ABST
    Figure CN119018178A_ABST
Patent Text Reader

Abstract

The invention relates to the technical field of vehicles, in particular to a vehicle intersection speed planning method and device, a vehicle and a storage medium, and the method comprises the steps: calculating a transverse vehicle distance when a current vehicle intersects with an opposite vehicle; based on the transverse vehicle distance, looking up a preset intersection vehicle distance safety speed table to obtain a target safety speed when the current vehicle intersects with the opposite vehicle; and the current vehicle speed of the current vehicle and the predicted trajectory of the opposite vehicle are obtained, the intersection interval of the opposite vehicle and the current vehicle is obtained based on a preset deceleration strategy according to the current vehicle speed, the target safety speed and the predicted trajectory of the opposite vehicle, and the speed of the current vehicle is planned based on the target safety speed and the intersection interval. Therefore, the problem that safety risks exist in the intersection scene due to the fact that various actual factors are not fully considered in the related technology is solved, and the safety of vehicle driving and the comfort level of a user are improved by determining the vehicle intersection interval and the vehicle safety speed.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of vehicle technology, and in particular to a vehicle intersection speed planning method, device, vehicle and storage medium. Background Art

[0002] Autonomous driving decision-making planning is the core of the autonomous driving system. Its main task is to make safe and reasonable decisions and corresponding track and speed planning based on the surrounding environmental information and the vehicle's position identified by the perception and positioning system. Track planning mainly involves horizontal planning tasks, such as planning the future driving trajectory based on the current position, speed, size and other information of traffic participants, while longitudinal planning is to plan the speed of the autonomous driving vehicle within a certain period of time in the future based on environmental information.

[0003] In related technologies, longitudinal speed planning usually integrates dimensions such as vehicle design maximum speed, road speed limit, road curvature, maximum acceleration and maximum jerk to obtain the final target speed, and the planning system performs planning based on the target speed.

[0004] However, in intersection scenarios, the speed planning methods of related technologies do not fully take into account factors such as the speed of oncoming vehicles and road width, thereby increasing the risk of traffic accidents and urgently need to be improved. Summary of the invention

[0005] The present application provides a vehicle intersection speed planning method, device, vehicle and storage medium to solve the problem that the relevant technology does not fully consider various practical factors, resulting in safety risks of vehicles in intersection scenarios. By determining the vehicle intersection point interval and the vehicle safety speed, the safety of vehicle driving and the comfort of users are improved.

[0006] The first aspect of the present application provides a vehicle merging speed planning method, comprising the following steps:

[0007] Calculate the lateral vehicle distance when the current vehicle intersects with the oncoming vehicle;

[0008] Based on the lateral vehicle spacing, looking up a preset merging vehicle spacing safety speed table to obtain a target safety speed when the current vehicle merges with the oncoming vehicle;

[0009] The current speed of the current vehicle and the predicted trajectory of the oncoming vehicle are obtained, and based on a preset deceleration strategy, the intersection interval between the oncoming vehicle and the current vehicle is obtained according to the current speed, the target safety speed and the predicted trajectory of the oncoming vehicle, and the speed of the current vehicle is planned based on the target safety speed and the intersection interval.

[0010] According to one embodiment of the present application, the calculating of the lateral vehicle distance when the current vehicle intersects with the oncoming vehicle includes:

[0011] Obtaining the lane width of the lane where the current vehicle is located, the width of the oncoming vehicle, the road width of the road where the current vehicle is located, and the width of the current vehicle;

[0012] The vehicle distance when the current vehicle meets the oncoming vehicle is obtained according to the lane width, the width of the oncoming vehicle, the road width and the width of the current vehicle.

[0013] According to an embodiment of the present application, the preset deceleration strategy is based on the current vehicle speed, the target safety speed and the predicted trajectory of the oncoming vehicle to obtain the intersection interval between the oncoming vehicle and the current vehicle, including:

[0014] Based on a preset selection strategy, an initial deceleration is selected from a preset sequence of decelerations to be selected;

[0015] Based on the initial deceleration, calculating a target time and a target displacement when the current vehicle is decelerated from the current vehicle speed to the target safety speed;

[0016] Based on the target time, finding the target distance between the oncoming vehicle and the current vehicle from the predicted trajectory of the oncoming vehicle;

[0017] If the difference between the target distance and the target displacement is not within the preset distance interval, a new deceleration is reselected from the preset deceleration sequence based on the preset selection strategy until the difference between the new target distance and the new target displacement is within the preset distance interval or the preset deceleration sequence is completely traversed, and the intersection interval is obtained according to the new target distance and the new target displacement.

[0018] According to an embodiment of the present application, before selecting the initial deceleration from the preset deceleration sequence to be selected based on the preset selection strategy, the method further includes:

[0019] Obtaining the maximum deceleration and comfortable deceleration of the current vehicle;

[0020] Based on a preset equidistant sampling generation strategy, the preset candidate deceleration sequence is generated according to the maximum deceleration and the comfortable deceleration.

[0021] According to an embodiment of the present application, the speed planning of the current vehicle based on the target safety speed of the current vehicle and the intersection interval includes:

[0022] Sampling the trajectory of the current vehicle in a preset coordinate system to obtain a plurality of sampling points of the current vehicle;

[0023] A target sampling point in the intersection interval is identified among the multiple sampling points, and a speed upper limit value of the target sampling point is determined according to a minimum value among the target safety speed, the maximum speed of the current vehicle, the road speed limit, and the road curvature speed limit.

[0024] According to the vehicle intersection speed planning method provided in the embodiment of the present application, based on the lateral vehicle spacing when the current vehicle and the oncoming vehicle intersect, the target safety speed when the current vehicle and the oncoming vehicle intersect is obtained by looking up a table, and based on the preset deceleration strategy, the intersection point interval between the oncoming vehicle and the current vehicle is obtained according to the current vehicle speed, the target safety speed and the predicted trajectory of the oncoming vehicle, and the speed of the current vehicle is planned based on the target safety speed and the intersection point interval. Thus, the problem that the relevant technology does not fully consider various practical factors, resulting in safety risks of vehicles in the intersection scene, etc., is solved, and the safety of vehicle driving and the comfort of users are improved by determining the vehicle intersection point interval and the vehicle safety speed.

[0025] A second aspect of the present application provides a vehicle merging speed planning device, comprising:

[0026] A calculation module, used for calculating the lateral vehicle distance when the current vehicle intersects with the oncoming vehicle;

[0027] A query module, configured to query a preset merging vehicle spacing safety speed table based on the lateral vehicle spacing to obtain a target safety speed when the current vehicle merges with the oncoming vehicle;

[0028] A speed planning module is used to obtain the current speed of the current vehicle and the predicted trajectory of the oncoming vehicle, and based on a preset deceleration strategy, obtain the intersection interval between the oncoming vehicle and the current vehicle according to the current speed, the target safety speed and the predicted trajectory of the oncoming vehicle, and perform speed planning for the current vehicle based on the target safety speed and the intersection interval.

[0029] According to one embodiment of the present application, the computing module is used to:

[0030] Obtaining the lane width of the lane where the current vehicle is located, the width of the oncoming vehicle, the road width of the road where the current vehicle is located, and the width of the current vehicle;

[0031] The vehicle distance when the current vehicle meets the oncoming vehicle is obtained according to the lane width, the width of the oncoming vehicle, the road width and the width of the current vehicle.

[0032] According to one embodiment of the present application, the speed planning module is used to:

[0033] Based on a preset selection strategy, an initial deceleration is selected from a preset sequence of decelerations to be selected;

[0034] Based on the initial deceleration, calculating a target time and a target displacement when the current vehicle is decelerated from the current vehicle speed to the target safety speed;

[0035] Based on the target time, finding the target distance between the oncoming vehicle and the current vehicle from the predicted trajectory of the oncoming vehicle;

[0036] If the difference between the target distance and the target displacement is not within the preset distance interval, a new deceleration is reselected from the preset deceleration sequence based on the preset selection strategy until the difference between the new target distance and the new target displacement is within the preset distance interval or the preset deceleration sequence is completely traversed, and the intersection interval is obtained according to the new target distance and the new target displacement.

[0037] According to one embodiment of the present application, before selecting the initial deceleration from the preset deceleration sequence to be selected based on the preset selection strategy, the speed planning module is further used to:

[0038] Obtaining the maximum deceleration and comfortable deceleration of the current vehicle;

[0039] Based on a preset equidistant sampling generation strategy, the preset candidate deceleration sequence is generated according to the maximum deceleration and the comfortable deceleration.

[0040] According to one embodiment of the present application, the speed planning module is used to:

[0041] Sampling the trajectory of the current vehicle in a preset coordinate system to obtain a plurality of sampling points of the current vehicle;

[0042] A target sampling point in the intersection interval is identified among the multiple sampling points, and a speed upper limit value of the target sampling point is determined according to a minimum value among the target safety speed, the maximum speed of the current vehicle, the road speed limit, and the road curvature speed limit.

[0043] According to the vehicle intersection speed planning device provided in the embodiment of the present application, based on the lateral vehicle spacing when the current vehicle and the oncoming vehicle intersect, the target safety speed when the current vehicle and the oncoming vehicle intersect is obtained by looking up a table, and based on the preset deceleration strategy, the intersection point interval between the oncoming vehicle and the current vehicle is obtained according to the current vehicle speed, the target safety speed and the predicted trajectory of the oncoming vehicle, and the speed of the current vehicle is planned based on the target safety speed and the intersection point interval. Thus, the problem that the relevant technology does not fully consider various practical factors, resulting in safety risks of vehicles in intersection scenarios, etc., is solved, and the safety of vehicle driving and the comfort of users are improved by determining the vehicle intersection point interval and the vehicle safety speed.

[0044] The third aspect of the present application provides a vehicle, comprising: a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor executes the program to implement the vehicle intersection speed planning method as described in the above embodiment.

[0045] A fourth aspect of the present application provides a computer-readable storage medium, wherein the computer-readable storage medium stores computer instructions, and the computer instructions are used to enable the computer to execute the vehicle intersection speed planning method as described in the above embodiment.

[0046] Additional aspects and advantages of the present application will be given in part in the description below, and in part will become apparent from the description below, or will be learned through the practice of the present application. BRIEF DESCRIPTION OF THE DRAWINGS

[0047] The above and / or additional aspects and advantages of the present application will become apparent and easily understood from the following description of the embodiments in conjunction with the accompanying drawings, in which:

[0048] Figure 1 A flow chart of a vehicle merging speed planning method provided according to an embodiment of the present application;

[0049] Figure 2 A flowchart of a vehicle merging speed planning method according to an embodiment of the present application;

[0050] Figure 3 Schematic diagram of a block diagram of a vehicle merging speed planning device according to an embodiment of the present application;

[0051] Figure 4 A schematic diagram of the structure of a vehicle provided in an embodiment of the present application. DETAILED DESCRIPTION

[0052] Embodiments of the present application are described in detail below, and examples of the embodiments are shown in the accompanying drawings, wherein the same or similar reference numerals throughout represent the same or similar elements or elements having the same or similar functions. The embodiments described below with reference to the accompanying drawings are exemplary and are intended to be used to explain the present application, and should not be construed as limiting the present application.

[0053] The following describes the vehicle intersection speed planning method, device, vehicle and storage medium of the embodiments of the present application with reference to the accompanying drawings.

[0054] Before introducing the vehicle intersection speed planning method of the embodiment of the present application, a brief introduction to the automatic driving speed planning method in the related art is first given.

[0055] In related technologies, speed planning of autonomous vehicles usually relies on optimization-based planning methods, which focus on setting a speed limit for each sampling point based on lateral trajectory planning to generate the final driving path.

[0056] However, due to certain limitations of this method in vehicle intersection scenarios, it is impossible to ensure safe vehicle spacing and driving comfort when vehicles intersect. Based on this, this application proposes a vehicle intersection speed planning method, which calculates the lateral spacing between the current vehicle and the oncoming vehicle, searches for a preset safe speed table to determine the target safe speed, and combines the current vehicle speed, the predicted trajectory of the oncoming vehicle, and the preset deceleration strategy to determine the intersection point interval, and accordingly plans the speed of the current vehicle, effectively improving the safety and reliability of autonomous driving vehicles in intersection scenarios.

[0057] Specifically, Figure 1 A flow chart of a vehicle intersection speed planning method provided in an embodiment of the present application.

[0058] like Figure 1 As shown, the vehicle intersection speed planning method includes the following steps:

[0059] In step S101 , the lateral vehicle distance between the current vehicle and the oncoming vehicle when they meet is calculated.

[0060] Among them, the lateral vehicle spacing when the current vehicle intersects with the oncoming vehicle refers to the minimum distance that needs to be maintained between the current vehicle and the oncoming vehicle in order to ensure driving safety during the intersection process.

[0061] Specifically, the embodiment of the present application can comprehensively consider multiple factors such as vehicle speed, road conditions and vehicle type, so as to calculate the lateral vehicle distance when the current vehicle intersects with the oncoming vehicle.

[0062] Furthermore, in some embodiments, calculating the lateral vehicle distance when the current vehicle intersects the oncoming vehicle includes: obtaining the lane width of the lane in which the current vehicle is located, the width of the oncoming vehicle, the road width of the road in which the current vehicle is located, and the width of the current vehicle; and obtaining the vehicle distance when the current vehicle intersects the oncoming vehicle based on the lane width, the width of the oncoming vehicle, the road width, and the width of the current vehicle.

[0063] The road width of the road where the current vehicle is located refers to the sum of the width of the lane where the current vehicle is located and the width of the adjacent lane (if any).

[0064] Optionally, the embodiment of the present application can obtain the real-time external dimensions of the current vehicle and the external dimensions of the intersecting vehicle in the opposite lane through the vehicle perception system, thereby obtaining the width of the current vehicle and the width of the opposite vehicle. The lane width of the lane in which the current vehicle is located and the road width of the road in which the current vehicle is located can also be obtained through the perception system or high-precision map, which is not specifically limited here.

[0065] Furthermore, the lateral vehicle spacing when the current vehicle intersects with the oncoming vehicle can be obtained based on the lane width, the width of the oncoming vehicle, the road width, and the width of the current vehicle:

[0066]

[0067] Among them, I self-obj is the distance between the current vehicle and the oncoming vehicle when they meet, W lane0 is the lane width, W lane1 is the road width, W obj is the width of the oncoming vehicle, W self is the width of the current vehicle.

[0068] In step S102, based on the lateral vehicle distance, a preset merging vehicle distance safety speed table is looked up to obtain a target safety speed when the current vehicle merges with an oncoming vehicle.

[0069] Optionally, those skilled in the art may establish a mapping relationship between the merging vehicle distance and the safe speed by manual calibration according to actual conditions, that is, establish a preset merging vehicle distance safe speed table.

[0070] Furthermore, the elements of the preset intersecting vehicle spacing safety speed table in the embodiment of the present application include vehicle spacing and safety speed. The mapping relationship between vehicle spacing and safety speed can be persistently stored on the disk, read into the system memory during the system operation phase, and stored in the memory using a map container T, where the vehicle spacing is the key and the safety speed is the value.

[0071] For example, the preset safe speed table for the intersecting vehicle spacing in the embodiment of the present application may be as shown in Table 1:

[0072] Table 1

[0073] Distance between vehicles(key) Safe speed (Value) … … 0.5m 30km / h 0.3m 10km / h 0.20m 5km / h 0.10m 1km / h

[0074] Furthermore, the lateral vehicle spacing obtained by the above calculation is used as the vehicle spacing key value, and a preset intersecting vehicle spacing safety speed table is looked up to obtain a target safety speed when the current vehicle intersects with an oncoming vehicle.

[0075] For example, taking Table 1 as an example, assuming that the lateral vehicle spacing obtained by calculation is 0.2 meters, Table 1 is looked up with the vehicle spacing key as 0.2 meters, and the corresponding safe speed when the vehicle spacing is 0.2 meters is obtained as 5km / h, and 5km / h is used as the target safe speed when the current vehicle intersects with the oncoming vehicle.

[0076] In step S103, the current speed of the current vehicle and the predicted trajectory of the oncoming vehicle are obtained, and based on the preset deceleration strategy, the intersection interval between the oncoming vehicle and the current vehicle is obtained according to the current speed, the target safety speed and the predicted trajectory of the oncoming vehicle, and the speed of the current vehicle is planned based on the target safety speed and the intersection interval.

[0077] Optionally, the embodiment of the present application can obtain the current speed of the current vehicle through a vehicle-mounted sensor, and can obtain the trajectory information of the oncoming vehicle within a certain period of time in the future (i.e., the predicted trajectory of the oncoming vehicle) through a vehicle prediction system, which is not specifically limited here.

[0078] Specifically, after obtaining the current speed of the current vehicle and the predicted trajectory of the oncoming vehicle, based on the preset deceleration strategy, and according to the current speed, the target safety speed and the predicted trajectory of the oncoming vehicle, the area where the oncoming vehicle and the current vehicle may intersect can be determined, that is, the intersection interval. According to the position and size of the intersection interval, the risk of the current vehicle intersecting with the oncoming vehicle can be evaluated, and the speed of the current vehicle can be planned based on the target safety speed and the intersection interval, so as to ensure the safe driving of the vehicle.

[0079] Further, in some embodiments, based on a preset deceleration strategy, the intersection point interval between the oncoming vehicle and the current vehicle is obtained according to the current vehicle speed, the target safety speed and the predicted trajectory of the oncoming vehicle, including: based on a preset selection strategy, selecting an initial deceleration from a preset deceleration sequence to be selected; based on the initial deceleration, calculating the target time and target displacement when the current vehicle decelerates from the current vehicle speed to the target safety speed; based on the target time, searching the target distance between the oncoming vehicle and the current vehicle from the predicted trajectory of the oncoming vehicle; if the difference between the target distance and the target displacement is not within the preset distance interval, re-selecting a new deceleration from the preset deceleration sequence to be selected based on the preset selection strategy, until the difference between the new target distance and the new target displacement is within the preset distance interval or the preset deceleration sequence to be selected is traversed in its entirety, and the intersection point interval is obtained according to the new target distance and the new target displacement.

[0080] Among them, the target distance and the target displacement are both longitudinal vehicle distances, and the preset distance interval can be a distance interval pre-set by technical personnel in this field, can be a distance interval obtained through a limited number of experiments, or can be a distance interval obtained through computer simulation, which is not specifically limited here.

[0081] It should be noted that the preset distance interval is a positive distance interval, for example, 0≤do-ds≤gap, wherein do is the target distance, ds is the target displacement, and gap is a preset positive value.

[0082] Preferably, the preset selection strategy can select the decelerations in the preset deceleration sequence to be selected in ascending order.

[0083] Specifically, based on a preset selection strategy, the first deceleration in the preset deceleration sequence is selected as the initial deceleration, and the initial deceleration is used as the deceleration of the current vehicle. Based on the current speed of the current vehicle, the target time and target displacement when decelerating to the target safety speed are calculated.

[0084] The target time is:

[0085]

[0086] Among them, t is the target time, V self-safe is the target safety speed, V self-current is the current speed of the vehicle, a i is the initial deceleration;

[0087] The target displacement is:

[0088]

[0089] Where ds is the target displacement, V self-currentis the current speed of the vehicle, V self-safe is the target safety speed, a i is the initial deceleration.

[0090] Furthermore, the target distance between the oncoming vehicle and the current vehicle at the target time is found from the predicted trajectory of the oncoming vehicle. If the difference between the target distance and the target displacement is in the preset distance interval, or all the candidate decelerations in the preset candidate deceleration sequence are traversed, the intersection point interval is determined, the loop is exited and the intersection point interval {ds, do} is returned, where ds is the target displacement and do is the target distance.

[0091] Furthermore, if the difference between the target distance and the target displacement is not within the preset distance interval, it means that the deceleration currently selected from the preset deceleration sequence is small, and a larger deceleration needs to be selected to quickly reduce the vehicle speed. Therefore, a new larger deceleration is selected from the preset deceleration sequence until the difference between the new target distance and the new target displacement is within the preset distance interval or the preset deceleration sequence is completely traversed to ensure that the current vehicle can reduce the speed to below the target safety speed within the intersection interval and maintain a sufficient safety distance, and then obtain the intersection interval according to the new target distance and the new target displacement.

[0092] Furthermore, in some embodiments, before selecting the initial deceleration from a preset deceleration sequence to be selected based on a preset selection strategy, it also includes: obtaining the maximum deceleration and comfortable deceleration of the current vehicle; based on a preset equidistant sampling generation strategy, generating a preset deceleration sequence to be selected according to the maximum deceleration and the comfortable deceleration.

[0093] The maximum deceleration refers to the maximum deceleration value that the vehicle can safely and effectively reach, and the comfortable deceleration refers to the deceleration that the passengers feel comfortable with during the deceleration process. In the embodiment of the present application, the maximum deceleration and comfortable deceleration of the current vehicle can be obtained through the vehicle-mounted sensor, which is not specifically limited here.

[0094] Optionally, those skilled in the art may pre-set a sampling interval based on actual needs, and the pre-set sampling interval determines the difference between two adjacent deceleration values ​​in a preset deceleration sequence.

[0095] Specifically, the embodiment of the present application can start from the comfortable deceleration, with a preset sampling interval as the step length, and incrementally generate deceleration values ​​until the maximum deceleration is reached or exceeded. If the last generated deceleration value exceeds the maximum deceleration, it can be set as the maximum deceleration, or discarded, so as to obtain a preset deceleration sequence to be selected. The preset deceleration sequence to be selected can be as follows:

[0096] A={a0,a1...an |a0=acc relax , a n =acc max}

[0097] Among them, A is the preset deceleration sequence to be selected, acc relax is the current vehicle's comfortable deceleration, acc max is the current maximum deceleration of the vehicle.

[0098] In order to facilitate those skilled in the art to understand the process of obtaining the intersection point interval in the embodiment of the present application, an example is given below.

[0099] For example, assuming that the selected decelerations in the preset sequence of selected decelerations are a0, a1, a2, and a3, first, the target displacement ds0 and the target distance do0 of the current vehicle are calculated based on a0. If the difference between ds0 and do0 is not within the preset distance interval, the target displacement ds1 and the target distance do1 of the current vehicle are calculated based on a1. If the difference between ds1 and do1 is also not within the preset distance interval, the target displacement ds2 and the target distance do2 of the current vehicle are calculated based on a2. If the difference between ds2 and do2 is still If it is not in the preset distance interval, the target displacement ds3 and target distance do3 of the current vehicle are calculated based on the last selected deceleration a3 in the selected deceleration sequence; if the difference between ds3 and do3 is in the preset distance interval, the intersection interval is obtained according to the target displacement ds3 and the target distance do3; if the difference between ds3 and do3 is not in the preset distance interval, considering that the selected deceleration a3 is the last selected deceleration in the selected deceleration sequence, the intersection interval is still obtained according to the target displacement ds3 and the target distance do3.

[0100] Furthermore, in some embodiments, speed planning is performed on the current vehicle based on the target safety speed and the intersection interval of the current vehicle, including: sampling the trajectory of the current vehicle in a preset coordinate system to obtain multiple sampling points of the current vehicle; identifying a target sampling point in the intersection interval among the multiple sampling points, and determining an upper speed limit value of the target sampling point according to the minimum value of the target safety speed, the maximum speed of the current vehicle, the road speed limit, and the road curvature speed limit.

[0101] Among them, the preset coordinate system may be the SL coordinate system.

[0102] Specifically, the embodiment of the present application can sample the trajectory output by the current vehicle in the SL coordinate system by adopting a quadratic optimization method to obtain multiple sampling points of the current vehicle, and set a speed limit for each sampling point according to the vehicle's maximum speed, road speed limit, and road curvature speed limit. For the intersection scenario of the present application, on the basis of the above speed, the present application considers the target safety speed, that is, if the sampling point is identified as being in the intersection point interval, the sampling point is determined to be the target sampling point, and the minimum value among the target safety speed, vehicle maximum speed, road speed limit, and road curvature speed limit is selected as the speed limit value of the target sampling point.

[0103] For example, assuming that the target safety speed is V1, the vehicle maximum speed is V2, the road speed limit is V3, and the road curvature speed limit is V4, and the relationship among the target safety speed V1, the vehicle maximum speed V2, the road speed limit V3 and the road curvature speed limit V4 is V2>V4>V1>V3, then the road speed limit V3 is used as the speed upper limit value of the target sampling point.

[0104] In order to facilitate those skilled in the art to more clearly and intuitively understand the vehicle intersection speed planning method of the embodiment of the present application, the following is combined with Figure 2 Provide detailed explanation.

[0105] like Figure 2 As shown, the vehicle intersection speed planning method includes the following steps:

[0106] S201, establishing a safe speed table for the distance between merging vehicles.

[0107] S202, dynamically calculate the safe speed of the vehicle when merging.

[0108] S203, calculating the intersection point interval.

[0109] S204, speed planning.

[0110] S205, output the track.

[0111] Therefore, by calculating the safe speed and intersection point interval of the vehicle, and planning the speed of the vehicle according to the safe speed and intersection point interval, the safety of the autonomous driving vehicle and the oncoming vehicle in the intersection scenario is improved.

[0112] According to the vehicle intersection speed planning method proposed in the embodiment of the present application, based on the lateral vehicle spacing when the current vehicle and the oncoming vehicle intersect, the target safety speed when the current vehicle and the oncoming vehicle intersect is obtained by looking up a table, and based on the preset deceleration strategy, the intersection point interval between the oncoming vehicle and the current vehicle is obtained according to the current vehicle speed, the target safety speed and the predicted trajectory of the oncoming vehicle, and the speed of the current vehicle is planned based on the target safety speed and the intersection point interval. In this way, the problem that the relevant technology does not fully consider various practical factors, resulting in safety risks of vehicles in intersection scenarios, etc. is solved. By determining the vehicle intersection point interval and the vehicle safety speed, the safety of vehicle driving and the comfort of users are improved.

[0113] Next, the vehicle intersection speed planning device proposed according to the embodiment of the present application is described with reference to the accompanying drawings.

[0114] Figure 3 It is a block diagram of a vehicle intersection speed planning device according to an embodiment of the present application.

[0115] like Figure 3 As shown, the vehicle intersection speed planning device 10 includes: a calculation module 100, a query module 200 and a speed planning module 300.

[0116] Among them, the calculation module 100 is used to calculate the lateral vehicle distance when the current vehicle intersects with the oncoming vehicle; the query module 200 is used to look up the target safety speed when the current vehicle intersects with the oncoming vehicle from a preset intersection vehicle distance safety speed table based on the lateral vehicle distance; the speed planning module 300 is used to obtain the current vehicle speed of the current vehicle and the predicted trajectory of the oncoming vehicle, and based on the preset deceleration strategy, obtain the intersection point interval between the oncoming vehicle and the current vehicle according to the current vehicle speed, the target safety speed and the predicted trajectory of the oncoming vehicle, and plan the speed of the current vehicle based on the target safety speed and the intersection point interval.

[0117] Furthermore, in some embodiments, the calculation module 100 is used to: obtain the lane width of the lane in which the current vehicle is located, the width of the oncoming vehicle, the road width of the road in which the current vehicle is located, and the width of the current vehicle; and obtain the vehicle distance when the current vehicle intersects the oncoming vehicle based on the lane width, the width of the oncoming vehicle, the road width, and the width of the current vehicle.

[0118] Further, in some embodiments, the speed planning module 300 is used to: select an initial deceleration from a preset deceleration sequence to be selected based on a preset selection strategy; calculate a target time and a target displacement when the current vehicle decelerates from the current vehicle speed to the target safety speed based on the initial deceleration; find a target distance between the oncoming vehicle and the current vehicle from the predicted trajectory of the oncoming vehicle based on the target time; if the difference between the target distance and the target displacement is not within the preset distance interval, reselect a new deceleration from the preset deceleration sequence to be selected based on the preset selection strategy, until the difference between the new target distance and the new target displacement is within the preset distance interval or the preset deceleration sequence to be selected is traversed in its entirety, and the intersection interval is obtained according to the new target distance and the new target displacement.

[0119] Furthermore, in some embodiments, before selecting the initial deceleration from a preset deceleration sequence to be selected based on a preset selection strategy, the speed planning module is also used to: obtain the maximum deceleration and comfortable deceleration of the current vehicle; and generate a preset deceleration sequence to be selected based on the maximum deceleration and comfortable deceleration based on a preset equidistant sampling generation strategy.

[0120] Furthermore, in some embodiments, the speed planning module 300 is used to: sample the trajectory of the current vehicle in a preset coordinate system to obtain multiple sampling points of the current vehicle; identify a target sampling point in the intersection interval among the multiple sampling points, and determine the speed upper limit value of the target sampling point according to the minimum value of the target safety speed, the maximum speed of the current vehicle, the road speed limit, and the road curvature speed limit.

[0121] It should be noted that the above explanations of the vehicle merging speed planning method embodiment are also applicable to the vehicle merging speed planning device of this embodiment, and will not be repeated here.

[0122] According to the vehicle intersection speed planning device proposed in the embodiment of the present application, based on the lateral vehicle spacing when the current vehicle and the oncoming vehicle intersect, the target safety speed when the current vehicle and the oncoming vehicle intersect is obtained by looking up a table, and based on the preset deceleration strategy, the intersection point interval between the oncoming vehicle and the current vehicle is obtained according to the current vehicle speed, the target safety speed and the predicted trajectory of the oncoming vehicle, and the speed of the current vehicle is planned based on the target safety speed and the intersection point interval. In this way, the problem that the relevant technology does not fully consider various practical factors, resulting in safety risks of vehicles in intersection scenarios, etc. is solved. By determining the vehicle intersection point interval and the vehicle safety speed, the safety of vehicle driving and the comfort of users are improved.

[0123] Figure 4 A schematic diagram of the structure of a vehicle provided in an embodiment of the present application. The vehicle may include:

[0124] Memory 401 , processor 402 , and a computer program stored in the memory 401 and executable on the processor 402 .

[0125] When the processor 402 executes the program, the vehicle merging speed planning method provided in the above embodiment is implemented.

[0126] Furthermore, the vehicle also includes:

[0127] The communication interface 403 is used for communication between the memory 401 and the processor 402 .

[0128] The memory 401 is used to store computer programs that can be executed on the processor 402 .

[0129] The memory 401 may include a high-speed RAM memory, and may also include a non-volatile memory (non-volatile memory), such as at least one disk memory.

[0130] If the memory 401, the processor 402 and the communication interface 403 are implemented independently, the communication interface 403, the memory 401 and the processor 402 can be connected to each other through a bus and communicate with each other. The bus can be an Industry Standard Architecture (ISA) bus, a Peripheral Component Interconnect (PCI) bus or an Extended Industry Standard Architecture (EISA) bus. The bus can be divided into an address bus, a data bus, a control bus, etc. For ease of representation, Figure 4 Only one thick line is used in the diagram, but this does not mean that there is only one bus or only one type of bus.

[0131] Optionally, in a specific implementation, if the memory 401, the processor 402 and the communication interface 403 are integrated on a chip, the memory 401, the processor 402 and the communication interface 403 can communicate with each other through an internal interface.

[0132] The processor 402 may be a central processing unit (CPU), or an application specific integrated circuit (ASIC), or one or more integrated circuits configured to implement the embodiments of the present application.

[0133] An embodiment of the present application also provides a computer-readable storage medium having a computer program stored thereon, which, when executed by a processor, implements the above vehicle intersection speed planning method.

[0134] In the description of this specification, the description with reference to the terms "one embodiment", "some embodiments", "example", "specific example", or "some examples" etc. means that the specific features, structures, materials or characteristics described in conjunction with the embodiment or example are included in at least one embodiment or example of the present application. In this specification, the schematic representations of the above terms do not necessarily refer to the same embodiment or example. Moreover, the specific features, structures, materials or characteristics described may be combined in any one or N embodiments or examples in a suitable manner. In addition, those skilled in the art may combine and combine the different embodiments or examples described in this specification and the features of the different embodiments or examples, without contradiction.

[0135] In addition, the terms "first" and "second" are used for descriptive purposes only and should not be understood as indicating or implying relative importance or implicitly indicating the number of technical features indicated. Therefore, a feature defined as "first" or "second" may explicitly or implicitly include at least one of the features. In the description of this application, "N" means at least two, such as two, three, etc., unless otherwise clearly and specifically defined.

[0136] Any process or method description in a flowchart or otherwise described herein may be understood to represent a module, fragment or portion of code comprising one or more executable instructions for implementing the steps of a custom logical function or process, and the scope of the preferred embodiments of the present application includes alternative implementations in which functions may not be performed in the order shown or discussed, including performing functions in a substantially simultaneous manner or in reverse order depending on the functions involved, which should be understood by technicians in the technical field to which the embodiments of the present application belong.

[0137] The logic and / or steps represented in the flowchart or otherwise described herein, for example, can be considered as an ordered list of executable instructions for implementing logical functions, and can be embodied in any computer-readable medium for use by an instruction execution system, device or apparatus (such as a computer-based system, a system including a processor, or other system that can fetch instructions from an instruction execution system, device or apparatus and execute instructions), or in combination with these instruction execution systems, devices or apparatuses. For the purpose of this specification, "computer-readable medium" can be any device that can contain, store, communicate, propagate or transmit a program for use by an instruction execution system, device or apparatus, or in combination with these instruction execution systems, devices or apparatuses. More specific examples of computer-readable media (a non-exhaustive list) include the following: an electrical connection with one or N wirings (electronic devices), a portable computer disk box (magnetic device), a random access memory (RAM), a read-only memory (ROM), an erasable and programmable read-only memory (EPROM or flash memory), a fiber optic device, and a portable compact disk read-only memory (CDROM). In addition, the computer-readable medium may even be paper or other suitable medium on which the program is printed, since the program may be obtained electronically, for example, by optically scanning the paper or other medium and then editing, interpreting or processing in other suitable ways if necessary, and then stored in a computer memory.

[0138] It should be understood that the various parts of the present application can be implemented by hardware, software, firmware or a combination thereof. In the above-mentioned embodiment, the N steps or methods can be implemented by software or firmware stored in a memory and executed by a suitable instruction execution system. For example, if implemented by hardware, as in another embodiment, it can be implemented by any one of the following technologies known in the art or their combination: a discrete logic circuit having a logic gate circuit for implementing a logic function for a data signal, a dedicated integrated circuit having a suitable combination of logic gate circuits, a programmable gate array (PGA), a field programmable gate array (FPGA), etc.

[0139] A person skilled in the art may understand that all or part of the steps in the method for implementing the above-mentioned embodiment may be completed by instructing related hardware through a program, and the program may be stored in a computer-readable storage medium, which, when executed, includes one or a combination of the steps of the method embodiment.

[0140] In addition, each functional unit in each embodiment of the present application may be integrated into a processing module, or each unit may exist physically separately, or two or more units may be integrated into one module. The above-mentioned integrated module may be implemented in the form of hardware or in the form of a software functional module. If the integrated module is implemented in the form of a software functional module and sold or used as an independent product, it may also be stored in a computer-readable storage medium.

[0141] The storage medium mentioned above may be a read-only memory, a magnetic disk or an optical disk, etc. Although the embodiments of the present application have been shown and described above, it can be understood that the above embodiments are exemplary and cannot be understood as limiting the present application. A person of ordinary skill in the art may change, modify, replace and modify the above embodiments within the scope of the present application.

Claims

1. A vehicle merging speed planning method, characterized in that: The following steps are involved: Calculate the lateral vehicle distance when the current vehicle intersects with the oncoming vehicle; Based on the lateral vehicle spacing, looking up a preset merging vehicle spacing safety speed table to obtain a target safety speed when the current vehicle merges with the oncoming vehicle; The current speed of the current vehicle and the predicted trajectory of the oncoming vehicle are obtained, and based on a preset deceleration strategy, an intersection interval between the oncoming vehicle and the current vehicle is obtained according to the current speed, the target safety speed and the predicted trajectory of the oncoming vehicle, and speed planning is performed for the current vehicle based on the target safety speed and the intersection interval.

2. The method according to claim 1, characterized in that: The calculating of the lateral vehicle distance when the current vehicle intersects with the oncoming vehicle includes: Obtaining the lane width of the lane where the current vehicle is located, the width of the oncoming vehicle, the road width of the road where the current vehicle is located, and the width of the current vehicle; A lateral vehicle distance when the current vehicle meets the oncoming vehicle is obtained according to the lane width, the width of the oncoming vehicle, the road width and the width of the current vehicle.

3. The method according to claim 1, characterized in that The step of obtaining the intersection interval between the oncoming vehicle and the current vehicle based on the preset deceleration strategy according to the current vehicle speed, the target safety speed and the predicted trajectory of the oncoming vehicle includes: Based on a preset selection strategy, an initial deceleration is selected from a preset sequence of decelerations to be selected; Based on the initial deceleration, calculating a target time and a target displacement when the current vehicle is decelerated from the current vehicle speed to the target safety speed; Based on the target time, finding the target distance between the oncoming vehicle and the current vehicle from the predicted trajectory of the oncoming vehicle; If the difference between the target distance and the target displacement is not within the preset distance interval, a new deceleration is reselected from the preset deceleration sequence based on the preset selection strategy until the difference between the new target distance and the new target displacement is within the preset distance interval or the preset deceleration sequence is completely traversed, and the intersection interval is obtained according to the new target distance and the new target displacement.

4. The method according to claim 3, characterized in that Before selecting the initial deceleration from the preset sequence of decelerations to be selected based on the preset selection strategy, the method further includes: Obtaining the maximum deceleration and comfortable deceleration of the current vehicle; Based on a preset equidistant sampling generation strategy, the preset candidate deceleration sequence is generated according to the maximum deceleration and the comfortable deceleration.

5. The method according to claim 1, characterized in that The performing speed planning for the current vehicle based on the target safety speed of the current vehicle and the intersection interval includes: Sampling the trajectory of the current vehicle in a preset coordinate system to obtain a plurality of sampling points of the current vehicle; A target sampling point in the intersection interval is identified among the multiple sampling points, and a speed upper limit value of the target sampling point is determined according to a minimum value among the target safety speed, the maximum speed of the current vehicle, the road speed limit, and the road curvature speed limit.

6. A vehicle merging speed planning device, characterized in that: include: A calculation module, used for calculating the lateral vehicle distance when the current vehicle intersects with the oncoming vehicle; A query module, configured to query a preset merging vehicle spacing safety speed table based on the lateral vehicle spacing to obtain a target safety speed when the current vehicle merges with the oncoming vehicle; A speed planning module is used to obtain the current speed of the current vehicle and the predicted trajectory of the oncoming vehicle, and based on a preset deceleration strategy, obtain the intersection interval between the oncoming vehicle and the current vehicle according to the current speed, the target safety speed and the predicted trajectory of the oncoming vehicle, and perform speed planning for the current vehicle based on the target safety speed and the intersection interval.

7. The device according to claim 6, characterized in that The computing module is used for: Obtaining the lane width of the lane where the current vehicle is located, the width of the oncoming vehicle, the road width of the road where the current vehicle is located, and the width of the current vehicle; The vehicle distance when the current vehicle meets the oncoming vehicle is obtained according to the lane width, the width of the oncoming vehicle, the road width and the width of the current vehicle.

8. The device according to claim 6, characterized in that The speed planning module is used to: Based on a preset selection strategy, an initial deceleration is selected from a preset sequence of decelerations to be selected; Based on the initial deceleration, calculating a target time and a target displacement when the current vehicle is decelerated from the current vehicle speed to the target safety speed; Based on the target time, finding the target distance between the oncoming vehicle and the current vehicle from the predicted trajectory of the oncoming vehicle; If the difference between the target distance and the target displacement is not within the preset distance interval, a new deceleration is reselected from the preset deceleration sequence based on the preset selection strategy until the difference between the new target distance and the new target displacement is within the preset distance interval or the preset deceleration sequence is completely traversed, and the intersection interval is obtained according to the new target distance and the new target displacement.

9. A vehicle, characterized in that: include: A memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor executes the program to implement the vehicle intersection speed planning method according to any one of claims 1 to 5.

10. A computer-readable storage medium having a computer program stored thereon, characterized in that: The program is executed by a processor to implement the vehicle merging speed planning method as described in any one of claims 1 to 5.

Citation Information

Cited By

  • Mining broadcasting rescue method based on artificial intelligence

    CN120487223A