fixed bug in route following vehicle