博客
关于我
【wsn定位问题】基于chan算法求解wsn定位问题
阅读量:265 次
发布时间:2019-03-01

本文共 2075 字,大约阅读时间需要 6 分钟。

一、简介

Chan 算法是 TDOA 定位方法的一个很赞的 trick。但是很多方法一旦从学术的角度去看,就罩上了奇异的光环。TDOA,the time differnces of arrival,到达时间差。

Chan 算法1是非递归双曲线方程组解法,具有解析表达式解。其主要的特点为在测量误差服从理想高斯分布时,它的定位精度高、计算量小,并且可以通过增加基站数量来提高算法精度。该算法的推导的前提是基于测量误差为零均值高斯随机变量,对于实际环境中误差较大的测量值,比如在有非视距误差的环境下,该算法的性能会有显著下降。Chan 算法在考虑二维的情况下,可分为 只有三个 BS 参与定位 和 三个以上 BS 定位 两种。
在这里插入图片描述
在这里插入图片描述
在这里插入图片描述
在这里插入图片描述
在这里插入图片描述
在这里插入图片描述
在这里插入图片描述
在这里插入图片描述
在这里插入图片描述
在这里插入图片描述
在这里插入图片描述
在这里插入图片描述

二、源代码

function X = ChanAlgorithm(BSN, MSP, Radius, Noise)%CHANALGORITHM 本函数用于实现无线定位中的CHAN算法%               - BSN  为基站个数,3 < BSN <= 7;%               - MSP  为移动台的初始位置, MSx, MSy均为[0,1]之间的数;%                      特别要注意服务小区与MS之间的关系,MS的位置不能越界。%               - Noise 测距误差方差。%               - R    为小区半径,单位(meter);%               - X    为移动台经算法处理后的位置.%See also: ChanAlgorithm.m%   参数检查:if  nargout>1,    error('Too many output arguments.');endif nargin<2 | nargin>4,    error('Wrong number of input arguments.');end% 算法开始:BS = Radius*NetworkTop(BSN);MS = Radius*MSP;% 噪声功率:Q = eye(BSN-1);% 第一次LS:% RiK1 = 0;for i = 1: BSN,    R0(i) = sqrt((BS(1,i) - MS(1))^2 + (BS(2,i) - MS(2))^2);endfor i = 1: BSN-1,    R(i) = R0(i+1) - R0(1) + Noise*randn(1);    K(i) = BS(1,i+1)^2 + BS(2,i+1)^2;end% Gafor i = 1: BSN-1,    Ga(i,1) = -BS(1, i+1);    Ga(i,2) = -BS(2, i+1);    Ga(i,3) = -R(i);end% hfor 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(i,i) = sqrt((BS(1,i+1) - Za0(1))^2 + (BS(2,i+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(i,i) = Za1(i);end% sFI:sFI = 4*sB*CovZa*sB;% sGa:sGa = [1, 0; 0, 1; 1, 1];% shsh  = [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

完整代码或者代写添加QQ1575304183

往期回顾>>>>>>

转载地址:http://ctgx.baihongyu.com/

你可能感兴趣的文章
MySQL 日期时间类型的选择
查看>>
Mysql 时间操作(当天,昨天,7天,30天,半年,全年,季度)
查看>>
MySQL 是如何加锁的?
查看>>
MySQL 是怎样运行的 - InnoDB数据页结构
查看>>
mysql 更新子表_mysql 在update中实现子查询的方式
查看>>
MySQL 有什么优点?
查看>>
mysql 权限整理记录
查看>>
mysql 权限登录问题:ERROR 1045 (28000): Access denied for user ‘root‘@‘localhost‘ (using password: YES)
查看>>
MYSQL 查看最大连接数和修改最大连接数
查看>>
MySQL 查看有哪些表
查看>>
mysql 查看锁_阿里/美团/字节面试官必问的Mysql锁机制,你真的明白吗
查看>>
MySql 查询以逗号分隔的字符串的方法(正则)
查看>>
MySQL 查询优化:提速查询效率的13大秘籍(避免使用SELECT 、分页查询的优化、合理使用连接、子查询的优化)(上)
查看>>
mysql 查询,正数降序排序,负数升序排序
查看>>
MySQL 树形结构 根据指定节点 获取其下属的所有子节点(包含路径上的枝干节点和叶子节点)...
查看>>
mysql 死锁 Deadlock found when trying to get lock; try restarting transaction
查看>>
mysql 死锁(先delete 后insert)日志分析
查看>>
MySQL 死锁了,怎么办?
查看>>
MySQL 深度分页性能急剧下降,该如何优化?
查看>>
MySQL 深度分页性能急剧下降,该如何优化?
查看>>