• 大小: 4.96MB
    文件类型: .rar
    金币: 1
    下载: 0 次
    发布日期: 2023-08-13
  • 语言: Matlab
  • 标签: 7站定位  

资源简介

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个文件信息

评论

共有 条评论

相关资源