Abstract: Methods for planning a trajectory for an autonomous vehicle are disclosed. A vehicle motion planning system will determine a reference curve that represents a path via which the vehicle may travel. The system will detect an actor that is moving in the environment. The system will segment the reference curve according to time intervals. For each of the time intervals, the system will identify a bounding geometry for the actor, predict a lateral offset distance between the reference curve and the actor, and use the predicted lateral offset distance to determine whether to alter a planned trajectory for the autonomous vehicle.

Abstract: Disclosed herein are system, method, and computer program product aspects for validating protolanes. For example, the method includes determining a protolane level flowchart from one or more flowcharts corresponding to one or more gates of a protolane selected from a set of protolanes of a geonet, wherein the one or more flowcharts correspond to conditions that can be encountered by an actor approaching the corresponding one or more gates, and wherein the geonet comprises a plurality of lane segments associated with the set of protolanes. A graph through the protolane level flowchart is generated that corresponds to actions of an actor. Reasoning of the actor is validated by testing the actions of the actor against the graph through the protolane level flowchart.

Abstract: Disclosed herein are systems, methods, and computer program products for generating a reference path for an autonomous vehicle. The methods comprising: receiving, by a computing device, a reference trajectory for the autonomous vehicle; generating, by the computing device, a first alternative trajectory for the autonomous vehicle based on an objective identified by the reference trajectory; comparing, by the computing device, the first alternative trajectory to the reference trajectory or a previously generated alternative trajectory; selecting, by the computing device, whether to generate a second alternative trajectory based on a result of said comparing; and generating, by the computing device, the second alternative trajectory for the autonomous vehicle in response to said selecting.

Abstract: Systems and methods of maneuvering an autonomous vehicle in a local region using topological planning, while traversing a route to a destination location, are disclosed. The system includes an autonomous vehicle including one or more sensors and a processor. The processor is configured to determine the local region on the route and receive real-time information corresponding to the local region. The processor performs topological planning to identify on or more topologically distinct classes of trajectories, compute a constraint set for each of the one or more topologically distinct classes of trajectories, optimize a trajectory to generate a candidate trajectory for each constraint set, and select a trajectory for the autonomous vehicle to traverse the local region from amongst the one or more candidate trajectories.

Abstract: Systems and methods for controlling navigation of an autonomous vehicle for making an unprotected turn while traversing an intersection. The methods may include identifying a loiter pose of an autonomous vehicle for stopping at a point in an intersection before initiating an unprotected turn, initiating navigation of the autonomous vehicle to the loiter pose when a traffic signal is at a first state, determining whether the traffic signal has changed to a second state during or after navigation of the autonomous vehicle to the loiter pose, and in response to determining that the traffic signal has changed to the second state, generating a first trajectory for navigating the autonomous vehicle to execute the unprotected turn if the expected time for moving the autonomous vehicle from a current position to a position when the autonomous vehicle has fully exited an opposing conflict lane is less than a threshold time.

Abstract: Methods, systems, and computer program products for navigating a vehicle are disclosed. The methods include extracting lane segment data associated with lane segments of a vector map that are within a region of interest, and analyzing the lane segment data and a heading of the vehicle to determine whether motion of the vehicle satisfies a condition. The condition can be associated with (i) an association between the heading of the vehicle and a direction of travel of a lane that corresponds to the current location of the vehicle and/or (ii) a minimum stopping distance to an imminent traffic control measure in the lane that corresponds to the current location of the vehicle. When the motion does not satisfy the condition, the methods include causing the vehicle to perform a motion correction.

Abstract: A method of determining a trajectory for an autonomous vehicle is disclosed. An ego-vehicle may detect a moving actor in an environment. To choose between candidate trajectories for the ego-vehicle, the system will consider the cost of each candidate trajectory to the moving actor. The system will use the candidate trajectory costs for the candidate trajectories to select one of the candidate trajectories via which to move the ego-vehicle. An autonomous vehicle system of the ego-vehicle may then move the ego-vehicle in the environment along the selected trajectory.

Abstract: Systems and methods for operating an autonomous vehicle (AV) are provided. The method includes detecting one or more objects in an environment, predicting a first set of predicted object trajectories comprising one or more trajectories for each of the detected one or more objects, generating a plurality of candidate AV trajectories for the AV, scoring each of the candidate AV trajectories according to a cost function, using the scoring to select a final AV trajectory for execution, determining which of the predicted object trajectories affected the final AV trajectory and which did not do so, adding the predicted object trajectories that affected the final AV trajectory to a persisted prediction cache, excluding from the persisted prediction cache any predicted object trajectories that did not affect the final AV trajectory, and executing the final AV trajectory to cause the AV to move along the final AV trajectory.

Abstract: Methods, systems, and computer program products for navigating a vehicle are disclosed. The methods include extracting lane segment data associated with lane segments of a vector map that are within a region of interest, and analyzing the lane segment data and a heading of the vehicle to determine whether motion of the vehicle satisfies a condition. The condition can be associated with (i) an association between the heading of the vehicle and a direction of travel of a lane that corresponds to the current location of the vehicle and/or (ii) a minimum stopping distance to an imminent traffic control measure in the lane that corresponds to the current location of the vehicle. When the motion does not satisfy the condition, the methods include causing the vehicle to perform a motion correction.

Abstract: Vehicle driver assistance and warning systems that alert a driver of a vehicle to wrong-way driving and/or imminent traffic control measures (TCMs) are disclosed. The system will identify a region of interest around the vehicle, access a vector map that includes the region of interest, and extract lane segment data associated with lane segments that are within the region of interest. The system will analyze the lane segment data and the vehicle's direction of travel to determine whether motion of the vehicle indicates that either: (a) the vehicle is traveling in a wrong-way direction for its lane; or (b) the vehicle is within a minimum stopping distance to an imminent TCM in its lane. When the system detects either condition, it will cause a driver warning system of the vehicle to output a driver alert.

