目录
【场景】仿真小车在Gazebo上进行Gmapping
步骤:
运行roslaunch spark1_description spark_gmapping_slam_gazebo_rviz.launch
问题:
[ WARN] [1642146649.678388245, 0.303000000]: TF_REPEATED_DATA ignoring data with redundant timestamp for frame odom at time 0.353000 according to authority unknown_publisher
[spark_slam_gmapping-4] process has died [pid 27710, exit code -11, cmd /home/nx_ros/spark-slam-gazebo/devel/lib/gmapping/slam_gmapping __name:=spark_slam_gmapping __log:=/home/nx_ros/.ros/log/af99f9d2-750e-11ec-b97d-7f03d0e3bbcd/spark_slam_gmapping-4.log].
可见gmapping已死掉,在rviz上查看
rviz上显示no map received,应该是gmapping死掉的原因
使用rqt_tf_tree查看
rosrun rqt_tf_tree rqt_tf_tree
截取关键部分,同样看不见map的tf转换关系。
spark_gmapping_slam_gazebo_rviz.launch文件内容如下:
其中模型文件关键部分如下:
true
50
left_wheel_joint
right_wheel_joint
0.281
0.068
0.1
na
true
odom
odom
false
5
1
1
cmd_vel
base_footprint
false
true
【填坑过程】
以下,将作为填坑所做功夫,同时也为让思路更加清晰,文笔更加严谨。若填坑成功,会将成功方法置顶,相反,若无成功方法,即是仍在为此努力中。
【知识储备】
gmapping对硬件要求:
1.移动机器人可发布里程计信息,即topic—/odom
2.移动机器人可发布雷达信息,即topic—/scan
gmapping订阅的话题:
1.tf (tf/tfMessage)—用于雷达、底盘与里程计之间的坐标变换消息。
2.scan(sensor_msgs/LaserScan)—SLAM所需的雷达信息。
从上可以清晰知道gmapping获取此类信息的原因和用途。
关于gmapping的坐标转换(TF transform)
1.所需的的坐标转换
a)雷达坐标系→基坐标系:一般由 robot_state_publisher 或 static_transform_publisher 发布。
b)基坐标系→里程计坐标系(base_footprint→odom):一般由里程计节点发布。
2.发布的坐标转换
地图坐标系→里程计坐标系(map→odom):地图到里程计坐标系之间的变换。
关于gmapping更多信息可查看http://wiki.ros.org/gmapping
【解决办法】
首先保证启动仿真环境时,TF转换是正确的,而且gmapping获取的雷达话题也是正确的
URDF文件修改如下:
启动后用rqt_tf_tree查看
确保odom–>base_link,base–>virtual_lidar_link(发布/scan的关节)能够正确连接
用rostopic echo /scan,查看scan是否有数据.
问题综述,启动仿真环境和小车没有问题,一启动gmapping就挂掉,而且在报错信息上看不到有用信息,查看spark_gmapping.launch
一开始文件中关于启动gmapping节点如下
output为log,也就不输出到终端,看不到相关信息
更改为输出到screen
如此,相关信息就会显示在终端上,再次按上述步骤启动
[ INFO] [1644392639.562246850, 6.522000000]: Laser is mounted upwards.
[spark_slam_gmapping-1] process has died [pid 28900, exit code -11, cmd /opt/ros/noetic/lib/gmapping/slam_gmapping scan:=/scan __name:=spark_slam_gmapping __log:=/home/nx_ros/.ros/log/03c0d4a0-897c-11ec-9bcf-e96662a23c5b/spark_slam_gmapping-1.log].
log file: /home/nx_ros/.ros/log/03c0d4a0-897c-11ec-9bcf-e96662a23c5b/spark_slam_gmapping-1*.log
出现Laser is mounted upwards.的信息,根据博客Gmapping报错 :[mapping-4] process has died 的可能解决原因与解决方法_wongHome的博客-CSDN博客
Gmapping 只适用于 单帧二维激光点数小于1440的点,如果单帧激光点数大于1440,那么就会出现
[mapping-4] process has died
这样的问题。
所以把单帧二维激光点数配置为1440,就可以正常进行建图了。
将URDF文件中的virtual_lidar_link部分的samples修改成1200
保存后,重新启动,建图效果如下
出现有漂移的现象,影响不大
【修改尝试-0】
下面为踩坑记录,只当作记录,不需要继续看下去。
下面为踩坑记录,只当作记录,不需要继续看下去。
下面为踩坑记录,只当作记录,不需要继续看下去。
对于出错的[spark_slam_gmapping-4] ,由于从提示的信息看不出来是什么问题,先从warn部分看起
[ WARN] [1642146649.678388245, 0.303000000]: TF_REPEATED_DATA ignoring data with redundant timestamp for frame odom at time 0.353000 according to authority unknown_publisher
从字面猜测,可能是由于多个发布者重复发布/odom,再次启动launch文件
roslaunch spark1_description spark_gmapping_slam_gazebo_rviz.launch
另开终端,使用rostopic info 查看
rostopic info /odom
结果如下:
【结论-0】odom由一个发布者发布
【修改尝试-1】
【修改部分】从中可以看出是由gazebo发出,推测是模型URDF中决定,修改URDF文件odom部分
true
odom1
odom1
修改gmapping上订阅的odom名称,再次启动launch文件,修改rviz上的Fixed Frame,并由rostopic info 查看
同理由rqt_tf_tree查看,也同样获得和之前一样的结果,gmapping仍然死掉,区别仅仅在odom的名称上。
【结论-1】odom信息由模型中的URDF决定
【修改尝试-2】
【修改部分】当将 odom名称设回原来值,并将URDF文件中的设为false后
false
再次启动,gmapping没有死掉,rviz中修改Fixed Frame,在gazebo中添加障碍物
仍出现no map received现象
报错信息为
[ WARN] [1642153099.373592268, 0.226000000]: TF_REPEATED_DATA ignoring data with redundant timestamp for frame odom at time 0.276000 according to authority unknown_publisher
[ WARN] [1642153121.976280751, 15.176000000]: MessageFilter [target=odom ]: Dropped 100.00% of messages so far. Please turn the [ros.gmapping.message_filter] rosconsole logger to DEBUG for more information.
使用rqt_tf_tree查看
可以看到odom与base_footprint的连接已断掉,但map已与odom相连,原因是因为URDF文件中将
【修改尝试-3】
【修改部分】目前缺少了odom到base_footprint的TF转换,尝试在launch文件中添加相应的tf关系转换
在spark_gmapping_slam_gazebo_rviz.launch文件中添加以下信息
其中所选范围即为新添加部分,运行查看效果
报错消息:
[ WARN] [1642212245.857175022, 0.226000000]: TF_REPEATED_DATA ignoring data with redundant timestamp for frame odom at time 0.276000 according to authority unknown_publisher
[spark_slam_gmapping-9] process has died [pid 13769, exit code -11, cmd /home/nx_ros/spark-slam-gazebo/devel/lib/gmapping/slam_gmapping __name:=spark_slam_gmapping __log:=/home/nx_ros/.ros/log/68a5e4e8-75a7-11ec-9515-adb2ca252e1d/spark_slam_gmapping-9.log].
用rqt_tf_tree查看
【踩坑分析-2】从成功例子入手
参照古月老师的slam教学例子(gmapping_slam)
启动成功后,用rqt_tf_tree查看
再去观察模型的URDF文件
分析得知,古月老师的这份URDF文件,是将publishWheelTF,publishWheelJointState,设为true的,同时,publishOdomTF默认值也应为true
【修改尝试-4】
【修改部分】将我的机器人模型URDF中的publishWheelTF,publishWheelJointState和publishOdomTF设为true
再次运行,出现以下错误
[ WARN] [1642386626.865860385, 0.895000000]: TF_REPEATED_DATA ignoring data with redundant timestamp for frame left_wheel_link at time 0.893000 according to authority unknown_publisher
[ WARN] [1642386626.865975309, 0.895000000]: TF_REPEATED_DATA ignoring data with redundant timestamp for frame right_wheel_link at time 0.893000 according to authority unknown_publisher
[spark_slam_gmapping-8] process has died [pid 6168, exit code -11, cmd /home/nx_ros/spark-slam-gazebo/devel/lib/gmapping/slam_gmapping __name:=spark_slam_gmapping __log:=/home/nx_ros/.ros/log/6ba24ef6-773d-11ec-ba9f-c313f8c7be2f/spark_slam_gmapping-8.log].
log file: /home/nx_ros/.ros/log/6ba24ef6-773d-11ec-ba9f-c313f8c7be2f/spark_slam_gmapping-8*.log
[ WARN] [1642386626.920107925, 0.934000000]: TF_REPEATED_DATA ignoring data with redundant timestamp for frame left_wheel_link at time 0.933000 according to authority unknown_publisher
[ WARN] [1642386626.920155923, 0.934000000]: TF_REPEATED_DATA ignoring data with redundant timestamp for frame right_wheel_link at time 0.933000 according to authority unknown_publisher
运行rqt_tf_tree查看
left_wheel_link和right_wheel_link会连接到base_footprint上
查看URDF文件中关于 left_wheel_link和right_wheel_link的部分
文件中父关节应为base_link
Original: https://blog.csdn.net/weixin_44362628/article/details/122496140
Author: Howe_xixi
Title: 【踩坑记录】Slam-Gmapping建图失败–已解决
原创文章受到原创版权保护。转载请注明出处:https://www.johngo689.com/619335/
转载文章受原作者版权保护。转载请注明原作者出处!