A* path finder was corrected