Adding pathfinder for directed moviment (WIP)