- implemented A Star algorithm, need to clean up the heuristics a bit for more accuracy