Implement basic pathfinding in Vanilla