Implement graph stuff, test RoadNode