研究文章

Clustering-Based方法改善超宽频传感器的室内定位系统的准确性

算法2

卡尔曼滤波算法的伪代码。
输入:,R,z,X美国东部时间,P美国东部时间
输出: ,
步骤1。初始化T矩阵和矩阵
步骤2。预测状态向量和协方差:
X珠江三角洲=T X美国东部时间
P珠江三角洲=T P美国东部时间
步骤3。评估步骤:
年代=
B=
步骤4。计算出卡尔曼增益系数:
klm_gain =
第5步。修正基于观察:
=X珠江三角洲+ klm_gain (z X珠江三角洲)
=P珠江三角洲−klm_gain P珠江三角洲
步骤6。返回 ,