无线定位.m

无线定位算法仿真,用matlab做的,本人觉得对做定位很有用

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

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

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

%几种传统定位算法的比较
%Noise = [30, 60, 90, 150, 210, 300];
Noise=90;
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);%Chan算法定位
            EMSC(i, 1) = EMSCI(1);   %x坐标估计值
            EMSC(i, 2) = EMSCI(2);   %y坐标估计值

            EMSTI = TaylorAlgorithm(BSN(m), MSP, R, Noise);%Taylor算法定位
            EMST(i ,1) = EMSTI(1);   %x坐标估计值
            EMST(i, 2) = EMSTI(2);   %y坐标估计值
        end
        rmse_c(m) = TDOA_RMSE(MS,EMSC);         %Chan算法测试精度
        rmse_t(m) = TDOA_RMSE(MS,EMST);         %Taylor算法测试精度
        crlb(m) = CRLB(BSN(m), MSP, R, Noise);%理论测试精度
    %end
end