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; validBlocks @1 :Int32;
status @2 :Status; status @2 :Status;
estimatedLateralDelay @3 :Float32; lateralDelayEstimate @3 :Float32;
points @4 :List(Float32); points @4 :List(Float32);
enum Status { enum Status {

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

Loading…
Cancel
Save