2D Navmesh pathfinding (in Rust)