Modified patfinder map to be 2D array

and small path test