Systems and Methods for Vehicle Motion Planning Based on Uncertainty

Systems and methods for vehicle motion planning based on uncertainty are provided. A method can include obtaining scene data descriptive of one or more objects within a surrounding environment of the autonomous vehicle. The method can include determining one or more subproblems based at least in part on the scene data. In some implementation, each of the one or more subproblems can correspond to at least one object within the surrounding environment of the autonomous vehicle. The method can include generating one or more branching policies based at least in part on the one or more subproblems. In some implementations, each of the one or more branching policies can include scene data associated with the autonomous vehicle and one or more objects within the surrounding environment of the autonomous vehicle. The method can include determining one or more costs associated each of the one or more branching policies. The method can include selecting a motion plan based at least in part on the one or more costs associated with each of the one or more branching policies. The method can include providing the motion plan for use in controlling a motion of the autonomous vehicle.