【室内定位】基于TDOA实现三维和二维室内定位matlab源码

326 阅读2分钟

1 模型

移动通信环境中,非视距传播与多径效应引起的信号附加时廷是影响TDOA定位精度的主要因素,深入研究信号到达时间差误差的统计特性,有利于进一步提高TDOA定位的精度.基于移动通信环境中非视距传播信号附加时廷服从指数分布的特性,综合考虑信号检测过程中引入的系统误差,利用统计分析方法,建立了信号到达时间的统计模型和到达时问差的误差分布模型,模型反映了蜂窝网络中信号到达时间和到达时间差误差的统计规律,模拟实验证明了模型的有效性.

2 部分代码

%**********本程序为三维空间内,TDOA方案定位,直接解方程法仿真


clear all
clc
close all
%close
tic

X = 50;
Y = 50;
Z = 50;
N = 1;
c = 3e8;
num = 0;
k = 0;
mse = [];
max_mse = 0;
min_mse = 0.04;


distribute = [];
num0 = 0;
num1 = 0;
num2 = 0;
num3 = 0;
num4 = 0;
num5 = 0;
num6 = 0;

position_maxerror = [];
position_minerror = [];

o1x = 0;o1y = 0;o1z = 0;   %坐标原点
o2x = X;o2y = 0;o2z = Z;   %x轴方向
o3x = X;o3y = Y;o3z = 0;   %y轴方向
o4x = 0;o4y = Y;o4z = Z;   %z轴方向

o5x = X/2;o5y = Y/2;o5z = Z/2;   %辅助站坐标 

for j=1:N
    
delta_mid1 = []
delta_mid2 = []
XX = rand*50;
YY = rand*50;
ZZ = rand*50;    
user = [XX YY ZZ];

%****************************解方程组1(1 2 3 4)********************************


figure(4)
plot3(o1x,o1y,o1z,'bo');hold on
plot3(o2x,o2y,o2z,'bo');hold on
plot3(o3x,o3y,o3z,'bo');hold on
plot3(o4x,o4y,o4z,'bo');hold on
plot3(o5x,o5y,o5z,'bo');hold on
plot3(XX,YY,ZZ,'go');hold on
plot3(position11(1),position11(2),position11(3),'r*');hold on
legend('雷达1','雷达2','雷达3','雷达4','雷达5','目标真实位置','预测位置')
toc

3 仿真结果

4 参考文献

[1]张志良, 孙棣华, 张星霞. TDOA定位中到达时间及时间差误差的统计模型[J]. 重庆大学学报, 2006, 29(001):85-88.

[2]孙胜, 李辉, & 韩崇昭. (2002). 基于tdoa定位技术的仿真研究. 无线通信技术(04), 40-43.

5 完整MATLAB代码与数据下载地址

私戳