Seems like I fixed the EKF with the fix in prop time (there was a one time step shift).
Seems like I fixed the EKF with the fix in prop time (there was a one time step shift).

ChristopherRabotin/gokalman