Cartographer_ROS中水平扫描数据丢失问题的分析与解决

问题背景

在使用Cartographer_ROS进行2D SLAM时，用户遇到了两个主要问题：一是系统持续输出"WARN Dropped empty horizontal range data"警告信息，二是无法在Rviz中接收到地图数据。该问题出现在一个基于Gazebo仿真的机器人系统中，系统配置包括2D激光雷达和里程计信息，但没有IMU数据。

问题分析

通过深入分析，我们发现问题的根源在于传感器配置与Cartographer参数设置的不匹配。具体表现为：

1. TF框架关系问题：系统中有多个TF广播节点，包括world到odom的静态转换和odom到robot_frame的里程计转换。这些转换关系与Cartographer预期的框架结构存在冲突。

2. 激光雷达高度配置问题：激光雷达安装位置与机器人基准框架(robot_frame)不在同一水平面上，导致Cartographer无法正确接收水平扫描数据。这是产生"Dropped empty horizontal range data"警告的主要原因。

3. 跟踪框架设置问题：用户最初将tracking_frame设置为"robot_frame"，但由于激光雷达高度差异，系统无法正确获取扫描数据。

解决方案

1. 正确配置TF框架关系

Cartographer需要清晰的TF框架结构来建立坐标系间的转换关系。最佳实践是：

• 确保world到odom的转换由Cartographer节点管理
• 里程计信息应发布到odom框架
• 机器人基准框架(如base_link或robot_frame)应作为tracking_frame

2. 调整激光雷达高度参数

当激光雷达与tracking_frame不在同一水平面时，必须明确配置高度范围参数：

TRAJECTORY_BUILDER_2D.min_z = 3.0  -- 激光雷达最低高度
TRAJECTORY_BUILDER_2D.max_z = 4.0  -- 激光雷达最高高度

这两个参数应包含激光雷达相对于tracking_frame的实际安装高度范围，确保Cartographer能够正确接收和处理扫描数据。

3. 跟踪框架的选择

虽然可以将tracking_frame直接设置为激光雷达框架(lidar_link)，但这并非最佳实践。更推荐的做法是：

1. 保持tracking_frame为机器人基准框架(如robot_frame或base_link)
2. 通过TF正确建立激光雷达到基准框架的转换关系
3. 配置适当的高度范围参数

配置建议

基于实际经验，我们推荐以下Cartographer配置要点：

1. 基础框架设置：

map_frame = "map"
tracking_frame = "base_link"  -- 或robot_frame
published_frame = "base_link"  -- 或robot_frame
odom_frame = "odom"
provide_odom_frame = true

2. 2D轨迹构建器配置：

TRAJECTORY_BUILDER_2D.use_imu_data = false  -- 无IMU时设为false
TRAJECTORY_BUILDER_2D.min_range = 0.5      -- 最小有效测距
TRAJECTORY_BUILDER_2D.max_range = 40.0     -- 最大有效测距

3. 传感器高度配置：

-- 根据激光雷达实际安装高度设置
TRAJECTORY_BUILDER_2D.min_z = [激光雷达最低高度]
TRAJECTORY_BUILDER_2D.max_z = [激光雷达最高高度]

验证与调试

在配置完成后，建议通过以下步骤验证系统：

1. 使用rviz检查TF框架结构是否正确
2. 确认激光雷达扫描数据在rviz中可见
3. 检查Cartographer节点是否输出正常的处理信息
4. 观察地图是否能够正确构建和更新

总结

Cartographer_ROS是一个强大的SLAM工具，但正确的配置对于其性能发挥至关重要。特别是在处理非标准传感器安装时，必须注意高度参数的配置。通过合理设置TF框架关系和传感器参数，可以解决大多数扫描数据丢失和地图构建问题。本文提供的解决方案已在Gazebo仿真环境中验证有效，可供类似应用场景参考。