evo估計(jì)VI-DSO和DSO的效果 2020-04-27

兩種比較方式:
-運(yùn)行時(shí)間的快慢
-誤差的大小

疑惑:result必須切換到秒云石,除以1e9,而真值還是用納秒唉工。
明天換幾個(gè)好的數(shù)據(jù)集,光照變化不明顯的汹忠,運(yùn)動(dòng)模糊的這些去除淋硝。

其中-r表示ape所基于的姿態(tài)關(guān)系,不添加-r/–pose_relation和可選項(xiàng),則默認(rèn)為trans_part宽菜。

evo-as.png
evo-r.png

-v表示verbose mode,詳細(xì)模式谣膳,
-a表示采用SE(3) Umeyama對(duì)齊,其余可選項(xiàng)如下表所示铅乡。
不加-s表示默認(rèn)尺度對(duì)齊參數(shù)為1.0继谚,即不進(jìn)行尺度對(duì)齊。

一定要加上-s

一隆判、運(yùn)行時(shí)間的比較:

運(yùn)行的時(shí)間在臺(tái)式機(jī)上運(yùn)行的時(shí)間特別慢犬庇,不調(diào)整UI的sparsity僧界,最后只能計(jì)算三到五幀侨嘀。正常情況應(yīng)該是20幀左右臭挽。

二、誤差分析:

TUM真實(shí)值格式: timestamp tx ty tz qx qy qz qw
EuRoc真實(shí)值格式: timestamp tx ty tz qw qx qy qz

true.csv文件不用修改咬腕,result.txt文件輸出為EuRoc格式
result.txt文件輸出的timestamps為0欢峰。這一塊需要修改。
EuRoc的時(shí)間戳超過int64涨共,需要time = time/1e9;

去除空格

DSO運(yùn)行得到的result.txt有空格(每行有8個(gè)元素纽帖,結(jié)尾沒有空格, 時(shí)間以秒為單位),運(yùn)行下面的命令:

cat result.txt | tr -s [:space:] > result_new.txt

在zshrc中添加 setopt no_nomatch

軌跡誤差:

evo_ape euroc true.csv result_imu.txt -as -p

evo_ape euroc true.csv result_new.txt -v -a -p --plot_mode=xz --save_results ./result/dso.ZIP

顯示軌跡:

evo_traj euroc V102_groundtruth.csv --plot

把euroc轉(zhuǎn)換為tum格式:

evo_traj euroc V102_groundtruth.csv --save_as_tum
evo_rpe tum true.txt estimate.txt --pose_relation angle_deg --delta 1 --delta_unit m

用法: python euroc2tum.py

程序功能:處理時(shí)間戳和互換qw和qx的位置

#!/usr/bin/python
# -*- coding: UTF-8 -*-
import csv
# 輸入csv文件名稱和輸出txt文件名稱
csv_file = raw_input('Enter the name of your input csv file: ')
txt_file = raw_input('Enter the name of your output txt file: ')
with open(txt_file, "w") as my_output_file:
    with open(csv_file, "r") as my_input_file:
        #逐行讀取csv存入txt中
        for row in csv.reader(my_input_file):
            # 前8個(gè)數(shù)據(jù)是:timestamp tx ty tz qw qx qy qz
            row = row[0:8]
            # 時(shí)間戳單位處理
            temp1 = row[0][0:10] + '.' + row[0][10:16]
            row[0] = temp1
            # 互換 qw 和 qx
            temp2 = row[4]
            row[4] = row[7]
            row[7] = temp2
            my_output_file.write(" ".join(row)+'\n')
    my_output_file.close()
