Closed rodralez closed 2 years ago
Check in Groves' book if biases states in Kalman filter are error states or direct states. Correct the code according.
It is checked that inertial biases states are error states in Kalman filter. They are the errors between both truth and noisy inertial measurements, as shown in Eq. 4.18, Groves' book.
Modified files are:
Check in Groves' book if biases states in Kalman filter are error states or direct states. Correct the code according.