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

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