上集

将rosbag的数据feed给lego-loam,输出地图。另外写了一个滤波节点,订阅地图,进行滤波操作,再发布出来。

由于输入给lego-loam的数据来自于rosbag,所以需要rosbag提供时间信息。

rosbag play --clock recorded1.bag

由于rosbag的数据发布频率比较快,导致了一个结果。rosbag播放完毕,时钟停止,滤波节点中缓存了几个数据还没有处理完毕。失去了时钟信息,滤波节点停止运行,但是没有输出报错信息!!!

个人心得:滤波节点有两个独立的线程,一个是callback函数线程,一个是main函数线程,进而导致print出来的信息排布混乱。没有花时间整理print出来的信息,也就没能及时发现main函数线程因为缺失了时间信息而停止运行。因此,但凡遇到莫名其妙的bug,即使没有报错信息,首要任务是结合print出来的信息整理代码的逻辑,快速缩小范围再逐步排查原因。

解决方案

1. 最佳

-k, --keep-alive

rosbag play -k  --clock recorded1.bag

bag文件中的数据播放完毕以后,继续提供时间信息。

 

2. 次佳

-r FACTOR--rate=FACTOR

rosbag play -r 0.1 --clock recorded1.bag

将发布频率降低为原来的10%,留给滤波节点足够的时间进行处理。

下集

首先启动 roscore ,这一步会启动ros的时钟,提供时钟信息。

接着启动lego-loam。

播放lego-loam的数据集, rosbag play --clock recorded1.bag 。这时候,启动了另一个时钟,导致roscore启动的时钟停止。所以,当rosbag播放完毕后,ros的时钟完全停止。这时候运行ros会报各种莫名其妙的错误

 

解决方案

重新运行 roscore !