无线定位.asv

来自「wsn中TDOA算法。希望对大家有帮助。」· ASV 代码 · 共 42 行

%  本程序实现测试、比较无线定位算法

%    参数说明：
%       移动台初始位置由MSPosition给出
%       输出移动台的估计位置。
%       比较各个算法的RMSE、CRLB、GDOP
%       比较各个算法的时间复杂度。

BSN = [7,6,5,4];            %基站数目
R = 3000;                   %
CalNum = 10000;             %使用Monte Carlo法仿真

%几种传统定位算法的比较
Noise = [30, 60, 90, 150, 210, 300];
for m = 1:4
    for n = 1:6
        for i = 1: CalNum
            MSP = MSPosition();     %移动台初始位置
            MS(i,1) = MSP(1)*R;     %x坐标值
            MS(i,2) = MSP(2)*R;     %y坐标值

            EMSCI = ChanAlgorithm(BSN(m), MSP, R, Noise(n));%Chan算法定位
            EMSC(i, 1) = EMSCI(1);   %x坐标估计值
            EMSC(i, 2) = EMSCI(2);   %y坐标估计值

            EMSTI = TaylorAlgorithm(BSN(m), MSP, R, Noise(n));%Taylor算法定位
            EMST(i ,1) = EMSTI(1);   %x坐标估计值
            EMST(i, 2) = EMSTI(2);   %y坐标估计值

           % EMSSII = SIAlgorithm(BSN(m), MSP, R, Noise(n));
           % EMSSI(i ,1) = EMSSII(1);
           % EMSSI(i, 2) = EMSSII(2);

        end

        rmse_c(m,n) = TDOA_RMSE(MS,EMSC);         %Chan算法测试精度
        rmse_t(m,n) = TDOA_RMSE(MS,EMST);         %Taylor算法测试精度
       % rmse_si(m,n) = TDOA_RMSE(MS,EMSSI);
        crlb(m,n) = CRLB(BSN(m), MSP, R, Noise(n));%理论测试精度
    end
end