Fuse multiple sensors using Kalman filter

kalman filter

I understand how to use Kalman filter for fusing two estimates and that essentially it fuses predicted state estimate produced by system dynamics update and observable state estimate produced by taking measurement.

However what if I have more than one measurement source for any of the state variables? The only way I can think of is to maintain two measurement models each of them having it's own covariance matrix and for each prediction step calculate two measurement updates using the following sequence:

  1. Predict state and covariance matrix using system dynamics model.
  2. Obtain state posterior estimate using measurement update.
  3. Use state posterior obtained in step 2 for the second measurement update.

Unfortunately I have not enough confidence in math in order to check the validity of this assumption.

Thanks!

Best Answer

The advantage of using a state space representation of your system is that a Kalman filter can, besides the state vector you try to estimate, deal with all outputs of the system as one vector as well. For this vector representation of the measurement of the state vector one can define one (bigger) covariance matrix, after which one can use the usual equations for a Kalman filter.

Related Question