26TDOA定位的Chan算法MATLAB源代码
4星 · 超过85%的资源 需积分: 46 71 浏览量
2015-05-18
21:06:09
上传
评论 19
收藏 79KB DOCX 举报 
欢迎访问 GreenSim 团队主页→http://blog.sina.com.cn/greensim 邮箱：greensim@163.com
TDOA 定位的 Chan 算法 MATLAB 源代码
Chan 算法是解决 TDOA 定位的经典算法，被众多的论文所引用。
function [POS_ref,POS1,POS2,POS3,POS4] = TDOA_chan(R,Pbs,Q)
%% TDOA 定位定位 Chan 算法
% GreenSim 团队——专业级算法设计&代写程序
% 欢迎访问 GreenSim 团队主页→http://blog.sina.com.cn/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 = (0.5*eye(M)+0.5*ones(M))*(delta^2);
% Pbs = [Xb Yb;X];
第 1 页
- 1
- 2
前往页