completed initialize method
Corrected repeated nodes
wrote first test
find_path method working!