首页 > 其他分享 >基于最小二乘法的无线定位

基于最小二乘法的无线定位

时间:2022-11-22 18:24:55浏览次数:41  
标签:iRsignal2 iRsignal3 rsn iRsignal1 iRsignal4 信噪比 最小 无线 乘法

一、部分源码

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
二、仿真图

 

 D151 

 

标签:iRsignal2,iRsignal3,rsn,iRsignal1,iRsignal4,信噪比,最小,无线,乘法
From: https://www.cnblogs.com/matlabfpga/p/16916032.html

相关文章