Richard,
It already does that, the only why you would get off the route is if you make a turn manually.