Load the route and judge the yaw and recovery

The nearest line segment distance and double threshold hysteresis already exist; NavigationSession, RouteProgress and DeviationPolicy have not yet formed a core owner.