【WSN定位】基于chan算法实现无源定位附matlab代码

简介: 【WSN定位】基于chan算法实现无源定位附matlab代码

1 内容介绍


Chan 算法是 TDOA 定位方法的一个很赞的 trick。但是很多方法一旦从学术的角度去看,就罩上了奇异的光环。TDOAthe time differnces of arrival,到达时间差。Chan 算法1是非递归双曲线方程组解法,具有解析表达式解。其主要的特点为在测量误差服从理想高斯分布时,它的定位精度高、计算量小。该算法的推导的前提是基于测量误差为零均值高斯随机变量,对于实际环境中误差较大的测量值,比如在有非视距误差的环境下,该算法的性能会有显著下降。

读取基站经纬度---获取每个基站测到目标信号的时间--根据速度*时间求其基站与基站到目标的距离差,得到两组方程--使用CHAN算法求解该双曲线方程组--舍弃无效解,得到目标位置,与GPS定位进行比较,使用大地主题公式求其距离误差。

2 仿真代码

% TDOA定位的Chan算法Matlab源码

clc;

clear all;

close all

weizhi=xlsread('4月21日.xlsx','实验四','B1:C3');

shijian=xlsread('4月21日.xlsx','实验四','D1:D150');

gps=xlsread('4月21日.xlsx','实验四','B4:C4');

cc = 3e8;%g光速

length=floor(length(shijian)/3);

x=zeros(1,length);

y=zeros(1,length);

x3=zeros(1,length);

y1=zeros(1,length);

[X(1,1),X(1,2)]= jingwei(weizhi(1,1),weizhi(1,2));   %网关1

[X(2,1),X(2,2)]= jingwei(weizhi(2,1),weizhi(2,2));   %网关2

[X(3,1),X(3,2)]= jingwei(weizhi(3,1),weizhi(3,2));   %网关3

% X(1,1)=weizhi(1,1);X(1,2)=weizhi(1,2);   %网关1

% X(2,1)=weizhi(2,1);X(2,2)=weizhi(2,2);   %网关1

% X(3,1)=weizhi(3,1);X(3,2)=weizhi(3,2);   %网关1

X=X';

for i=1:length

   

   for j= 1:3

       K(j)=X(1,j)^2 + X(2,j)^2;

   end


%% 方差

m=mean(diff,2);

var=sum((diff(1,:)-m).^2)/100 ;

   %% 画图

   figure(1)

   t=1:100;

   plot(t,diff,'bo-');

   xlabel('次数');

   ylabel('误差大小(m)');    axis([0 100 0 700])

   title('实验四')


 disp(['平均误差为',num2str(mean(diff,2)),'方差为',num2str(var)]);

   figure(2)

   plot( weizhi(1,1),weizhi(1,2),'rs','LineWidth',2,...

       'MarkerEdgeColor','k',...

       'MarkerFaceColor','r',...

       'MarkerSize',10);hold on

   plot(weizhi(2,1),weizhi(2,2),'rs','LineWidth',2,...

       'MarkerEdgeColor','k',...

       'MarkerFaceColor','m',...

       'MarkerSize',10);hold on

   plot(weizhi(3,1),weizhi(3,2),'rs','LineWidth',2,...

       'MarkerEdgeColor','k',...

       'MarkerFaceColor','g',...

       'MarkerSize',10);hold on

   plot(gps(1,1),gps(1,2),'yo','LineWidth',2,...

       'MarkerEdgeColor','k',...

       'MarkerFaceColor','y',...

       'MarkerSize',10);hold on

    title('实验四')

    xlabel('经度');

    ylabel('纬度');

   for i=1:length

       plot(xx(i),yy(i),'bo');hold on

   end

    axis([108.93 108.95 34.05 34.09]);

   legend('基站1','基站2','基站3','目标真实位置','TDOA定位结果');

        figure(3);

    plot( weizhi(1,1),weizhi(1,2),'rs','LineWidth',2,...

       'MarkerEdgeColor','k',...

       'MarkerFaceColor','r',...

       'MarkerSize',10);hold on

   plot(weizhi(2,1),weizhi(2,2),'rs','LineWidth',2,...

       'MarkerEdgeColor','k',...

       'MarkerFaceColor','m',...

       'MarkerSize',10);hold on

   plot(weizhi(3,1),weizhi(3,2),'rs','LineWidth',2,...

       'MarkerEdgeColor','k',...

       'MarkerFaceColor','g',...

       'MarkerSize',10);hold on

   plot(gps(1,1),gps(1,2),'yo','LineWidth',2,...

       'MarkerEdgeColor','k',...

       'MarkerFaceColor','y',...

       'MarkerSize',10);hold on

     legend('基站1','基站2','基站3','目标真实位置');

    title('实验四')

    xlabel('经度');

    ylabel('纬度');

