資源簡介
Chan算法的數(shù)學(xué)原理。Chan算法可將TDOA中的求解多個(gè)雙曲線的非線性方程求解,化為帶參數(shù)的偽線性方程,可大大降低運(yùn)算量。但在求解參數(shù)r0r_0r
0
?
時(shí),會(huì)存在無解,一個(gè)解,兩個(gè)解三種情況。即Chan算法,存在不可定位和定位模糊的可能,在出現(xiàn)定位模糊時(shí),需要我們引入新的時(shí)間差信息,對其中的一個(gè)偽解進(jìn)行剔除
代碼片段和文件信息
function?Zp=myChan2(BSNBSR)
Q=eye(BSN-1);
K1=0;
for?i=1:BSN-1
????K(i)=BS(1i+1)^2+BS(2i+1)^2;
end
for?i=1:BSN-1
????Ga(i1)=-BS(1i+1);
????Ga(i2)=-BS(2i+1);
????Ga(i3)=-R(i);
end
for?i=1:BSN-1
????h(i)=0.5*(R(i)^2-K(i)+K1);
end
Za0?=?inv(Ga‘*inv(Q)*Ga)*Ga‘*inv(Q)*h‘;
B=eye(BSN-1);
for?i=1:BSN-1
????B(i1)=sqrt((BS(1i+1)-Za0(1))^2+(BS(2
評論
共有 條評論