Autonomous driving systems and methods include a controller of a first vehicle configured to detect an operating state of a second vehicle proximate the first vehicle, and to predict, based on the operating state of the second vehicle, a potential behavior for the second vehicle that optimizes a cost function from the perspective of the second vehicle. The controller then controls the first vehicle to avoid a collision with the second vehicle assuming the second vehicle operates according to the potential behavior.