Two-stage route planning algorithm for last mile delivery