evo估计VI-DSO和DSO的效果 2020-04-27

两种比较方式:
-运行时间的快慢
-误差的大小

疑惑:result必须切换到秒,除以1e9,而真值还是用纳秒。
明天换几个好的数据集,光照变化不明显的,运动模糊的这些去除。

其中-r表示ape所基于的姿态关系,不添加-r/–pose_relation和可选项,则默认为trans_part。

evo-as.png
evo-r.png

-v表示verbose mode,详细模式,
-a表示采用SE(3) Umeyama对齐,其余可选项如下表所示。
不加-s表示默认尺度对齐参数为1.0,即不进行尺度对齐。

一定要加上-s

一、运行时间的比较:

运行的时间在台式机上运行的时间特别慢,不调整UI的sparsity,最后只能计算三到五帧。正常情况应该是20帧左右。

二、误差分析:

TUM真实值格式: timestamp tx ty tz qx qy qz qw
EuRoc真实值格式: timestamp tx ty tz qw qx qy qz

true.csv文件不用修改,result.txt文件输出为EuRoc格式
result.txt文件输出的timestamps为0。这一块需要修改。
EuRoc的时间戳超过int64,需要time = time/1e9;

去除空格

DSO运行得到的result.txt有空格(每行有8个元素,结尾没有空格, 时间以秒为单位),运行下面的命令:

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转换为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

程序功能:处理时间戳和互换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个数据是:timestamp tx ty tz qw qx qy qz
            row = row[0:8]
            # 时间戳单位处理
            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()
最后编辑于
©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 216,142评论 6 498
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 92,298评论 3 392
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 162,068评论 0 351
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 58,081评论 1 291
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 67,099评论 6 388
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 51,071评论 1 295
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 39,990评论 3 417
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 38,832评论 0 273
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 45,274评论 1 310
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 37,488评论 2 331
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 39,649评论 1 347
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 35,378评论 5 343
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 40,979评论 3 325
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 31,625评论 0 21
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 32,796评论 1 268
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 47,643评论 2 368
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 44,545评论 2 352