轨迹误差评估完整流程总结(使用 evo 工具)

roslaunch .launch

rosbag play your_dataset.bag -r 2.0

✅ 第二步:录制估计轨迹

复制代码

bash

复制编辑

bash 复制代码
rosbag record -O traj_only.bag /aft_mapped_to_init 

运行一段时间后 Ctrl+C 停止,生成 traj_only.bag

第三步:提取估计轨迹和真值轨迹为 CSV

复制代码

bash

复制编辑

rostopic echo -b traj_only.bag -p /aft_mapped_to_init > traj.txt rostopic echo -b your_dataset.bag -p /leica/pose/relative > gt_raw.txt

✅ 第四步:转换为 TUM 格式(8列,空格分隔)

python3 convert_traj_raw_to_tum.py traj.txt traj_tum.txt

python3 convert_gt_raw_to_tum.py gt_raw.txt gt_tum.txt

✅ 第五步:对齐估计轨迹的时间戳(手动)

head -n 1 gt_tum.txt

head -n 1 traj_tum.txt

offset = 1746711524.090586901 - 1609059060.110306978 ≈ 137652463.98028

python3 align_traj_time.py traj_tum.txt traj_tum_aligned.txt 137652463.98028

第六步:使用 evo 评估误差(最终步骤)

复制代码

bash

复制编辑

python3 -m evo.main_ape tum gt_tum.txt traj_tum_aligned.txt --align --plot

相关推荐
Reggie_L16 小时前
Eureka-服务注册,服务发现
云原生·eureka·服务发现
水瓶_bxt18 小时前
创建 GitLab Runner 使用CICD自动化部署容器
eureka·自动化·gitlab
贺贺丿1 天前
Docker4-容器化企业级应用
linux·nginx·docker·云原生·eureka·tomcat·ssh
cherishSpring3 天前
Eureka+LoadBalancer实现服务注册与发现
云原生·eureka
ZwZ121234 天前
渗透部分总结
云原生·eureka
cherishSpring4 天前
Eureka+Ribbon实现服务注册与发现
云原生·eureka·ribbon
企鹅侠客4 天前
Docker 中有哪些不同类型的挂载?
docker·容器·eureka
wydxry5 天前
同步本地文件到服务器上的Docker容器
服务器·docker·eureka
烟雨书信5 天前
Docker中的Compose, 私库 registry,使用私库 Harbor
docker·容器·eureka
老马啸西风6 天前
windows docker-02-docker 最常用的命令汇总
linux·运维·ubuntu·docker·容器·eureka·maven