目标定位跟踪算法及仿真程序.docx

目标定位跟踪算法及仿真程序质心算法是最简单的定位算法，如图2-1所示，四个小圆为观测站，实线三角形是目标真实的位置，假设四个圆形观测站都探测到目标的存在，则根据质心定位算法，目标的位置(x,y)可以表示为：x=xi+x2+x3+x4,4y=yi+y2+y3+y4，这里观测站得位置为(x,y)，同理，当观测站数目为N4ii时，这时候的质心定位算法可以表示为：丄艺iyiN丄N耳图1质心定位%质心定位算法Matlab程序%functionmain%定位初始化Length=100;%场地空间，单位：米Width=100;%场地空间，单位：米d=50;%目标离观测站50米以内都能探测到，反之则不能Node_number=6;%观测站的个数fori=1:Node_number%观测站的位置初始化，这里位置是随机给定的Nod