Skip to main content
. 2018 Jan 25;18(2):341. doi: 10.3390/s18020341
Algorithm 1: The adaptive Unscented Kalman filter (AUKF) algorithm.
  Input: f(*),h(*),x^0,Q0,R1,P^0,λ.
  1: Initialization:
  2:   ωj=(1ω0)/2nx; c0=nx1ω0;cj=nx1ω0rj,j=1,,2nx.
  3: for k=1K do
  4:   Implement the standard UKF to obtain x^k|k, P¯zzk|k1, Kk, P^k|kxx.
  5:    Update the Qk1:
  6:     μk=zk0h(x¯k|k1)
  7:     Qk1(1λ)Qk1+λ(KkμkμkTKkT);
  8:    Correct state estimations:
  9:     K^k=ΔP^k|kxz(P¯k|kzz)1;
  10:     x^k|k=x^k|k+K^k(zk0Z^k|k);
  11:     P^k|kxx=P¯k|kxxK^kP^k|kxz(Kk)T;
  12:     QkQk1, Rk+1Rk.
  13:     Save the x^k|k and P^k|kxx.
  14: end for