TABLE 1
Extended Kalman filter algorithm
Time Update
Measurement Update