?? kalman.m
字號:
function [Xk, Pk, Kk] = kalman(Phikk_1, Qk, Xk_1, Pk_1, Hk, Rk, Zk) if nargin<7 % 僅進行狀態遞推 Xk = Phikk_1*Xk_1; Pk = Phikk_1*Pk_1*Phikk_1'+Qk; else % 有測量時濾波 Xkk_1=Phikk_1*Xk_1; Pkk_1 = Phikk_1*Pk_1*Phikk_1' + Qk; Pxz = Pkk_1*Hk'; Pzz = Hk*Pxz + Rk; Kk = Pxz*Pzz^-1; Xk = Xkk_1 + Kk*(Zk-Hk*Xkk_1); Pk = Pkk_1 - Kk*Pzz*Kk'; end
?? 快捷鍵說明
復制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -