plot_sigma_rb.m

一个目标跟踪系统的MATLAB 源程序包

% plot_sigma_rb.m
% standard deviations of range and bearing measurements
% using finite sensor resolution model
function fig = plot_sigma_rb()
r = linspace(.1, 4, 40);
b = linspace(.1, 4, 40);

for i=1:length(r)
    if r(i)<1
        sr(i) = 1;
    elseif r(i)<3
        sr(i) = 1-(1-1/sqrt(12))*(r(i)-1)/2;
    else
        sr(i) = 1/sqrt(12);
    end
end

for i=1:length(b)
    if b(i)<1
        sb(i) = 1;
    elseif r(i)<3
        sb(i) = 1-(1-1/sqrt(12))*(b(i)-1)/2;
    else
        sb(i) = 1/sqrt(12);
    end
end

fig = figure;
plot(r,sr)
xlabel('\Deltar/C_r or \Deltab/C_b');
ylabel('\sigma_r/C_r or \sigma_b/C_b');
title('Measurement error vs. target separation in range and bearing');