m_t.m

针对卡尔曼滤波的原创改进算法

x=1:0.2:100;
y=ttrue(x);
subplot(2,1,1);
plot(x,y);
title('真实轨迹');
xlabel('时间');
ylabel('位移');
legend('y=10*sin(x)');
ylim([-15,15]);


R=2;
y1=mmeasured(x,R);
subplot(2,1,2);
plot(x,y1);
title('测量轨迹');
xlabel('时间');
ylabel('位移');
legend('y=10*sin(x)+2*randn(size(x))');
ylim([-15,15]);