Closed jtec closed 3 years ago
From 2008 and 2011 papers, we can see that they implement an error-state KF to estimate position, velocity (etc.) errors and then they use this error to correct the IMU position. Therefore, we tried to follow the same notation and structure as they. However, in the end, we realized that our state is defined by the mechanization equations (a total state) and we use the GNSS measurements to correct this position, so the Q matrix refers to the covariances associated with IMU sensors.
Maybe we can change the name of the variables according to this interpretation of a total-state KF instead of following the notation of the papers, which may be a bit more confusing.
OK - when it comes to notation, the tutorial by Solà is very good and clear, see e.g. Table 3 in
In standardEKF.m, the update corrects the total state, even if the correction is called "xEst". So is looks like a total state EKF has been implemented, using IMU observations to propagate the mean? Please make the distinction clear in the report.