Systems and methods for improving path selection for automated driving

Abstract

Systems, methods, and other embodiments described herein relate to improving identification of a path for an ego vehicle on a roadway. In one embodiment, a method includes, in response to acquiring sensor data from at least one sensor of the ego vehicle about a surrounding environment, identifying roadway elements from the sensor data as cues about the path. The roadway elements include one or more of lane markers of the roadway and surrounding vehicles. The method includes grouping the roadway elements into two or more groups according to characteristics of roadway elements indicating common curvatures. The method includes analyzing the two or more groups according to a confidence heuristic to determine a priority group from the two or more groups that corresponds with a trajectory of the ego vehicle. The method includes providing an identifier for the priority group to facilitate at least path planning for the ego vehicle.