Abstract: A system of linearizing a trajectory of an autonomous vehicle about a reference path includes a computing device and a computer-readable storage medium.

Abstract: Systems and methods for controlling navigation of an autonomous vehicle through an intersection are disclosed. The methods include determining a loiter pose of an autonomous vehicle for stopping at a point within the intersection before initiating an unprotected turn for traversing the intersection. One or more distinct classes of trajectories are then identified, each of which is associated with multiple trajectories that take the same combination of discrete actions with respect to the loiter pose. A constraint set for each of the one or more distinct classes of trajectories is then be computed based on the loiter pose, and a candidate trajectory is determined for each of the one or more distinct classes based on the corresponding constraint set. A trajectory for the autonomous vehicle for executing the unprotected turn for traversing the intersection is selected from amongst the candidate trajectories.

Abstract: Systems and methods for controlling navigation of an autonomous vehicle for making an unprotected turn while traversing an intersection. The methods may include identifying a loiter pose of an autonomous vehicle for stopping at a point in an intersection before initiating an unprotected turn, initiating navigation of the autonomous vehicle to the loiter pose when a traffic signal is at a first state, determining whether the traffic signal has changed to a second state during or after navigation of the autonomous vehicle to the loiter pose, and in response to determining that the traffic signal has changed to the second state, generating a first trajectory for navigating the autonomous vehicle to execute the unprotected turn if the expected time for moving the autonomous vehicle from a current position to a position when the autonomous vehicle has fully exited an opposing conflict lane is less than a threshold time.

Abstract: Methods and systems for maneuvering an autonomous vehicle are disclosed. The methods include generating a multi-corridor representation corresponding to a local region around the autonomous vehicle while travelling on a route, and using the multi-corridor representation and perception data corresponding to the local region to generate a trajectory for the autonomous vehicle to traverse the local region. The multi-corridor representation includes a plurality of adjacent corridors that each include one or more lane segments of a road network. A location of executing a lane change along the route is determined dynamically during a trajectory generation phase based on the perception data.

Abstract: A system and method for inferring a stop line for a vehicle at an intersection are provided. The system includes a processor configured to detect from accessed map data that a traffic control measure is positioned before an intersection and determine whether a stop line for the detected traffic control measure is painted. The processor, in response to determining that no stop line is painted, identifies a restricted lane and infers a stop line. The processor infers the stop line by identifying, as a nearest lane conflict, a lane segment of a second road intersecting the first road at the intersection and advancing a location of the entry line as an intermediate stop line a distance toward the nearest lane conflict, until the intermediate stop line is at a target distance from a nearest boundary of the nearest lane conflict to form an inferred stop line.

Abstract: A method and a system for maneuvering an autonomous vehicle is disclosed. The system includes an autonomous vehicle including one or more sensors and a processor. The processor is configured to generate a nominal route from a start position toward a destination with reference to a road network map. The nominal route includes a plurality of consecutive lane segments from the start position to the destination. The processor is further configured to use the road network map to identify at least one candidate lane segment corresponding to one or more of the plurality of consecutive lane segments to generate an expanded route representation, generate a multi-corridor representation of a local region around the autonomous vehicle while travelling on the nominal path, and generate a trajectory for the autonomous vehicle to traverse the local region using the multi-corridor representation and perception data corresponding to the autonomous vehicle.

Abstract: Vehicle driver assistance and warning systems that alert a driver of a vehicle to wrong-way driving and/or imminent traffic control measures (TCMs) are disclosed. The system will identify a region of interest around the vehicle, access a vector map that includes the region of interest, and extract lane segment data associated with lane segments that are within the region of interest. The system will analyze the lane segment data and the vehicle's direction of travel to determine whether motion of the vehicle indicates that either: (a) the vehicle is traveling in a wrong-way direction for its lane; or (b) the vehicle is within a minimum stopping distance to an imminent TCM in its lane. When the system detects either condition, it will cause a driver warning system of the vehicle to output a driver alert.

Abstract: Methods for planning a trajectory for an autonomous vehicle are disclosed. A vehicle motion planning system will determine a reference curve that represents a path via which the vehicle may travel. The system will detect an actor that is moving in the environment. The system will segment the reference curve according to time intervals. For each of the time intervals, the system will identify a bounding geometry for the actor, predict a lateral offset distance between the reference curve and the actor, and use the predicted lateral offset distance to determine whether to alter a planned trajectory for the autonomous vehicle.

Abstract: An autonomous vehicle navigates an intersection in which occlusions block the vehicle's ability to detect moving objects. The vehicle handles this by generating a phantom obstacle behind the occlusion. The vehicle will predict the speed of the phantom obstacle and use the predicted speed to assess whether the phantom obstacle may collide with the vehicle. If a collision is a risk, the vehicle will slow or stop until it confirms that either (a) the phantom obstacle is not a real obstacle or (b) the vehicle can proceed at a speed that avoids the collision. To determine which occlusions shield real objects, the system may use a rasterized visibility grid of the area to identify occlusions that may accommodate the object.

Abstract: A method of determining a trajectory for an autonomous vehicle is disclosed. An ego-vehicle may detect a moving actor in an environment. To choose between candidate trajectories for the ego-vehicle, the system will consider the cost of each candidate trajectory to the moving actor. The system will use the candidate trajectory costs for the candidate trajectories to select one of the candidate trajectories via which to move the ego-vehicle. An autonomous vehicle system of the ego-vehicle may then move the ego-vehicle in the environment along the selected trajectory.