diff --git a/code/perception/src/kalman_filter.py b/code/perception/src/kalman_filter.py index 9ee3d242..382cc19a 100755 --- a/code/perception/src/kalman_filter.py +++ b/code/perception/src/kalman_filter.py @@ -248,7 +248,7 @@ def predict(self): """ # Predict the next state and covariance matrix, pretending the last # velocity state estimate stayed constant - self.x_pred = self.A @ self.x_est + self.x_pred = self.A @ self.x_est self.P_pred = self.A @ self.P_est @ self.A.T + self.Q def update(self):