function?X?=?ChanAlgorithm（BSN?MSP?Radius?Noise）
%CHANALGORITHM?本函數(shù)用于實現(xiàn)無線定位中的CHAN算法
%???????????????-?BSN??為基站個數(shù)，3?%???????????????-?MSP??為移動臺的初始位置?MSx?MSy均為[01]之間的數(shù)；
%??????????????????????特別要注意服務小區(qū)與MS之間的關系，MS的位置不能越界。
%???????????????-?Noise?測距誤差方差。
%???????????????-?R????為小區(qū)半徑，單位（meter）；
%???????????????-?X????為移動臺經(jīng)算法處理后的位置.
%See?also:?ChanAlgorithm.m
%???參數(shù)檢查：
if??nargout>1
?????error（‘Too?many?output?arguments.‘）;
end
if?nargin~=4
?????error（‘Wrong?number?of?input?arguments.‘）;
end

%?算法開始：
BS?=?Radius*NetworkTop（BSN）;
MS?=?Radius*MSP;
%?噪聲功率：
Q?=?eye（BSN-1）;
%?第一次LS：
%?Ri
K1?=?0;
for?i?=?1:?BSN
?????R0（i）?=?sqrt（（BS（1i）?-?MS（1））^2?+?（BS（2i）?-?MS（2））^2）;
end
for?i?=?1:?BSN-1
?????R（i）?=?R0（i+1）?-?R0（1）?+?Noise*randn（1）;
?????K（i）?=?BS（1i+1）^2?+?BS（2i+1）^2;
end
%?Ga
for?i?=?1:?BSN-1
?????Ga（i1）?=?-BS（1?i+1）;
?????Ga（i2）?=?-BS（2?i+1）;
?????Ga（i3）?=?-R（i）;
end
%?h
for?i?=?1:?BSN-1
?????h（i）?=?0.5*（R（i）^2?-?K（i）?+?K1）;
end
%?由（14b）給出B的估計值：
Za0?=?inv（Ga‘*inv（Q）*Ga）*Ga‘*inv（Q）*h‘;
%?利用這個粗略估計值計算B：
B?=?eye（BSN-1）;
for?i?=?1:?BSN-1
?????B（ii）?=?sqrt（（BS（1i+1）?-?Za0（1））^2?+?（BS（2i+1）?-?Za0（2））^2）;
end
%?FI:
FI?=?B*Q*B;
%?第一次LS結果：
Za1?=?inv（Ga‘*inv（FI）*Ga）*Ga‘*inv（FI）*h‘;
if?Za1（3）??????Za1（3）?=?abs（Za1（3））;
%?????Za1（3）?=?0;
end
%***************************************************************
%?第二次LS：
%?第一次LS結果的協(xié)方差：
CovZa?=?inv（Ga‘*inv（FI）*Ga）;
%?sB：
sB?=?eye（3）;
for?i?=?1:?3
?????sB（ii）?=?Za1（i）;
end
%?sFI：
sFI?=?4*sB*CovZa*sB;
%?sGa：
sGa?=?[1?0;?0?1;?1?1];
%?sh
sh??=?[Za1（1）^2;?Za1（2）^2;?Za1（3）^2];
%?第二次LS結果：
Za2?=?inv（sGa‘*inv（sFI）*sGa）*sGa‘*inv（sFI）*sh;
%?Za?=?sqrt（abs（Za2））;
Za?=?sqrt（Za2）;
%?輸出:
%?if?Za1（1）?%?????out1?=?-Za（1）;
%?else
%?????out1?=?Za（1）;
%?end
%?if?Za2（1）?%?????out2?=?-Za（2）;
%?else
%?????out2?=?Za（2）;
%?end
%?
%?out?=?[out1;out2];
out?=?abs（Za）;
%?out?=?Za;
if?nargout?==?1
?????X?=?out;
elseif?nargout?==?0
?????disp（out）;
end

?屬性????????????大小?????日期????時間???名稱
-----------?---------??----------?-----??----
?????文件????????2192??2014-01-14?12:07??chan.m