pull/35426/head
Shane Smiskol 1 week ago
parent 47d260e76a
commit 5f419b5692
  1. 5
      selfdrive/locationd/lagd.py

@ -208,7 +208,7 @@ class LateralLagEstimator:
liveDelay = msg.liveDelay
valid_mean_lag, valid_std, current_mean_lag, current_std = self.block_avg.get()
if self.block_avg.valid_blocks >= self.min_valid_block_count and not np.isnan(valid_mean_lag) and not np.isnan(valid_std):
if self.enabled and self.block_avg.valid_blocks >= self.min_valid_block_count and not np.isnan(valid_mean_lag) and not np.isnan(valid_std):
if valid_std > MAX_LAG_STD:
liveDelay.status = log.LiveDelayData.Status.invalid
else:
@ -216,9 +216,6 @@ class LateralLagEstimator:
else:
liveDelay.status = log.LiveDelayData.Status.unestimated
if not self.enabled:
liveDelay.status = log.LiveDelayData.Status.unestimated
if liveDelay.status == log.LiveDelayData.Status.estimated:
liveDelay.lateralDelay = valid_mean_lag
else:

Loading…
Cancel
Save