3、传感器仿真：激光雷达(LiDAR)模型配置、IMU模型配置、相机模型配置
传感器，说白了就是机器人的眼睛和耳朵。没有它们，机器人就是个瞎子。
在Gazebo里做仿真，最核心的一步就是把传感器模型配好。我见过太多新手，URDF写得飞起，结果一跑仿真，激光雷达扫出来全是黑洞，IMU数据飘得像过山车。嗯，今天咱们就把这三个关键传感器——激光雷达、IMU、相机——的配置方法彻底讲透。
核心要点：传感器仿真不是简单地把真实参数填进去就完事。你需要理解Gazebo的插件机制，以及每个参数背后的物理含义。
3.1 激光雷达(LiDAR)模型配置
激光雷达，我习惯叫它LiDAR。在ROS里，最常用的LiDAR插件是 libgazebo_ros_laser.so。你想想看，真实世界里的激光雷达有扫描角度、分辨率、最大距离这些参数，仿真里一个都不能少。
我个人习惯把LiDAR的配置拆成两部分：物理属性和ROS接口。物理属性决定它能不能扫到东西，ROS接口决定它怎么把数据发出来。
先看一个我常用的配置模板：
<gazebo reference="laser_link">
<sensor type="ray" name="head_laser">
<pose>0 0 0 0 0 0</pose>
<visualize>true</visualize>
<update_rate>10</update_rate>
<ray>
<scan>
<horizontal>
<samples>360</samples>
<resolution>1</resolution>
<min_angle>-3.14159</min_angle>
<max_angle>3.14159</max_angle>
</horizontal>
</scan>
<range>
<min>0.10</min>
<max>30.0</max>
<resolution>0.01</resolution>
</range>
<noise>
<type>gaussian</type>
<mean>0.0</mean>
<stddev>0.01</stddev>
</noise>
</ray>
<plugin name="laser_controller" filename="libgazebo_ros_laser.so">
<topicName>/scan</topicName>
<frameName>laser_link</frameName>
</plugin>
</sensor>
</gazebo>这里有几个坑，我一个个说。
第一，扫描角度。我见过有人把 min_angle 和 max_angle 设成 -1.57 和 1.57，结果机器人只能看到前面180度。如果你想要360度全覆盖，就得设成 -3.14159 和 3.14159。注意，单位是弧度，不是度。
第二，采样点数。samples 设成360，意味着每度一个点。设成720就是每0.5度一个点。采样点越多，数据越密，但计算量也越大。我在项目里一般用360，够用又不卡。
第三，噪声模型。真实LiDAR是有噪声的。我曾经在仿真里把噪声设成0，结果算法在仿真里跑得飞起，一上真机就崩。后来我学乖了，至少加个高斯噪声，标准差0.01到0.02之间，模拟真实传感器的抖动。
小技巧：调试LiDAR时，把 <visualize>true</visualize> 打开。这样在Gazebo里能看到激光射线，方便你判断扫描范围对不对。
3.2 IMU模型配置
IMU，惯性测量单元。它提供加速度和角速度数据。在Gazebo里，IMU的配置比LiDAR简单，但坑更多。
为什么？因为IMU数据太容易飘了。真实IMU有零偏、有噪声、有温度漂移。如果你在仿真里给一个完美的IMU，那你的里程计融合算法永远调不好。
来看配置：
<gazebo reference="imu_link">
<sensor type="imu" name="imu_sensor">
<pose>0 0 0 0 0 0</pose>
<update_rate>100</update_rate>
<imu>
<noise>
<type>gaussian</type>
<rate>
<mean>0.0</mean>
<stddev>0.0002</stddev>
<bias_mean>0.00001</bias_mean>
<bias_stddev>0.00002</bias_stddev>
</rate>
<accel>
<mean>0.0</mean>
<stddev>0.017</stddev>
<bias_mean>0.001</bias_mean>
<bias_stddev>0.001</bias_stddev>
</accel>
</noise>
</imu>
<plugin name="imu_controller" filename="libgazebo_ros_imu.so">
<topicName>/imu/data</topicName>
<frameName>imu_link</frameName>
</plugin>
</sensor>
</gazebo>注意看噪声配置。我把它分成两部分：角速度噪声和加速度噪声。每个部分都有 stddev（随机噪声）和 bias_stddev（零偏漂移）。
我曾经在项目里犯过一个低级错误：把IMU的 update_rate 设成10Hz。结果机器人稍微一动，数据就严重滞后，定位直接崩了。IMU的更新率至少要100Hz，这是底线。
警告：IMU的零偏参数不要设太大。我见过有人把 bias_mean 设成0.1，结果积分出来的角度每秒漂移几十度，根本没法用。建议从0.0001级别开始调。
3.3 相机模型配置
相机仿真，说白了就是模拟一个摄像头在Gazebo里拍画面。它比LiDAR和IMU都直观，但参数更多。
我常用的相机配置：
<gazebo reference="camera_link">
<sensor type="camera" name="camera_sensor">
<pose>0 0 0 0 0 0</pose>
<update_rate>30</update_rate>
<camera>
<horizontal_fov>1.047</horizontal_fov>
<image>
<width>640</width>
<height>480</height>
<format>R8G8B8</format>
</image>
<clip>
<near>0.1</near>
<far>100</far>
</clip>
<noise>
<type>gaussian</type>
<mean>0.0</mean>
<stddev>0.005</stddev>
</noise>
</camera>
<plugin name="camera_controller" filename="libgazebo_ros_camera.so">
<topicName>/camera/image_raw</topicName>
<frameName>camera_link</frameName>
</plugin>
</sensor>
</gazebo>这里有几个关键参数：
- horizontal_fov：水平视场角。1.047弧度约等于60度。如果你想要广角效果，可以设到1.57（90度）甚至更大。
- 图像分辨率：640x480是标准VGA。我建议从640x480开始，跑通了再调高。分辨率越高，仿真越慢。
- 裁剪平面：
near和far决定了相机能看到的最远和最近距离。near设太小会导致深度图出现奇怪的闪烁，我一般设0.1。
嗯，这里要注意：相机噪声和LiDAR噪声不一样。相机噪声主要影响像素值，而不是位置。如果你做视觉SLAM，建议把噪声加上，否则你的特征点提取算法在仿真里完美无缺，一上真机就找不到特征点了。
调试建议：用 rqt_image_view 查看相机话题。如果画面全黑，检查一下场景里有没有光源。Gazebo默认场景是有光的，但如果你自己建了世界文件，别忘了加 <light> 标签。
3.4 传感器配置的核心逻辑
说了这么多，其实传感器配置的核心逻辑就一句话：用插件把Gazebo的传感器数据转成ROS话题。
我画了一张图，帮你理清思路：
从图里可以看得很清楚：URDF定义传感器的物理位置和外观，Gazebo标签定义传感器的类型和参数，插件负责把数据发到ROS话题。这三层缺一不可。
3.5 避坑指南
最后，我把自己踩过的坑总结一下：
- 坐标系对齐：传感器的
frameName必须和URDF里的link名称一致。我见过有人写成laser但URDF里是laser_link，结果数据发出来了但坐标系对不上。 - 更新率匹配：LiDAR的更新率一般10-20Hz，IMU要100Hz以上，相机30Hz就够了。别把IMU设成10Hz，也别把相机设成100Hz——后者会让你的CPU爆炸。
- 噪声参数：从零开始加噪声。先不加噪声跑通，再加小噪声验证算法鲁棒性，最后调到接近真实传感器的水平。
一句话总结：传感器仿真配置 = URDF定位 + Gazebo参数 + 插件映射。三个环节都对了，你的机器人才能「看得见、感觉得到、拍得清楚」。
好了，传感器配置就讲到这里。记住，仿真只是第一步，最终还是要回到真机上验证。但如果你连仿真都配不好，真机就更别想了。
个人经验：我每次配新传感器，都会先在Gazebo里用 rostopic echo 看一眼数据格式对不对。这个习惯帮我省了至少一半的调试时间。
可可精品资料库