Add base work for pathfinding algorithms