3 运行结果

4 参考文献

[1]沙勇. 基于Matlab的WSN定位算法仿真设计[J]. 齐齐哈尔大学学报:自然科学版, 2017, 33(6):3.

博主简介:擅长智能优化算法、神经网络预测、信号处理、元胞自动机、图像处理、路径规划、无人机等多种领域的Matlab仿真,相关matlab代码问题可私信交流。

部分理论引用网络文献,若有侵权联系博主删除。

相关文章
|
16天前
|
算法
分享一些提高二叉树遍历算法效率的代码示例
这只是简单的示例代码,实际应用中可能还需要根据具体需求进行更多的优化和处理。你可以根据自己的需求对代码进行修改和扩展。
|
28天前
|
算法 测试技术 开发者
在Python开发中,性能优化和代码审查至关重要。性能优化通过改进代码结构和算法提高程序运行速度,减少资源消耗
在Python开发中,性能优化和代码审查至关重要。性能优化通过改进代码结构和算法提高程序运行速度,减少资源消耗;代码审查通过检查源代码发现潜在问题,提高代码质量和团队协作效率。本文介绍了一些实用的技巧和工具,帮助开发者提升开发效率。
35 3
|
27天前
|
分布式计算 Java 开发工具
阿里云MaxCompute-XGBoost on Spark 极限梯度提升算法的分布式训练与模型持久化oss的实现与代码浅析
本文介绍了XGBoost在MaxCompute+OSS架构下模型持久化遇到的问题及其解决方案。首先简要介绍了XGBoost的特点和应用场景,随后详细描述了客户在将XGBoost on Spark任务从HDFS迁移到OSS时遇到的异常情况。通过分析异常堆栈和源代码,发现使用的`nativeBooster.saveModel`方法不支持OSS路径,而使用`write.overwrite().save`方法则能成功保存模型。最后提供了完整的Scala代码示例、Maven配置和提交命令,帮助用户顺利迁移模型存储路径。
|
2月前
|
存储 缓存 算法
如何通过优化算法和代码结构来提升易语言程序的执行效率?
如何通过优化算法和代码结构来提升易语言程序的执行效率?
|
2月前
|
搜索推荐
插入排序算法的讲解和代码
【10月更文挑战第12天】插入排序是一种基础的排序算法,理解和掌握它对于学习其他排序算法以及数据结构都具有重要意义。你可以通过实际操作和分析,进一步深入了解插入排序的特点和应用场景,以便在实际编程中更好地运用它。
|
2月前
|
缓存 分布式计算 监控
优化算法和代码需要注意什么
【10月更文挑战第20天】优化算法和代码需要注意什么
18 0
|
2月前
|
算法 Java 测试技术
数据结构 —— Java自定义代码实现顺序表,包含测试用例以及ArrayList的使用以及相关算法题
文章详细介绍了如何用Java自定义实现一个顺序表类,包括插入、删除、获取数据元素、求数据个数等功能,并对顺序表进行了测试,最后还提及了Java中自带的顺序表实现类ArrayList。
25 0
|
3月前
|
机器学习/深度学习 存储 算法
经典算法代码
这段代码展示了多个经典算法,包括:穷举法解决“百钱买百鸡”问题;递推法计算“猴子吃桃”问题;迭代法求解斐波那契数列及折纸高度超越珠峰的问题。同时,还提供了希尔排序算法实现及披萨票务订购系统和汉诺塔问题的链表存储解决方案。每部分通过具体案例解释了算法的应用场景与实现方法。
31 3
|
4月前
|
人工智能 算法 数据可视化
DBSCAN密度聚类算法(理论+图解+python代码)
DBSCAN密度聚类算法(理论+图解+python代码)
|
4月前
|
数据采集 搜索推荐 算法
【高手进阶】Java排序算法:从零到精通——揭秘冒泡、快速、归并排序的原理与实战应用,让你的代码效率飙升!
【8月更文挑战第21天】Java排序算法是编程基础的重要部分,在算法设计与分析及实际开发中不可或缺。本文介绍内部排序算法,包括简单的冒泡排序及其逐步优化至高效的快速排序和稳定的归并排序,并提供了每种算法的Java实现示例。此外,还探讨了排序算法在电子商务、搜索引擎和数据分析等领域的广泛应用,帮助读者更好地理解和应用这些算法。
46 0