Add some pathfinding helper methods