Add navigation mesh implementation