Changed RouteFollowingVehicle so that states can be added. Fail state works.