卡尔曼-组合导航-matlab

X=[0;0]; %状态 P=[1 0 ;0 1]; %状态协方差矩阵 F=[1 1;0 1]; %状态转移矩阵 Q=[0.0001,0;0 0.0001]; %状态转移协方差 H=[1 0]; % 观测矩阵 R=1; %观测噪声方差