online-lag
Kacper Rączy 1 month ago
parent d00f7841d5
commit d191989ece
  1. 4
      selfdrive/locationd/lagd.py

@ -221,10 +221,10 @@ class LagEstimator:
fast = self.v_ego > self.min_vego
turning = np.abs(self.yaw_rate) >= self.min_yr
has_recovered = all([ # wait for recovery after !lat_active, steering_pressed, steering_saturated
has_recovered = all( # wait for recovery after !lat_active, steering_pressed, steering_saturated
self.t - last_t >= self.min_recovery_buffer_sec
for last_t in [self.last_lat_inactive_t, self.last_steering_pressed_t, self.last_steering_saturated_t]
])
)
okay = self.lat_active and not self.steering_pressed and not self.steering_saturated and fast and turning and has_recovered
self.points.update(self.t, la_desired, la_actual_pose, okay)

Loading…
Cancel
Save