算法1:融合估计 x ^ ( t ) 的算法

1) 初始条件: { N , A , B , C 1 , C 2 , D 2 , D 2 , F 1 ˜ , F 2 ˜ , ρ 1 , ρ 2 } 和初始状态 ρ

2) 根据式(20)计算获得正定矩阵 R 0 , R p , Γ 0 , Γ p

3) 通过测量时变概率 ρ k 求得每个传感器的估计器增益 K i ,且使得 k = k + 1

4) 通过3的求值代入式(21)来计算加权调度矩阵 Ω i u ( ρ k ) Ω i v ( ρ k )

5) 求解状态加权融合估计 x ^ ( t )

6) 如果 k < N ,则跳到3,否则到7;

7) 停止。