Added Pathfinder algorithm

added in the iterative pathfinder algorithm i wrote for my Sokoban-bot