1 问题描述
2 SRCIF算法
表1 水下传感网络SRCIF被动跟踪算法 |
1. 初始化 融合中心初始化,得到信息形式下的估计误差协方差阵平方根S0及相应的估计信息向量 。 Sy,0=chol( ), = |
2. 时间更新 1) 计算均方根协方差阵Sk|k= ,相应的状态估计值为 =Sk|k 。 2) 运用容积规则进行一步递推,得到 和Sk+1|k。 ① 生成容积点(l=1,…,m),m=2nx。 Xl,k|k=Sk|kξl+ ② 对2)-① 中生成的容积点进行一步递推。 =ΦkXl,k|k ③ 计算得到预测状态值 = ④ 计算得到预测误差协方差阵的均方根阵 Sk+1|k=Tria([ SQ,k]) 其中SQ,k=chol(Qk), χk+1|k*= [ - … - ] 3) 计算得到预测信息矩阵的均方根阵 Sy,k+1|k= 4) 计算得到预测信息向量 =Sy,k+1|k |
3. 量测更新 1) 利用SRCKF滤波算法计算得到T11、T21 2) 计算信息贡献矩阵的均方根 Si,k+1=Sy,k+1|k T21 3) 计算信息贡献向量 =Si,k+1 ( - )+Si,k+1 4) 计算更新后的信息向量 = + 5) 计算更新后的信息矩阵均方根阵 Sy,k+|k+1=Tria([Sy,k+1|k S1,k+1…SM,k+1]) |
3 基于CKF的水下传感网络事件触发机制
表2 水下传感网络SRCIF被动跟踪算法 |
1. 初始化 融合中心初始化步骤同 |
2. 时间更新 时间更新中步骤同 |
3. 量测更新 1) 各节点得到量测值后,按照事件触发机制(3)中的公式,计算 。 2) 按照 3) 计算更新后的信息向量。 = + 4) 计算更新后的信息矩阵均方根阵。 Sy,k+|k+1=Tria([Sy,k+1|k r1,k+1S1,k+1…rM,k+1SM,k+1]) |