• 大小: 0.01M
    文件类型: .rar
    金币: 1
    下载: 0 次
    发布日期: 2021-03-28
  • 语言: 其他
  • 标签: 其他  

资源简介


经典 chan 算法 TDOA 仿真 用于无线定位算法仿真

资源截图

代码片段和文件信息

clear
x_1=0;y_1=0;x_2=750;y_2=433;x_3=750;y_3=-433;
x21=x_2-x_1;y21=y_2-y_1;x31=x_3-x_1;y31=y_3-y_1;
D1=x_1^2+y_1^2;D2=x_2^2+y_2^2;D3=x_3^2+y_3^2;

Ts=0.5;%采样间隔s
Num=100;%个数
x0=100;y0=100;% 初始位置
vx=10;vy=10;%速度
x(1)=x0+Ts.*vx(1);
y(1)=y0+Ts.*vy(1);
r1(1)=sqrt((x(1)-x_1)^2+(y(1)-y_1)^2);
r2(1)=sqrt((x(1)-x_2)^2+(y(1)-y_2)^2);
r3(1)=sqrt((x(1)-x_3)^2+(y(1)-y_3)^2);
r0(1)=sqrt(x(1).^2+y(1).^2);

for i=2:Num
    x(i)=x(i-1)+Ts.*vx;
    y(i)=y(i-1)+Ts.*vy;
    r1(i)=sqrt((x(i)-x_1)^2+(y(i)-y_1)^2);
    r2(i)=sqrt((x(i)-x_2)^2+(y(i)-y_2)^2);
    r3(i)=sqrt((x(i)-x_3)^2+(y(i)-y_3)^2);
    r0(i)=sqrt(x(i).^2+y(i).^2);
end
d_n=50;

noise=randn(1Num);
r21=r2-r1+d_n.*noise;
r31=r3-r1+d_n.*noise;
r01=r0+r1+d_n.*noise;


qq=d_n^2.*[1 0.5 0.5;0.5 1 0.5;0.5 0.5 1];

for k=1:Num
g_a1=-[x21 y21 r21(k);x31 y31 r31(k);-x_1 -y_1 -r01(k)];
h_a1=0.5*[r21(k).^2-D2+D1;r31(k).^2-D3+D1;r01(k).^2+D1];
the_10=inv(g_a1‘*inv(qq)*g_a1)*g_a1‘*inv(qq)*h_a1;  

b_1_temp=zeros(33

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----

     文件       1941  2007-04-25 22:02  CHAN\chan.m

     文件      25640  2007-04-05 21:29  CHAN\ls1.fig

     文件      26880  2007-04-05 21:34  CHAN\ls2.fig

     文件       2069  2007-04-25 21:32  CHAN\tdoa3_bijiao.asv

     文件       2007  2007-04-25 21:33  CHAN\tdoa3_bijiao.m

     目录          0  2009-04-24 08:16  CHAN

----------- ---------  ---------- -----  ----

                58537                    6


评论

共有 条评论