uwb室内定位算法

这是一个uwb定位解算程序

%判断是否可以定位，这里只用一个标签。
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  
%     

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----

     文件       1630  2017-04-01 17:56  loc_test.m

     文件       1736  2017-03-19 21:41  LSE_position.m

----------- ---------  ---------- -----  ----

                 3366                    2