%判斷是否可以定位，這里只用一個(gè)標(biāo)簽。
clc;
clear;
%讀取csv文件
loc_info=csvread（‘C:\Users\Administrator\Desktop\loc.csv‘13[137005]）;
%選取標(biāo)簽地址
%先判斷定位序號(hào)?取初值為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）?%是否為同一定位序號(hào)
????????count=count+1;
%?????????disp（count）
?????????if?count==5???%這樣的話基站定位。
??????????%同一個(gè)標(biāo)簽，再看定位序號(hào)決定是否定位
??????????%取出定位時(shí)間戳
?????????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;
??????????%定位函數(shù)（）;
?????????PosTag=LSE_position（Reftimestamp）;
?????????P（:loc_num）=PosTag;
%??????????disp（number）;
%??????????else?
%??????????????disp（‘還不夠5個(gè)基站同步序號(hào)為:‘）
%??????????????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坐標(biāo)‘）????????
ylabel（‘Y坐標(biāo)‘）;
zlabel（‘Z坐標(biāo)‘）;???????
legend（‘基站位置‘‘標(biāo)簽估測(cè)位置‘0）
grid?on

???????????
???????????
????

?屬性????????????大小?????日期????時(shí)間???名稱
-----------?---------??----------?-----??----
?????目錄???????????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