METHOD FOR IMPROVING TEMPORAL CONSISTENCY OF PLANNED MANEUVERS

A method of motion planning and maneuvering of an ego vehicle is described. The method includes computing a set of potential vehicle maneuvers during a current motion planning cycle of the ego vehicle. The method also includes identifying, for the set of potential vehicle maneuvers, space corridor compatible vehicle maneuvers from a set of previously computed vehicle maneuvers during a previous motion planning cycle. The method further includes prioritizing a currently executed vehicle maneuver when the currently executed vehicle maneuver is a space corridor compatible vehicle maneuver with the set of potential vehicle maneuvers.