我正在进行一个关于室内定位的项目。我已经使用了NS2和一个名为Senelex的matlab GUI来查找节点的原始位置和估计位置。现在,我想使用卡尔曼滤波器来估计节点/目标的位置。
例如:
如果我将目标的速度视为恒定值,如何使用估计或节点的原始位置的确定值作为卡尔曼滤波器的输入。
以下是节点的估计位置和原始位置。
如何将这些作为卡尔曼滤波器的输入并使用卡尔曼滤波器估计目标?
例如:
如果我将目标的速度视为恒定值,如何使用估计或节点的原始位置的确定值作为卡尔曼滤波器的输入。
以下是节点的估计位置和原始位置。
ori = [6.62650602409639 194.444444444445;
6.62650602409639 10.6837606837607;
192.168674698795 7.83475783475797;
192.168674698795 191.595441595442;
70.4819277108434 171.652421652422;
129.518072289157 168.803418803419;
24.6987951807229 144.586894586895;
42.7710843373494 79.0598290598291];
est = [6.62650602409639 194.444444444445;
6.62650602409639 10.6837606837607;
192.168674698795 7.83475783475797;
192.168674698795 191.595441595442;
70.7600705547484 171.847603055024;
129.443055817301 168.734648868329;
25.01956026761 144.890243978875;
42.6058125534278 79.1446327727804];
如何将这些作为卡尔曼滤波器的输入并使用卡尔曼滤波器估计目标?