机器人 / 系统课时

在 RViz 2 中检查激光扫描与轨迹

在 RViz 2 中检查激光扫描与轨迹

这次把二维激光扫描、TF 坐标关系和机器人运动轨迹放到同一视图中,先排除话题、坐标系与时间戳错误,再判断扫描是否能随机器人运动正确叠合。完成后可保存一份用于后续 SLAM 调试的 RViz 2 配置。

学习目标

  • 找到激光、里程计和 TF 话题,正确选择 Fixed Frame。
  • 在 RViz 2 中显示 LaserScan、TF 和运动轨迹,并识别 Path 的数据前提。
  • 用短距离移动测试定位显示异常的原因。

确认话题和运行环境

以下操作以 Ubuntu 24.04、ROS 2 Jazzy 为例,适用于已启动激光驱动、里程计与 TF 的机器人或仿真;也可以使用正在回放相关话题的 rosbag。其他 ROS 2 发行版应换用本机对应的环境脚本。

打开终端,检查常见的 /scan 话题是否为激光扫描消息:

bash
# 加载 Jazzy 环境,确认扫描消息类型
source /opt/ros/jazzy/setup.bash
ros2 topic type /scan

预期输出(存在标准 /scan 话题时):

text
sensor_msgs/msg/LaserScan

再执行:

bash
# 列出实际话题和消息类型,不要假定所有机器人都使用相同名称
ros2 topic list -t

预期结果:找到类型为 sensor_msgs/msg/LaserScan 的雷达话题;若要显示里程计轨迹,还应有 nav_msgs/msg/Odometry 话题(常用名为 /odom)。/tf 和 /tf_static 承载坐标变换,/map 则只在地图发布后出现。实际名称带命名空间时,后续应使用列表中的完整名称。

读取一帧扫描头,记下真实的激光坐标系名称:

bash
# 只取消息头,避免输出成百上千个距离值
ros2 topic echo /scan --once --field header

预期结果:输出 stamp 和 frame_id;时间戳是动态值,frame_id 可能是 laser、laser_frame 或驱动自定义名称,后面的 TF 检查必须使用实际名称。

配置固定坐标与显示图层

启动 RViz 2:

bash
# 在已有机器人数据持续发布的情况下打开可视化器
ros2 run rviz2 rviz2

预期结果:出现 RViz 2 窗口;如果面板显示 No tf data 或 Fixed Frame does not exist,先不要把它当成激光硬件故障。

依次配置左侧 Displays 面板:

  1. 在 Global Options → Fixed Frame 选择 odom,用于先检查局部运动;若 SLAM 已发布 map 且存在 map 到 odom 的 TF,则改选 map。不要用会随车运动的 base_link 来判断历史轨迹是否稳定。
  2. 点击 Add → By display type → LaserScan,在 Topic 选实际雷达话题(例如 /scan)。推荐 Style = Points、Size (m) = 0.03、Decay Time = 0,先只看最新扫描;要对比相邻扫描时可临时设为 1 秒。
  3. 添加 TF 图层,开启坐标轴显示,检查 odom → base_link → laser_frame 这类链路;laser_frame 只是示例,真实名称应以消息的 header.frame_id 为准。
  4. 添加 Odometry 图层,选择类型为 nav_msgs/msg/Odometry 的话题(例如 /odom)。该图层会积累位姿箭头,用于观察运动方向与轨迹形状。
  5. 如果系统实际发布 nav_msgs/msg/Path(如 /trajectory),再添加 Path 并选择该话题;不能把 /odom 直接填给 Path。有 /map 时也可添加 Map 图层辅助对照。

在 Views 面板把视角控制器设为 TopDownOrtho,便于在 XY 平面观察。扫描在机器人附近,位姿箭头沿行驶方向延伸;若 Fixed Frame = map,必须确保 map → odom → base_link → 雷达帧 的变换在相应时间戳可用。

RViz 2 扫描、位姿轨迹与固定坐标系检查界面

用短距离移动核对显示

按下列顺序完成一次低速、安全的短程验证,实机应在无障碍环境操作:

  1. 静止约 5 秒:观察扫描轮廓是否稳定,墙面或固定障碍物是否形成连续点列。
  2. 直行约 1 米:在 odom 或 map 固定坐标下,机器人位置和 Odometry 箭头应改变;固定墙面对应的激光点应大体对齐。
  3. 原地缓慢旋转约 90°:扫描扇区随车体一起旋转,但世界坐标下固定障碍物的位置应基本保持;若整片环境跟着车体绕圈,先核查 Fixed Frame。
  4. 在 File → Save Config As... 保存为 scan-check.rviz。该文件只保存 RViz 显示配置,不会保存传感器数据或 SLAM 地图。

按异常现象定位问题

现象 优先检查和处理
/scan 存在但没有点 确认 LaserScan → Topic 选对;用 ros2 topic hz /scan 检查是否持续发布;再核对其 Reliability Policy 与发布端 QoS,常见雷达使用 Best Effort。
提示 No transform 检查 Fixed Frame 和雷达的 header.frame_id;确认从雷达到 odom 或 map 的 TF 链存在,而非随意伪造静态变换。
点云出现拖影、跳动或时间错误 先把 Decay Time 调回 0;检查激光消息时间戳、TF 更新时间以及仿真或 rosbag 回放时的 use_sim_time 一致性。
能看到扫描,却没有移动轨迹 确认 /odom 的消息类型、发布状态和机器人是否真的在运动;Path 还需要单独的 nav_msgs/msg/Path 数据源。

出现 TF 问题时,可在另一个终端检查机器人底盘与雷达之间的变换:

bash
# 把 laser_frame 换成当前扫描消息实际使用的坐标系名称
ros2 run tf2_ros tf2_echo base_link laser_frame

预期结果:命令持续打印 Translation 和 Rotation,固定安装的雷达相对车体的变换应基本不变,按 Ctrl+C 退出。若一直报告坐标系不存在或无法连通,应先修复 TF 发布或帧名;若只有回放时失效,进一步检查 /clock 与各节点的仿真时间设置。

最终应能在固定坐标中同时观察到稳定的障碍物扫描和随运动变化的位姿箭头,再开始判断 SLAM 建图结果是否可靠。

按自己的节奏,确认真正理解。

目录与阅读设置

阅读设置

17

记录一个想法

在 RViz 2 中检查激光扫描与轨迹

0 / 10000 · 笔记保存到账号。未提交的修改会在关闭、离开或刷新后丢失。

登录哪都通