find fastest route
removed some cost calculation duplication
removed route calculation duplication