Improved performance of route finding in large environments