資源簡(jiǎn)介
使用matlab畫(huà)ORBSLAM2運(yùn)行保存的軌跡文件:對(duì)產(chǎn)生的軌跡進(jìn)行繪制,保存的KeyFrameTrajectory.txt格式.保存的格式為時(shí)間戳+平移+旋轉(zhuǎn).繪制軌跡其實(shí)只要有平移就行了,因?yàn)樵趫D上體現(xiàn)不出一個(gè)點(diǎn)的方向
代碼片段和文件信息
clear?all;?
clc;?
fidin=fopen(‘KeyframeTrajectory.txt‘);?%?打開(kāi)test2.txt文件?????????????
fidout=fopen(‘trajectory_deal.txt‘‘w‘);?%?創(chuàng)建MKMATLAB.txt文件?
while?~feof(fidin)?%?判斷是否為文件末尾???????????????
tline=fgetl(fidin);?%?從文件讀行???
if?double(tline(1))>=48&&double(tline(1))<=57?%?判斷首字符是否是數(shù)值?
fprintf(fidout‘%s\n\n‘tline);?%?如果是數(shù)字行,把此行數(shù)據(jù)寫(xiě)入文件MKMATLAB.txt?
continue?%?如果是非數(shù)字繼續(xù)下一次循環(huán)?
end?
end?
fclose(fidout);?
transformation=importdata(‘trajectory_deal.txt‘);?%?將生成的MKMATLAB.txt文件導(dǎo)入工作空間,變量名為MK,實(shí)際上它不顯示出來(lái)?
plot3(transformation(:?2)?transformation(:?3)?transformation(:?4)?‘ro-‘?‘Linewidth‘?2);?
grid?on;
評(píng)論
共有 條評(píng)論