remotes/origin/revert-34974-revert-34531-online-lag
Kacper Rączy 4 weeks ago
parent 4de1784516
commit 646ec2ad8e
  1. 26
      selfdrive/locationd/estimators/lateral_lag.py

@ -114,10 +114,10 @@ def masked_normalized_cross_correlation(expected_sig: np.ndarray, actual_sig: np
class Points: class Points:
def __init__(self, num_points: int): def __init__(self, num_points: int):
self.times = deque(maxlen=num_points) self.times = deque[float](maxlen=num_points)
self.okay = deque(maxlen=num_points) self.okay = deque[bool](maxlen=num_points)
self.desired = deque(maxlen=num_points) self.desired = deque[float](maxlen=num_points)
self.actual = deque(maxlen=num_points) self.actual = deque[float](maxlen=num_points)
@property @property
def num_points(self): def num_points(self):
@ -180,18 +180,18 @@ class LateralLagEstimator:
self.min_yr = min_yr self.min_yr = min_yr
self.min_ncc = min_ncc self.min_ncc = min_ncc
self.t = 0 self.t = 0.0
self.lat_active = False self.lat_active = False
self.steering_pressed = False self.steering_pressed = False
self.steering_saturated = False self.steering_saturated = False
self.desired_curvature = 0 self.desired_curvature = 0.0
self.v_ego = 0 self.v_ego = 0.0
self.yaw_rate = 0 self.yaw_rate = 0.0
self.last_lat_inactive_t = 0 self.last_lat_inactive_t = 0.0
self.last_steering_pressed_t = 0 self.last_steering_pressed_t = 0.0
self.last_steering_saturated_t = 0 self.last_steering_saturated_t = 0.0
self.last_estimate_t = 0 self.last_estimate_t = 0.0
self.calibrator = PoseCalibrator() self.calibrator = PoseCalibrator()

Loading…
Cancel
Save