7站定位，基于matlab声源定位

TDOA定位算法，基于7站定位算法，Taylor算法，仿真分析，误差分析

function X = ChanAlgorithm（BSN MSP Radius Noise）
%CHANALGORITHM 本函数用于实现无线定位中的CHAN算法
%               - BSN  为基站个数，3 < BSN <= 7；
%               - 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个文件信息