Skip to main content
. 2020 Dec 3;20(23):6923. doi: 10.3390/s20236923
Algorithm 4: A diffusion distributed Kalman filter separating diffusion update.
  For the node iV and node jNi,
  Initialize with:
    x^i,00loc=Ex0,
    Pi,00loc=E[(x0Ex0)(x0Ex0)T],
    x^i,00=Ex0,
    Pi,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:
    x^i,tt1=Ax^i,t1t1,
    Pi,tt1=APi,t1t1AT+ΓQΓT,
    (Pi,ttdiffusion)1=Pi,tt11+HiTRi1Hi,
    x^i,ttdiffusion=x^i,tt1+Pi,ttdiffusionHiTRi1(yi,tHix^i,tt1);
  Communication and fusion update:
    Send x^j,ttdiffusion and Pj,ttdiffusion to adjacent node i,
    Pi,tt1=jNiwj(Pi,ttdiffusion)1+wi(Pi,ttloc)1,
    x^i,tt=Pi,ttjNiwj(Pi,ttdiffusion)1x^j,ttdiffusion+wi(Pi,ttloc)1x^i,ttloc,
  where wj and wi is calculated by Equation (5).