正文

树莓派或工控机运行ROS让激光雷达数据实时传输到PC显示点云教程

/0 浏览量
0921

嘿，朋友！看到这个问题我就想起了自己刚折腾ROS那会儿的日子——那种看着激光雷达数据在屏幕上跳来跳去，却怎么都连不上的焦灼感，真的记忆犹新。不过别担心，今天咱们就把这个事儿掰开揉碎了讲清楚。不管你是用树莓派4B、树莓派5，还是搞工业用的工控机（比如Intel NUC、研华或者倍福的盒子），只要跑Linux + ROS，这套逻辑都是通用的。

咱们先别急着动手，我得先问问你几个关键信息，这样教程才能对症下药：

第一步：确认你的“硬件阵容”

激光雷达种类太多了，不同的雷达配置方式完全不一样。你得先告诉我：

  1. 你的激光雷达是什么型号？

    • 2D雷达？比如：速腾聚创（RoboSense）LD06/LD19、思必驰、禾赛、LMS系列、RPLIDAR A1/A2/M1、YDLidar等
    • 3D雷达？比如：奥比中光、思岚3D、Livox系列、Velodyne等

  2. 你的通信接口是哪种？

    • 以太网口（RJ45，TCP/IP）
    • USB口
    • 串口（UART）

  3. 雷达的IP地址是多少？或者USB设备节点是/dev/ttyUSB0还是/dev/serial/by-id/xxx？

    • 如果是以太网易位雷达，默认IP通常是 192.168.1.200，但很多国产雷达支持DHCP或者自定义静态IP

  4. 边缘设备（树莓派/工控机）装的是什么系统？ROS版本是Noetic、Melodic还是Humble？

    • 树莓派通常用 Ubuntu 20.04 + ROS Noetic 或 Ubuntu 22.04 + ROS 2 Humble
    • 工控机可能更灵活，可以是 Ubuntu 18.04 + Melodic，也可能是 Ubuntu 20.04 + Noetic

  5. 你的PC（接收端）是什么系统？装的是同一套ROS版本吗？

    • 这点非常重要！ROS 1的Noetic和Melodic不能混用，ROS 2的Humble和Iron也不能混用。如果你边缘端用Noetic，PC端必须也是Noetic，否则话题格式不一样，根本连不上。

第二步：边缘设备端配置（树莓派/工控机）

假设你已经装好了ROS，咱们先给边缘设备搞起来。这里我以最常见的 2D激光雷达 + 以太网接口 为例，因为这是工业场景用得最多的方案。

2.1 安装激光雷达驱动

不同的雷达驱动包不一样，我给你列几个最常见的：

如果是RPLIDAR（思岚科技）：

# 先更新系统
sudo apt update && sudo apt upgrade -y

# 安装RPLIDAR ROS驱动
sudo apt install ros-$ROS_DISTRO-rplidar-ros

# 如果是ROS 2，用这个：
sudo apt install ros-humble-rplidar-ros

如果是Livox雷达（比如Mid-360或Horizon）：

# 克隆Livox官方驱动
cd ~/catkin_ws/src
git clone https://github.com/Livox-SDK/livox_ros_driver.git

# 编译
cd ~/catkin_ws && catkin_make
source devel/setup.bash

如果是禾赛（Hesai）或速腾聚创：

这些厂商通常提供自己的ROS驱动包，建议去官网下载最新的deb包或者源码，因为固件升级频繁，源码更新最快。

2.2 配置网络（以太网口雷达）

这一步是很多人卡住的地方。树莓派和雷达在同一个网段，但IP冲突或者路由不对都会导致连不上。

检查雷达IP： 大多数雷达默认IP是 192.168.1.200，子网掩码 255.255.255.0。你可以用ping测试连通性：

ping 192.168.1.200

如果ping不通，检查树莓派的网卡配置：

# 查看当前IP
ip addr show

# 假设树莓派有线网卡是eth0，设置静态IP让它在同一网段
sudo ip addr add 192.168.1.100/24 dev eth0
sudo ip link set eth0 up

# 再ping一次试试
ping 192.168.1.200

如果是USB雷达，直接插上去就行，用ls /dev/ttyUSB*或者ls /dev/serial/by-id/看看设备节点。

2.3 启动雷达节点

以RPLIDAR为例，启动launch文件：

# ROS 1
roslaunch rplidar_ros rplidar.launch

# 如果是ROS 2
ros2 launch rplidar_ros rplidar.launch.py

启动后，用rostopic echo /scan看看有没有数据：

rostopic echo /scan

如果看到满屏的Float32MultiArray数据在刷，说明雷达工作正常！

第三步：PC端配置与数据接收

现在边缘设备已经在发数据了，关键是PC怎么收。这里分两种主流方案：ROS Master直连 和 DDS/ZeroMQ中转。

方案A：ROS Master直连（最简单，适合局域网环境）

核心思路：把PC变成ROS Master，边缘设备连过来，或者反过来。

步骤：

  1. 确保PC和边缘设备在同一局域网

    • 最好用交换机或者同一台路由器，延迟越低越好
    • 激光雷达数据量大（10-30Hz，每帧几百KB），Wi-Fi 5G以下很容易丢包，强烈建议用网线

  2. 设置ROS_MASTER_URI

在边缘设备的终端里执行：

export ROS_MASTER_URI=http://<PC的IP>:11311
export ROS_IP=<边缘设备的IP>

在PC的终端里执行：

export ROS_MASTER_URI=http://localhost:11311
export ROS_IP=<PC的IP>
  1. 在PC上启动rviz显示点云
# 先装rviz
sudo apt install ros-$ROS_DISTRO-rviz

