Improved navigation performance (should be good enough for AI)