最后編輯于
?著作權(quán)歸作者所有,轉(zhuǎn)載或內(nèi)容合作請(qǐng)聯(lián)系作者
  • 序言:七十年代末举反,一起剝皮案震驚了整個(gè)濱河市懊直,隨后出現(xiàn)的幾起案子,更是在濱河造成了極大的恐慌火鼻,老刑警劉巖室囊,帶你破解...
    沈念sama閱讀 217,406評(píng)論 6 503
  • 序言:濱河連續(xù)發(fā)生了三起死亡事件,死亡現(xiàn)場離奇詭異魁索,居然都是意外死亡融撞,警方通過查閱死者的電腦和手機(jī),發(fā)現(xiàn)死者居然都...
    沈念sama閱讀 92,732評(píng)論 3 393
  • 文/潘曉璐 我一進(jìn)店門粗蔚,熙熙樓的掌柜王于貴愁眉苦臉地迎上來尝偎,“玉大人,你說我怎么就攤上這事鹏控≈鲁叮” “怎么了?”我有些...
    開封第一講書人閱讀 163,711評(píng)論 0 353
  • 文/不壞的土叔 我叫張陵当辐,是天一觀的道長抖僵。 經(jīng)常有香客問我,道長瀑构,這世上最難降的妖魔是什么裆针? 我笑而不...
    開封第一講書人閱讀 58,380評(píng)論 1 293
  • 正文 為了忘掉前任,我火速辦了婚禮寺晌,結(jié)果婚禮上世吨,老公的妹妹穿的比我還像新娘。我一直安慰自己呻征,他們只是感情好耘婚,可當(dāng)我...
    茶點(diǎn)故事閱讀 67,432評(píng)論 6 392
  • 文/花漫 我一把揭開白布。 她就那樣靜靜地躺著陆赋,像睡著了一般沐祷。 火紅的嫁衣襯著肌膚如雪嚷闭。 梳的紋絲不亂的頭發(fā)上,一...
    開封第一講書人閱讀 51,301評(píng)論 1 301
  • 那天赖临,我揣著相機(jī)與錄音胞锰,去河邊找鬼。 笑死兢榨,一個(gè)胖子當(dāng)著我的面吹牛嗅榕,可吹牛的內(nèi)容都是我干的。 我是一名探鬼主播吵聪,決...
    沈念sama閱讀 40,145評(píng)論 3 418
  • 文/蒼蘭香墨 我猛地睜開眼凌那,長吁一口氣:“原來是場噩夢(mèng)啊……” “哼!你這毒婦竟也來了吟逝?” 一聲冷哼從身側(cè)響起帽蝶,我...
    開封第一講書人閱讀 39,008評(píng)論 0 276
  • 序言:老撾萬榮一對(duì)情侶失蹤,失蹤者是張志新(化名)和其女友劉穎块攒,沒想到半個(gè)月后励稳,有當(dāng)?shù)厝嗽跇淞掷锇l(fā)現(xiàn)了一具尸體,經(jīng)...
    沈念sama閱讀 45,443評(píng)論 1 314
  • 正文 獨(dú)居荒郊野嶺守林人離奇死亡局蚀,尸身上長有42處帶血的膿包…… 初始之章·張勛 以下內(nèi)容為張勛視角 年9月15日...
    茶點(diǎn)故事閱讀 37,649評(píng)論 3 334
  • 正文 我和宋清朗相戀三年麦锯,在試婚紗的時(shí)候發(fā)現(xiàn)自己被綠了。 大學(xué)時(shí)的朋友給我發(fā)了我未婚夫和他白月光在一起吃飯的照片琅绅。...
    茶點(diǎn)故事閱讀 39,795評(píng)論 1 347
  • 序言:一個(gè)原本活蹦亂跳的男人離奇死亡扶欣,死狀恐怖,靈堂內(nèi)的尸體忽然破棺而出千扶,到底是詐尸還是另有隱情料祠,我是刑警寧澤,帶...
    沈念sama閱讀 35,501評(píng)論 5 345
  • 正文 年R本政府宣布澎羞,位于F島的核電站髓绽,受9級(jí)特大地震影響,放射性物質(zhì)發(fā)生泄漏妆绞。R本人自食惡果不足惜顺呕,卻給世界環(huán)境...
    茶點(diǎn)故事閱讀 41,119評(píng)論 3 328
  • 文/蒙蒙 一、第九天 我趴在偏房一處隱蔽的房頂上張望括饶。 院中可真熱鬧株茶,春花似錦、人聲如沸图焰。這莊子的主人今日做“春日...
    開封第一講書人閱讀 31,731評(píng)論 0 22
  • 文/蒼蘭香墨 我抬頭看了看天上的太陽。三九已至僵闯,卻和暖如春卧抗,著一層夾襖步出監(jiān)牢的瞬間,已是汗流浹背鳖粟。 一陣腳步聲響...
    開封第一講書人閱讀 32,865評(píng)論 1 269
  • 我被黑心中介騙來泰國打工社裆, 沒想到剛下飛機(jī)就差點(diǎn)兒被人妖公主榨干…… 1. 我叫王不留牺弹,地道東北人浦马。 一個(gè)月前我還...
    沈念sama閱讀 47,899評(píng)論 2 370
  • 正文 我出身青樓时呀,卻偏偏與公主長得像张漂,于是被迫代替她去往敵國和親航攒。 傳聞我的和親對(duì)象是個(gè)殘疾皇子趴梢,可洞房花燭夜當(dāng)晚...
    茶點(diǎn)故事閱讀 44,724評(píng)論 2 354