L1_Control : Added hysteresis for rear WP capture