Added more for going to known route.
There are some issues, it only goes to the first spot then just stays there.