資源簡介
TDOA定位算法,基于7站定位算法,Taylor算法,仿真分析,誤差分析

代碼片段和文件信息
function?X?=?ChanAlgorithm(BSN?MSP?Radius?Noise)
%CHANALGORITHM?本函數用于實現無線定位中的CHAN算法
%???????????????-?BSN??為基站個數,3?%???????????????-?MSP??為移動臺的初始位置?MSx?MSy均為[01]之間的數;
%??????????????????????特別要注意服務小區與MS之間的關系,MS的位置不能越界。
%???????????????-?Noise?測距誤差方差。
%???????????????-?R????為小區半徑,單位(meter);
%???????????????-?X????為移動臺經算法處理后的位置.
%See?also:?ChanAlgorithm.m
%算法與CHANFUN有重復,只是調用的參數不一樣。不同的已知參數,調用不同的函數
%???參數檢查:
if??nargout>1
????error(‘Too?many?output?arguments.‘);
end
if?nargin<2?|?nargin>4
????error(‘Wrong?number?of?input?arguments.‘);
end
%?算法開始:
BS?=?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)?0
????Za1(3)?=?abs(Za1(3));
%?????Za1(3)?=?0;
end
%***************************************************************
%?第二次LS:
%?第一次LS結果的協方差:
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)?0
%?????out1?=?-Za(1);
%?else
%?????out1?=?Za(1);
%?end
%?if?Za2(1)?0
%?????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
?屬性????????????大小?????日期????時間???名稱
-----------?---------??----------?-----??----
?????文件????2448124??2011-01-14?11:13??畢設matlab程序(3)\1.wav
?????文件????1183788??2011-01-15?21:03??畢設matlab程序(3)\151.wav
?????文件????1183788??2011-01-15?21:03??畢設matlab程序(3)\152.wav
?????文件????1183788??2011-01-15?21:04??畢設matlab程序(3)\153.wav
?????文件????2822268??2011-01-14?11:13??畢設matlab程序(3)\2.wav
?????文件???????2305??2011-01-14?22:40??畢設matlab程序(3)\ChanAlgorithm.m
?????文件???????1486??2011-01-14?22:34??畢設matlab程序(3)\GDOP.asv
?????文件???????1484??2011-01-14?22:36??畢設matlab程序(3)\GDOP.m
?????文件???????1809??2010-11-16?11:23??畢設matlab程序(3)\GDOP_Figure.asv
?????文件???????1807??2010-11-16?11:34??畢設matlab程序(3)\GDOP_Figure.m
?????文件???????2144??2011-01-09?17:15??畢設matlab程序(3)\GDOP_Figure2.asv
?????文件???????2146??2011-01-09?17:18??畢設matlab程序(3)\GDOP_Figure2.m
?????文件????????627??2011-01-15?21:23??畢設matlab程序(3)\NetworkTop.asv
?????文件????????627??2011-01-15?21:25??畢設matlab程序(3)\NetworkTop.m
?????文件???????2225??2007-07-17?18:22??畢設matlab程序(3)\SXAlgorithm.m
?????文件???????2967??2011-01-15?21:18??畢設matlab程序(3)\TaylorAlgorithm.asv
?????文件???????2643??2011-01-15?23:26??畢設matlab程序(3)\TaylorAlgorithm.m
?????文件???????1650??2011-01-10?13:39??畢設matlab程序(3)\TaylorAlgorithm2.m
?????文件????????668??2011-01-14?22:44??畢設matlab程序(3)\TDOA_RMSE.asv
?????文件????????668??2011-01-14?22:46??畢設matlab程序(3)\TDOA_RMSE.m
?????文件????????637??2011-01-10?13:43??畢設matlab程序(3)\TDOA_RMSE1.m
?????文件???????1332??2011-01-15?21:23??畢設matlab程序(3)\test.asv
?????文件???????1413??2011-01-15?23:19??畢設matlab程序(3)\test.m
?????文件???????1388??2011-01-10?13:45??畢設matlab程序(3)\test2.asv
?????文件???????1471??2011-01-10?13:55??畢設matlab程序(3)\test2.m
?????文件????????628??2011-01-14?19:11??畢設matlab程序(3)\yanshi.asv
?????文件????????628??2011-01-14?19:16??畢設matlab程序(3)\yanshi.m
?????目錄??????????0??2011-01-15?21:07??畢設matlab程序(3)
-----------?---------??----------?-----??----
??????????????8854509????????????????????28
............此處省略1個文件信息
評論
共有 條評論