A self-driving vehicle (SDV) can dynamically analyze a sensor view of a surrounding area of the SDV, and a current localization map in order to autonomously operate acceleration, braking, and steering systems of the SDV along a current route to a destination. Upon approaching a decision point along the current route, the SDV can perform a cost optimization to determine whether to diverge from the current route.