应用介绍

此项目是目标定位与跟踪的各种算法仿真代码。

%定位初始化

Length=100; %场地空间长度，单位：米

Width=100;  %场地空间宽度，单位：米

d=50;       %观测站最大测量距离

N=6;        %观测站个数

for i=1:N   %观测站位置初始化，位置随机给定

    Node(i).x=Width*rand;

    Node(i).y=Length*rand;

end

%目标出现在监测场地的真实位置，这里也随机给定

Target.x=Width*rand;

Target.y=Length*rand;

X=[];   %初始化，找出能探测到目标的观测站的位置集合

for i=1:N

    if getDist(Node(i),Target)<=d

        X=[X;Node(i).x, Node(i).y];  %保存探测到目标的观测站位置

    end

end

M=size(X,1);    %探测到目标的观测站个数

if M>0

    Est_Target.x=sum(X(:,1))/M;     %质心算法估计位置x

    Est_Target.y=sum(X(:,2))/M;     %质心算法估计位置y

    Error_Dist=getDist(Est_Target,Target); %目标真实位置与估计位置的偏差距离

end

.............................了解更多请下载附件。