基于最小二乘法的无线定位技术研究与仿真_程序

clc;
clear;
close all;

N=4;        %参与定位的基站数 
C=3e5;   %电磁波传播速度300000000m/s
X=[0 5000 5000 0];
Y=[0 0 5000 5000];
x=1200;    y=1600;
D(1:N)=sqrt((X(1:N)-x).^2+(Y(1:N)-y).^2);
delay(1:N)=D(1:N)./C;
T=1;
N_sample=200000;%传输速率200kbit/s
iTsignal=[ones(1,N_sample/2),-ones(1,N_sample/2)];%发送信号的实部
qTsignal=zeros(size(iTsignal));%发送信号的虚部
rsn=[0 3 5 10 20 30 40 50];  %信噪比
%rsn=40;
standard=0;       %1为b标准，0为a标准；
for j=1:8
    for i=5
    [iRsignal1]=pathoutput(iTsignal,rsn(j),standard,delay(1));
    [iRsignal2]=pathoutput(iTsignal,rsn(j),standard,delay(2));
    [iRsignal3]=pathoutput(iTsignal,rsn(j),standard,delay(3));
    [iRsignal4]=pathoutput(iTsignal,rsn(j),standard,delay(4));
   
    iRsignal1(i,:)=iRsignal1;
    iRsignal2(i,:)=iRsignal2;
    iRsignal3(i,:)=iRsignal3;
    iRsignal4(i,:)=iRsignal4;
    
    end
    iRsignal1=mean(iRsignal1);
    iRsignal2=mean(iRsignal2);
    iRsignal3=mean(iRsignal3);
    iRsignal4=mean(iRsignal4);
   
   TDOA(1)=correlation(iRsignal2,iRsignal1,T,N_sample);
   TDOA(2)=correlation(iRsignal3,iRsignal1,T,N_sample);
   TDOA(3)=correlation(iRsignal4,iRsignal1,T,N_sample);
   
   Q=eye(N-1);
   for i=1:N-1
    Rplus(i)=TDOA(i)*C; %第一个reader为主站其余为辅站，Ri,1为第i个站到定位点的距离与第一个站到其距离的差。
    R(i)=(TDOA(i)*C).^2; %为了在Tdoainiial函数中使用R
   end                                                                           %Q=sigma(l).*[1 0.5 0.5;0.5 1 0.5;0.5 0.5 1]; %噪声协方差阵随着基站的数目变化而改变。
   [xu yu]=Leastsquare(X,Y,N,Q,R,Rplus,x,y);
    xr(j)=xu-x;
    yr(j)=yu-y;
    locationerror(j)=sqrt((xu-x).^2+(yu-y).^2);
end
figure(1);
plot(locationerror,'b*-');
xlabel('信噪比（dB）（1-8分别代表信噪比[0 3 5 10 20 30 40 50]');
ylabel('误差');
title('信噪比对误差的影响');
grid on
figure(2);
plot(xr,'k*-')
hold on
plot(yr,'rx--')
xlabel('信噪比（dB）（1-8分别代表信噪比[0 3 5 10 20 30 40 50]');
ylabel('x、y坐标误差');
gtext({'xr'});
gtext({'yr'});
title('信噪比对x、y坐标误差的影响');
grid on