Adding vehicle parameter to TestRouting

Some changes I found usefull when testing.