TDOA定位的Chan算法MATLAB源代码
TDOA定位的Chan算法MATLAB源代码 。
function [POS_ref,POS1,POS2,POS3,POS4] = TDOA_chan(R,Pbs,Q)
%*********************************************************
% 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);%M行2列0
% 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测量误差 正态分布 均值0 标准差 delta 返回一
个N数组下标为1 到 M
% 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];%矩阵
% N = 5;
% [POS_ref POS1 POS2 POS3 POS4] = TDOA_chan(R,Pbs,Q)
N = size(Pbs,1);%维度
K = zeros(1,N);
K = Pbs(:,1).^2 + Pbs(:,2).^2;
ha = 0.5*(R.^2-K(2:N)+K(1))
Ga = -[Pbs(2:N,1)-Pbs(1,1) Pbs(2:N,2)-Pbs(1,2) R] www.docin.com
%计算第一次WLS估计结果远距算法
Za = inv(Ga.'*inv(Q)*Ga)*Ga.'*inv(Q)*ha;
Ba = diag(Va);
Fa = Ba*Q*Ba;
Zacov = inv(Ga.'*inv(Fa)*Ga);
%第一次计算近距算法
Va2 = sqrt((Za2(1)-Pbs(2:N,1)).^2+(Za2(2)-Pbs(2:N,2)).^2);
Ba2 = diag(Va2);
Fa2 = Ba2*Q*Ba2;
Zacov2 = inv(Ga.'*inv(Fa2)*Ga);
%第二次计算近距算法
Gb = [1 0;0 1;1 1];
Bb2 = [Za2(1)-Pbs(1,1) 0 0;0 Za2(2)-Pbs(1,2) 0;0 0
sqrt((Za2(1)-Pbs(1,1))^2+(Za2(2)-Pbs(1,2))^2)];
Fb2 = 4*Bb2*Zacov2*Bb2;
POS_ref = Za2(1:2,1); %第一次WLS的估计结果,作为参考作最终定位结果的判决
POS1 = sqrt(Zb2)+Pbs(1,:).'; %定位结果1
POS2 = -sqrt(Zb2)+Pbs(1,:).';%定位结果2
POS3 = [-sqrt(Zb2(1));sqrt(Zb2(2))]+Pbs(1,:).';%定位结果3
POS4 = [sqrt(Zb2(1));-sqrt(Zb2(2))]+Pbs(1,:).';%定位结果4
TDOA定位的Chan算法MATLAB源代码相关推荐
- 【老生谈算法】matlab实现TDOA定位的Chan算法源码——TDOA定位
TDOA定位的Chan算法MATLAB源代码 1.原文下载: 本算法原文如下,有需要的朋友可以点击进行下载 序号 原文(点击下载) 本项目原文 [老生谈算法]TDOA定位的Chan算法MATLAB源代 ...
- 用C/C++实现输入IQ数据,计算时差(IQ数据互相关),完成TDOA定位(Chan算法)
文末贴源码链接 需求:已知接收机IQ数据,根据IQ数据做互相关,求信号时差,最终通过TDOA(Chan算法)定位发射机坐标.输入输出坐标均为经纬度坐标,而在TDOA计算中,需要笛卡尔坐标系坐标,涉及坐 ...
- matlab虚拟力,31无线传感网络布局优化的虚拟力导向粒子群算法MATLAB源代码
无线传感网络布局优化的虚拟力导向粒子群算法MATLAB源代码 本源代码主要参考了下面的文献:王雪, 王晟, 马俊杰. 无线传感器网络布局的虚拟力导向微粒群优化策略[J]. 电子学报, 2007, 11 ...
- gwo算法matlab源代码,智能优化算法应用:基于GWO优化BP神经网络 - 附代码
智能优化算法应用:基于GWO优化BP神经网络 - 附代码 智能优化算法应用:基于GWO优化BP神经网络 - 附代码 智能优化算法应用:基于GWO优化BP神经网络 文章目录智能优化算法应用:基于GWO优 ...
- 【老生谈算法】matlab实现Chan算法及其验证源码——Chan算法
Chan算法及其验证 matlab程序 1.文档下载: 本算法已经整理成文档如下,有需要的朋友可以点击进行下载 序号 文档(点击下载) 本项目文档 [老生谈算法]chan算法定位-matlab.doc ...
- matlab chan算法定位,MATLAB实现基于Chan氏算法的三维TDOA定位
% 功能:基于chan算法的TDOA三维定位 function [zp] = Chan_3(Noise,MS) %基站数目 BSN = 7; %基站位置,每一列为一个基站位置 BS = [0, 2*s ...
- TDOA定位 chan算法和Taylor算法比较仿真 matlab
最近在学习TDOA定位算法,需要比较chan(查恩算法)和Taylor(泰勒级数算法)的定位效果. 分别实现的效果图: 运动目标从零点开始沿x=y做匀速运动. 观测站坐标如下: 在不同的雷达测距误差下 ...
- 基于TDOA的chan算法(定位算法)
Chan算法原理 TDOA(TDOA,the time differences of arrival,到达时间差),Chan算法是TDOA定位方法的一个很好用的方法. Chan算法是非递归双曲线方程组 ...
- 在matlab下实现TDOA定位算法性能仿真
一.题目 TDOA定位算法性能仿真 二.仿真要求 要求一:编写两个函数TDOA_CHAN和TDOA_Taylor得到位置的估计. 要求二:用RMSE实现两种算法的性能比较, 得到两种算法的RMSE曲线 ...
最新文章
- 分布式计算开源框架Hadoop入门实践
- leetcode算法题--一周中的第几天
- Python爬虫入门(8):Beautiful Soup的用法
- Angular 服务器端渲染的学习笔记(一)
- 想做大数据的,可以看看这个学习路线,超全!
- 「SCOI2011」棘手的操作
- mysql游标进阶_MYSQL进阶学习知识拓展一:MySQL 存储过程之游标!
- gps频率范围_以GPS为例讲解射频接收阻抗匹配的过程
- 调试内存_如何调试Python 程序的内存泄露问题
- 【HANA系列】SAP HANA中null变成问号的问题
- Leetcode207---课程表(逆拓扑排序)
- 用计算机考试怎么作弊,一种防作弊计算机考试系统的制作方法
- ThinkPHP高仿蓝奏云网盘系统源码/对接易支付系统程序
- jsmy97时间控件,时间范围选择
- halcon分割区域的方法
- Android转接电话到iPhone,Android迁移数据到iPhone
- webrtc 支持h264 思路
- MySQL的三层架构(连接认证、解析优化和存储引擎)
- 【电源专题】回顾:了解LDO的的专业术语与定义 2
- 《孩子,为你自己读书》(Yanlz+Unity+SteamVR+云技术+5G+AI+VR云游戏+多多图书馆+志存当高远+读万卷书如行万里路+术业有专攻+读书是对思想的一种升华+立钻哥哥++==)