Fix routing in pedestrian mode