starting to fix "the mess" in CostArray. Renamed CostArray class to PathFinder