# 启动rviz
rosrun rviz rviz

在rviz里，左下角Add按钮，添加LaserScan或者PointCloud2，Topic选/scan或/laser/points，点击OK，数据就应该在屏幕上跳起来了！

方案B：使用rosbridge或者ZeroMQ做中转（适合跨网络或需要低延迟）

如果PC和边缘设备不在同一个网段，或者Wi-Fi环境下丢包严重，可以用rosbridge把ROS话题转成WebSocket，PC用浏览器或者Python脚本接收。

边缘设备端启动rosbridge：

# 安装rosbridge
sudo apt install ros-$ROS_DISTRO-rosbridge-suite

# 启动
roslaunch rosbridge_server rosbridge_websocket.launch

PC端用Python接收（以LaserScan为例）：

import websocket
import json
import numpy as np
import matplotlib.pyplot as plt

def on_message(ws, message):
    data = json.loads(message)
    if data.get('op') == 'publish' and data.get('topic') == '/scan':
        scan_data = data['msg']['ranges']
        # 这里可以把scan_data画出来，或者转成点云
        print(f"收到数据，长度: {len(scan_data)}")

ws = websocket.WebSocketApp(
    "ws://<边缘设备IP>:9090/",
    on_message=on_message
)
ws.run_forever()

不过说实话，这个方案对于激光雷达来说有点“杀鸡用牛刀”了，除非你确实需要跨网段传输，否则直接用方案A就行。

第四步：把2D激光数据转成3D点云（可选）

很多小伙伴问：“我不是要看点云吗，怎么还是线？”

其实2D激光雷达扫出来的是扫描线，严格来说是2.5D数据。但如果你非要看“点云”，可以用laser_geometry库把scan转成pointcloud2。

在边缘设备上安装并转换：

# 安装laser_geometry
sudo apt install ros-$ROS_DISTRO-laser-geometry
sudo apt install ros-$ROS_DISTRO-laser-utils

然后写一个简单的node来做转换（或者用现成的launch文件）：

<!-- 在rplidar的launch文件里追加 -->
<node name="scan_toPointCloud" pkg="laser_geometry" type="scan_to_pointcloud" respawn="false" output="screen">
    <remap from="scan" to="scan"/>
    <remap from="cloud" to="cloud"/>
</node>

这样PC端rviz里添加PointCloud2，Topic选/cloud，就能看到3D点云效果了（虽然是扁平的一层）。

如果你用的是3D激光雷达（比如Livox Mid-360），那直接发布的就是sensor_msgs/PointCloud2，不需要转换，rviz里直接加PointCloud2就行。

第五步：常见坑与排错指南

坑1：数据延迟巨大，或者卡顿

原因： 网络带宽不够，或者UDP包丢失。 解决：

  • 换有线网络，关闭树莓派的Wi-Fi（sudo ip link set wlan0 down）
  • 调整雷达的传输协议为UDP（大部分雷达默认就是UDP，确认一下配置）
  • 在PC端加大接收缓冲区： 
    
sudo sysctl -w net.core.rmem_max=16777216
sudo sysctl -w net.core.rmem_default=16777216

坑2：rviz里一片空白，没有数据

排查顺序：

  1. 边缘设备上rostopic list，看看有没有/scan话题
  2. rostopic echo /scan，看有没有数据
  3. PC端rostopic echo /scan，看能不能收到
  4. 如果边缘设备能发，PC收不到，检查ROS_MASTER_URI和ROS_IP
  5. 防火墙问题：sudo ufw disable 临时关闭防火墙测试

坑3：点云颜色奇怪，或者坐标不对

原因： 雷达的坐标系和机器人坐标系不一致。 解决： 在rviz里，设置Fixed Frame为雷达自己的frame_id（比如laser或base_link），不要强行用map或odom。

坑4：树莓派负载过高，数据断断续续

解决：

  • 关闭不必要的服务（蓝牙、Wi-Fi、图形界面）

  • 给树莓派加散热器，开启性能模式：

    sudo raspi-config
# Performance Options -> GPU Clock -> 500MHz
# Performance Options -> CPU Frequency Governor -> performance

  • 如果是树莓派4B，考虑升级散热风扇

  • 降低雷达的采集频率（比如从20Hz降到10Hz）

第六步：工控机场景的特殊考量

如果你用的是工控机（比如Intel NUC、Advantech、BeagleBone等），有几个点要注意：

  1. 实时性要求高：工控机通常用来做实时控制，建议安装preempt-rt内核补丁，或者使用RTOS + ROS Bridge的方案。
  2. 看门狗与稳定性：工控机往往7x24小时运行，建议写一个监控脚本，检测ROS节点是否存活，异常时自动重启： 
    
#!/bin/bash
while true; do
   if ! pgrep -f "rplidar" > /dev/null; then
       echo "RPLIDAR node died, restarting..."
       roslaunch rplidar_ros rplidar.launch &
   fi
   sleep 5
done
  3. 硬件看门狗：如果条件允许，开启工控机的硬件看门狗，防止系统死锁。

总结：一句话概括

边缘设备装雷达驱动 → 配好网络确保互通 → PC设为ROS Master → rviz添加对应话题 → 搞定。

现在，你可以把上面我抛出来的那几个问题（雷达型号、接口、IP、ROS版本）回复给我，我可以给你写一份完全针对你硬件的、可以直接复制粘贴执行的命令清单。毕竟，不同雷达的launch文件参数差得非常多，瞎猜容易踩坑。

你手头上是什么雷达？咱们一步步来，肯定能跑通！💪

-- 展开阅读全文 --