SYSTEM AND METHOD FOR TRAJECTORY PLANNING

A system and method for trajectory planning selects a trajectory from a plurality of candidate trajectories to direct an autonomous vehicle. The system includes a controller in communication with a global positioning system (GPS) and at least one sensor. The GPS receives a plurality of global scene information. The at least one sensor collects local scene information. The controller is programmed to receive global scene information and local scene information, identify the location of the occluding obstacle. Additionally, the controller is programmed to determine an occluded portion of the roadway, identify a location of the scene actors on the roadway, and calculate a contracted occluded portion within the occluded portion. Furthermore, the system generates candidate trajectories for the autonomous vehicle to travel along, score the candidate trajectories, and select one of the candidate trajectories based on the assigned score.