Mayitzin / ahrs

Attitude and Heading Reference Systems in Python

Home Page:https://ahrs.readthedocs.io/

Geek Repo:Geek Repo

Github PK Tool:Github PK Tool

EKF update Qt

tkumpumak opened this issue · comments

In the EKF update function where do this another 0.5*dt come from? I don't see it in the equations on the documentation.

W = 0.5*dt * np.r_[[-q[1:]], q[0]np.identity(3) + skew(q[1:])] # Jacobian W = df/dω
Q_t = 0.5
dt * self.g_noise * W@W.T # Process Noise Covariance

Omg! You're right. That 0.5*dt shouldn't be there. I fixed it with the commit a214a7b

It doesn't change much of the result, but it has to be correct.

Thanks for pointing it out!