PathFinder : using A*, still debuging