uwb定位算法

0分 UWB各种算法合集 UWB各种算法合集,这里内含了各种UWB算法，包含了最小二乘，Chan，Fang，TOA，TDOA，RSSI全部可matlab仿真

%判断是否可以定位，这里只用一个标签。
clc;
clear;
%读取csv文件
loc_info=csvread（‘C:\Users\Administrator\Desktop\loc.csv‘13[137005]）;
%选取标签地址
%先判断定位序号 取初值为loc_info（12）;
%输入基站位置
Ref=[1 2 3 4 5;460 1121 1121 53 53;16 16 558 558 16; 288 208 218 228 238];%基站位置
x=Ref（2:）;
y=Ref（3:）;
z=Ref（4:）;

number=loc_info（12）;
timestamp=zeros（15）;
count=0;
loc_num=0;
for i=1:36     
    if  number==loc_info（i2） %是否为同一定位序号
        count=count+1;
%         disp（count）
         if count==5   %这样的话基站定位。
          %同一个标签，再看定位序号决定是否定位
          %取出定位时间戳
         timestamp=[loc_info（i-43）loc_info（i-33）loc_info（i-23）loc_info（i-13）loc_info（i3）];
% %          disp（timestamp）;
% %          disp（number）
         %第loc次定位
         loc_num=loc_num+1;
          %定位函数（）;
         PosTag=LSE_position（Reftimestamp）;
         P（:loc_num）=PosTag;
%          disp（number）;
%          else 
%              disp（‘还不够5个基站同步序号为:‘）
%              disp（number）;
         end
    else  
%         disp（number）
        count=1;
        number=loc_info（i2）;
        timestamp=0;
    end
end
xt=P（2:）;
yt=P（3:）;
zt=P（4:）;

plot3（xyz‘bs‘xtytzt‘.-r‘）;
%         plot3（PosTag（2）PosTag（3）PosTag（4）‘rp‘）;
%         hold on;
%         plot3（xtytzt‘ko‘‘MarkerEdgeColor‘‘k‘‘MarkerFaceColor‘‘y‘‘MarkerSize‘12）;
title（‘最小二乘3D定位模型‘）;
xlabel（‘X坐标‘）        
ylabel（‘Y坐标‘）;
zlabel（‘Z坐标‘）;       
legend（‘基站位置‘‘标签估测位置‘0）
grid on

           
           
    

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----
     目录           0  2018-10-23 10:27  uwb_robot\
     文件        1630  2017-04-01 17:56  uwb_robot\loc_test.m
     文件        1736  2017-03-19 21:41  uwb_robot\LSE_position.m