routefinder full, just needs implementation and debug