lateralDelayEstimate

pull/34531/head
Kacper Rączy 5 months ago
parent 1b814c61d4
commit 19b271d62a
  1. 2
      cereal/log.capnp
  2. 4
      selfdrive/locationd/lagd.py

@ -2279,7 +2279,7 @@ struct LiveDelayData {
validBlocks @1 :Int32;
status @2 :Status;
estimatedLateralDelay @3 :Float32;
lateralDelayEstimate @3 :Float32;
points @4 :List(Float32);
enum Status {

@ -184,7 +184,7 @@ class LagEstimator:
liveDelay = msg.liveDelay
estimated_lag = self.block_avg.get()
liveDelay.estimatedLateralDelay = estimated_lag or self.initial_lag
liveDelay.lateralDelayEstimate = estimated_lag or self.initial_lag
if self.block_avg.valid_blocks >= self.min_valid_block_count and estimated_lag is not None:
liveDelay.status = log.LiveDelayData.Status.estimated
liveDelay.lateralDelay = estimated_lag
@ -279,7 +279,7 @@ def main():
if lag_params:
try:
with log.Event.from_bytes(lag_params) as msg:
lag_init = msg.liveDelay.estimatedLateralDelay
lag_init = msg.liveDelay.lateralDelayEstimate
valid_blocks = msg.liveDelay.validBlocks
estimator.reset(lag_init, valid_blocks)
except Exception:

Loading…
Cancel
Save