rodralez / NaveGo

NaveGo: an open-source MATLAB/GNU Octave toolbox for processing integrated navigation systems and performing inertial sensors analysis.
Other
581 stars 212 forks source link

Check if biases states in Kalman filter should be error states or direct states #129

Closed rodralez closed 2 years ago

rodralez commented 2 years ago

Check in Groves' book if biases states in Kalman filter are error states or direct states. Correct the code according.

rodralez commented 2 years ago

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:

  1. ins_gnss.m
  2. ins_gnss_mag.m
  3. ins_visual.m
  4. ins_visual_gnss.m