26TDOA定位的Chan算法MATLAB源代码.doc

26TDOA定位的Chan算法MATLAB源代码.doc欢迎访问 GreenSim 团队主页宀 邮箱：******@
第1页
欢迎访问 GreenSim 团队主页宀 邮箱：******@
第2页
TD0A定位的Chan算法MATLAB源代码
Chan算法是解决TDOA定位的经典算法，被众多的论文所引用
fun ctio n [ POS_ref,POS1,POS2,POS3,POS4] = TD0A_cha n(R,Pbs,Q) %% TDOA 定位定位 Chan算法
% GreenSim团队一一专业级算法设计 &代写程序
% a = 2*pi/M;
% for i=1:M
% 欢迎访问 GreenSim 团队主页宀
°%*********************************************************
%
CHAN算法,假设移动台与各基站位置较近，需进行三四WLS计算
%
输入参数:
%
R(N-1 X 1): TDOA 测量值
%
Pbs(N X 2):基站的坐标，第一列为X,第二列为Y;参考基站坐标位于第一行
%
输出参数:
%
POS_ref(2X1):
第一次WLS的估计结果，作为参考作最终定位结果的判决
%
POS1(2X1)
:定位结果1
%
POS2(2X1)
:定位结果2
%
POS3(2X1)
:定位结果3
%
POS4(2X1)
:定位结果4
%这段程序用于自己产生算法输入参数，用于算法测试
% delta = 10;
% M=4;
% Xb = 20;Yb = 100;
% X = zeros(M,2);
%TDOA测量误差的标准差，用于产生Q矩阵
%参考基站外的基站数量
%参考的基站坐标
%生成其他基站的坐标
% X(i,1) = 400*cos(a*(i-1));
% X(i,2) = 400*si n(a*(i-1));
% end
% Xreal = -150;Yreal = 200;% 移动台真实坐标
% %产生TDOA测量结果 % Rb = sqrt((Xreal - Xb)A2+(Yreal - Yb)A2);% 移动台到基站的真实距离
% N = normrnd(0,delta,1,M);% 产生 TDOA 测量误差
% Kb = XbA2+YbA2;
%产生TDOA测量值
% R = zeros(M,1);
% for i=1:M % R(i) = -Rb+sqrt((Xreal - X(i,1))A2+(Yreal - X(i,2))A2)+N(i);
% end % Q = (*eye(M)+*o nes(M))*(deltaA2);
% Pbs = [Xb Yb;X];
% N = 5;
% [POS_ref POS1 POS2 POS3 POS4] = TDOA_cha n(R,Pbs,Q)