Moved driveTo call in setup so it's just called once.