Improved number of lookups in the open and closed lists
Dry-coded path extraction from A* result