Skip to main content
. 2020 Dec 3;20(23):6923. doi: 10.3390/s20236923
Algorithm 6: A distributed Kalman filter based on the non-repeated diffusion strategy.
  For the node iV and node jNi.
  Initialize with:
    x^i,00loc=Ex0,Pi,00loc=E[(x0Ex0)(x0Ex0)T],
    x^ji,00=0,Pji,00=E[(x0Ex0)(x0Ex0)T];
  Local update:
    x^i,tt1loc=Ax^i,t1t1loc,
    Pi,tt1loc=APi,t1t1locAT+ΓQΓT,
    (Pi,ttloc)1=(Pi,tt1loc)1+HiTRi1Hi,
    x^i,ttloc=x^i,tt1loc+Pi,ttlocHiTRi1(yi,tHix^i,tt1loc);
  Diffusion incremental update:
    Pij,t1=gNijwj,giPgi,t1t11+wj,ii(Pi,t1t1loc)1,     (13)
    x^ij,t=Pij,tgNijwj,giPgi,tt1x^gi,t1t1+wj,ii(Pi,t1t1loc)1x^i,t1t1loc,     (14)
    x^ij,tt1=Ax^ij,t,
    Pij,tt1=APij,tAT+ΓQΓT,
    Pij,tt1=Pij,tt11+HiTRi1Hi,
    x^ij,tt=x^ij,tt1+Pij,ttHiTRi1(yi,tHix^ij,tt1);
  Communication and fusion update:
    Send x^ji,tt and Pji,tt to adjacent node i,
    Pi,tt1=jNiwjiPji,tt1+wii(Pi,ttloc)1,
    x^i,tt=Pi,ttjNiwjiPji,tt1x^ji,tt+wii(Pi,ttloc)1x^i,ttloc,
  where wj is calculated by Equation (19).