AUTOMATIC LANE MERGE WITH TUNABLE MERGE BEHAVIORS
An autonomous vehicle automatically implements a lane change in dense traffic condition. A minimum distance gap between the vehicle and a vehicle in front of the present vehicle is calculated for an autonomous vehicle, along with a best trajectory for changing lanes into a left adjacent lane or changing lanes into a right adjacent lane. The left or right lane change is triggered by the driver or the global planner that navigates the vehicle. During the next cycle, pre-calculated information is utilized by a planning module to determine the final speed of the trajectory to complete the final planning trajectory for the lane change.
1 . A system for automatically merging a vehicle from a current lane into a target lane, comprising:
a data processing system comprising one or more processors, memory, a planning module, and a control module, the data processing system to:
detect a merge condition associated with a current lane from received sensor data;
select a best trajectory from the current lane to the target lane, the best trajectory selected from a plurality of trajectories at least in part based on a determined cost of a lane change from the current lane, the cost dependent on a change in acceleration in one or more vehicles, the one or more vehicles including the automatically merging vehicle; and
generate one or more commands to navigate a merge from the current lane to the target lane.
2 . The system of claim 1 , wherein the cost has an opposite value to the difference in acceleration between a target position and the current position of each of the merging vehicle, a lagging vehicle in the target lane, and a lagging vehicle in the current lane.
3 . The system of claim 3 , wherein the weight of the difference in acceleration for each of the lagging vehicle in the target lane and the lagging vehicle in the current lane is tunable.
4 . The system of claim 3 , wherein the weights are tuned to increase the significance of the lagging vehicle acceleration change in the cost.
5 . The system of claim 3 , wherein the weights are tuned to decrease the significance of the lagging vehicle acceleration change in the cost.
6 . The system of claim 1 , the data processing system further to:
detect the merge condition includes an end to the current lane; and
generate a virtual object at the end of the lane.
7 . The system of claim 6 , wherein the merging vehicle generates an alert for a user of the merging vehicle when the merging vehicle is within a threshold distance of the virtual object at the end of the lane.
8 . The system of claim 1 , the data processing system further to:
detect that there is an exit at the end of the current lane; and
navigate the merging vehicle to the exit when the merging vehicle is within a threshold distance of the exit at the end of the lane.
9 . The system of claim 1 , the data processing system further to:
determine that execution of a decision to navigate a previously selected best trajectory has begun during a previous computing cycle; and
weighting the decision to navigate the previously selected best trajectory.
10 . The system of claim 9 , wherein a new best trajectory is selected using hysteresis.
11 . The system of claim 1 , the data processing system further to:
detect a first vehicle object current speed and acceleration in the target lane;
identify a gap adjacent to the first vehicle and forming within a set period of time; and
select the best trajectory at least in part on the identified gap.
12 . A non-transitory computer readable storage medium having embodied thereon a program, the program being executable by a processor to perform a method for automatically merging a vehicle from a current lane into a target lane, the method comprising:
detecting a merge condition associated with a current lane from received sensor data;
selecting a best trajectory from the current lane to the target lane, the best trajectory selected from a plurality of trajectories at least in part based on a determined cost of a lane change from the current lane, the cost is dependent on a change in acceleration in one or more vehicles, the one or more vehicles including the automatically merging vehicle; and
generating one or more commands to navigate a merge from the current lane to the target lane.
13 . The non-transitory computer readable storage medium of claim 12 , wherein the cost is to the opposite value of the difference in acceleration between a target position and the current position of each of the merging vehicle, a lagging vehicle in the target lane, and a lagging vehicle in the current lane.
14 . The non-transitory computer readable storage medium of claim 13 , wherein the weight of the difference in acceleration for each of the lagging vehicle in the target lane and the lagging vehicle in the current lane is tunable.
15 . The non-transitory computer readable storage medium of claim 13 , wherein the weights are tuned to increase or decrease the significance of the lagging vehicle acceleration change in the cost.
16 . The non-transitory computer readable storage medium of claim 12 , the method further including:
detecting the merge condition includes an end to the current lane; and
generating a virtual object at the end of the lane.
17 . The non-transitory computer readable storage medium of claim 16 , wherein the merging vehicle generates an alert for a user of the merging vehicle when the merging vehicle is within a threshold distance of the virtual object at the end of the lane.
18 . The non-transitory computer readable storage medium of claim 12 , the method further including:
determining that execution of a decision to navigate a previously selected best trajectory has begun during a previous computing cycle; and
weighting the decision to navigate the previously selected best trajectory.
19 . The non-transitory computer readable storage medium of claim 12 , the method further including:
detecting a first vehicle object current speed and acceleration in the target lane;
identifying a gap adjacent to the first vehicle and forming within a set period of time; and
selecting the best trajectory at least in part on the identified gap.
20 . A method for automatically merging a vehicle from a current lane into a target lane, comprising:
detecting, by a data management system, a merge condition associated with a current lane from received sensor data;
selecting, by a data management system, a best trajectory from the current lane to the target lane, the best trajectory selected from a plurality of trajectories at least in part based on a determined cost of a lane change from the current lane, the cost dependent on a change in acceleration in one or more vehicles, the one or more vehicles including the automatically merging vehicle; and
generating, by a data management system, one or more commands to navigate a merge from the current lane to the target lane.