|
|
@ -346,7 +346,7 @@ class CarStateBase(ABC): |
|
|
|
|
|
|
|
|
|
|
|
def update_speed_kf(self, v_ego_raw): |
|
|
|
def update_speed_kf(self, v_ego_raw): |
|
|
|
if abs(v_ego_raw - self.v_ego_kf.x[0][0]) > 2.0: # Prevent large accelerations when car starts at non zero speed |
|
|
|
if abs(v_ego_raw - self.v_ego_kf.x[0][0]) > 2.0: # Prevent large accelerations when car starts at non zero speed |
|
|
|
self.v_ego_kf.x = [[v_ego_raw], [0.0]] |
|
|
|
self.v_ego_kf.set_x([[v_ego_raw], [0.0]]) |
|
|
|
|
|
|
|
|
|
|
|
v_ego_x = self.v_ego_kf.update(v_ego_raw) |
|
|
|
v_ego_x = self.v_ego_kf.update(v_ego_raw) |
|
|
|
return float(v_ego_x[0]), float(v_ego_x[1]) |
|
|
|
return float(v_ego_x[0]), float(v_ego_x[1]) |
|
|
|