无源定位学习代码

实现无源定位，包括了时差和交叉；实现无源定位，包括了时差和交叉；实现无源定位，包括了时差和交叉；实现无源定位，包括了时差和交叉；实现无源定位，包括了时差和交叉；实现无源定位，包括了时差和交叉；实现无源定位，包括了时差和交叉；

function main

Length=100; 
Width=100;  
d=50;      
Node_number=6;
for i=1:Node_number 
    Node（i）.x=Width*rand; 
    Node（i）.y=Length*rand;
end

Target.x=Width*rand;
Target.y=Length*rand;

X=[]; 
for i=1:Node_number
    if DIST（Node（i）Target）<=d
        X=[X;Node（i）.xNode（i）.y];
    end
end
N=size（X1）;  
Est_Target.x=sum（X（:1））/N;
Est_Target.y=sum（X（:2））/N; 
Error_Dist=DIST（Est_TargetTarget）

figure
hold on;box on;axis（[0 100 0 100]）; 
for i=1:Node_number
    h1=plot（Node（i）.xNode（i）.y‘ko‘‘MarkerFace‘‘g‘‘MarkerSize‘10）;
    text（Node（i）.x+2Node（i）.y[‘Node ‘num2str（i）]）;
end
h2=plot（Target.xTarget.y‘k^‘‘MarkerFace‘‘b‘‘MarkerSize‘10）;
h3=plot（Est_Target.xEst_Target.y‘ks‘‘MarkerFace‘‘r‘‘MarkerSize‘10）;
line（[Target.xEst_Target.x][Target.yEst_Target.y]‘Color‘‘k‘）;
circle（Target.xTarget.yd）;
legend（[h1h2h3]‘Observation Station‘‘Target Postion‘‘Estimate Postion‘）;
xlabel（[‘error=‘num2str（Error_Dist）‘m‘]）;

function dist=DIST（AB）
dist=sqrt（ （A.x-B.x）^2+（A.y-B.y）^2 ）;

function circle（x0y0r）
sita=0:pi/20:2*pi;
plot（x0+r*cos（sita）y0+r*sin（sita））;

    

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

     文件       1154  2017-04-19 14:50  chap2\2.1\main.m

     文件       1277  2012-12-23 13:43  chap2\2.2\main.m

     文件       1557  2012-12-23 13:44  chap2\2.3\main.m

     目录          0  2018-04-23 23:24  chap2\2.1

     目录          0  2018-04-23 23:24  chap2\2.2

     目录          0  2018-04-23 23:24  chap2\2.3

     目录          0  2018-04-23 23:25  chap2

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

                 3988                    7