Livox_mapping 中tf的timestamp不更新/错误更新

最新推荐文章于 2024-06-28 11:02:42 发布

Wh8850

最新推荐文章于 2024-06-28 11:02:42 发布

阅读量465

点赞数 2

分类专栏： SLAM Linux 文章标签： ubuntu 机器人

本文链接：https://blog.csdn.net/Wh8850/article/details/132620569

版权

SLAM 同时被 2 个专栏收录

5 篇文章 0 订阅

订阅专栏

Linux

5 篇文章 0 订阅

订阅专栏

文章讲述了作者在使用Livox_mapping进行路径规划时遇到的odom与maptf无法更新的问题，原因是Livox_mapping中时间戳发布错误导致。通过将关键时间变量从float改为double类型，解决了这个问题，最终导航显示恢复正常。

摘要由CSDN通过智能技术生成

项目场景：

笔者在使用Livox_mapping的点云地图做路径规划时，启动move_base发现odom(camera_init) 与map之间的tf无法正常更新，但tf_tree却显示两者之间正常连接。

问题描述

1. move_base报错，找不到 transform from frame [aft_mapped] to frame [map]

Extrapolation Error looking up robot pose: Lookup would require extrapolation 2.254647634s into the past. Requested time 1693479424.000000000 but the earliest data is at time 1693479426.254647732, when looking up transform from frame [aft_mapped] to frame [map]

发现是aft_mapped和map没有即使更新，往前查Livox_mapping的原因。

2. Livox_mapping warning : 时间戳重复

TF_REPEATED_DATA ignoring data with redundant timestamp for frame aft_mapped at time 1693537024.000000 according to authority unknown_publisher

原因分析：

根本原因是Livox_mapping中发布tf [aft_mapped] to frame [camera_init] 时时间戳更新错误，一直打的同一个时间戳。

在代码中每个timestamp调试后发现：

laserCloudCornerLast2 在赋值时前后出现了错误。

laserCloudCornerLast2 定义为float，在赋值出现了精度损失

解决方案：

// float timeLaserCloudCornerLast = 0;
// float timeLaserCloudSurfLast = 0;
// float timeLaserCloudFullRes = 0;
double timeLaserCloudCornerLast = 0;
double timeLaserCloudSurfLast = 0;
double timeLaserCloudFullRes = 0;

把float换成double