Systems and methods to control autonomous vehicle motion

Abstract

The present disclosure provides systems and methods that control the motion of an autonomous vehicle by rewarding or otherwise encouraging progress toward a goal, rather than simply rewarding distance travelled. In particular, the systems and methods of the present disclosure can project a candidate motion plan that describes a proposed motion path for the autonomous vehicle onto a nominal pathway to determine a projected distance associated with the candidate motion plan. The systems and methods of the present disclosure can use the projected distance to evaluate a reward function that provides a reward that is positively correlated to the magnitude of the projected distance. The motion of the vehicle can be controlled based on the reward value provided by the reward function. For example, the candidate motion plan can be selected for implementation or revised based at least in part on the determined reward value.