多个目标定位的基本算法仿真

质心算法、RRSI算法、TOA算法、AOA算法等多个目标定位的基本算法，所有程序均已调通，仿真结果通过。

function main

Length=20; 
Width=20;  
d=10;      
Node_number=8;
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 20 0 20]）; 
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））;

    

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----
     文件        1150  2020-10-02 18:07  chap2\2.1\main.m
     文件        1277  2020-10-02 18:07  chap2\2.2\main.m
     文件        1553  2020-10-02 18:07  chap2\2.3\main.m
     文件        2267  2020-10-02 18:07  chap2\2.4\main.m
     文件        1076  2020-10-02 18:07  chap2\2.5\main.m
     文件        1250  2020-10-02 18:07  chap2\2.6\2.6.2\main.m
     文件        1382  2020-10-02 18:07  chap2\2.6\2.6.3\main.m
     文件        1345  2020-10-02 18:07  chap2\2.6\2.6.4\main.m
     文件        1258  2020-10-02 18:07  chap2\2.6\2.6.5\main.m