Clean up A* algorithm a bit

* Remove duplicate code in evaluate_next_paths
* TODO: ensure cell does not have more than one score attributed with it
* to eliminate duplicate processing