Two echelon vehicle routing algorithm