refactored graph code, sped up find nearest street, still could be faster