add_control_noise.m

来自「利用MATLAB建立扩展卡尔曼滤波器进行扫描滤波」· M 代码 · 共 11 行

function [V,G]= add_control_noise(V,G,Q, addnoise)
%function [V,G]= add_control_noise(V,G,Q, addnoise)
%
% Add random noise to nominal control values. We assume Q is diagonal.

if addnoise == 1
    V= V + randn(1)*sqrt(Q(1,1));
    G= G + randn(1)*sqrt(Q(2,2));
end