Replaced for loops with for:in
Added iostream operators and finished route finding
Added print statements to debug path finding