資源簡介
這是一個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
- 上一篇:simuli
nk中MPC汽車軌跡跟蹤模型 - 下一篇:校園網規劃方案
評論
共有 條評論