Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

EKF: Jacobian Matrix for the state estimate error covariance matrix (P) prediction #286

Open
afonsomm opened this issue Apr 5, 2023 · 0 comments

Comments

@afonsomm
Copy link

afonsomm commented Apr 5, 2023

def predict(self, u=0):
"""
Predict next state (prior) using the Kalman filter state propagation
equations.
Parameters
----------
u : np.array
Optional control vector. If non-zero, it is multiplied by B
to create the control input into the system.
"""
self.predict_x(u)
self.P = dot(self.F, self.P).dot(self.F.T) + self.Q
# save prior
self.x_prior = np.copy(self.x)
self.P_prior = np.copy(self.P)

Shouldn't the Jacobian matrix of the system's dynamics be used in the prediction of (P) (line 367), instead of the transition matrix (F)?

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Projects
None yet
Development

No branches or pull requests

1 participant