proper route calculation, switching units works properly