Heuristic done. Other functions modified to use heuristic.
Breadth First Search working in rush3.py