Initial waypoint-based router