4、Gazebo仿真入门：世界文件解析、加载无人机模型、传感器仿真

Gazebo，说白了就是飞控开发者的「虚拟试飞场」。

我刚开始做飞控那会儿，每次改个参数都要跑到操场上去试飞。摔机是家常便饭，有一次直接把桨叶打到了自己腿上……嗯，从那以后我就老老实实搭起了Gazebo仿真环境。今天咱们就聊聊怎么用好这个工具。

4.1 Gazebo世界文件解析

世界文件（.world）是Gazebo仿真的「舞台布景」。它定义了地面、光照、重力、物理参数等基础环境。

我个人习惯把世界文件拆成三块来看：

• 物理引擎配置：设置重力、摩擦系数、最大步长
• 环境光照：太阳位置、阴影、环境光颜色
• 静态模型：地面、建筑物、障碍物等

来看一个最简世界文件长什么样：

<?xml version="1.0"?>
<sdf version="1.6">
  <world name="default">
    <physics type="ode">
      <gravity>0 0 -9.81</gravity>
      <max_step_size>0.001</max_step_size>
    </physics>
    
    <include>
      <uri>model://sun</uri>
    </include>
    
    <include>
      <uri>model://ground_plane</uri>
    </include>
  </world>
</sdf>

这里有个坑——max_step_size。我曾经设成0.01想跑快点，结果无人机直接穿模到地底下去了。仿真步长太大，物理碰撞检测会失效。建议保持0.001，别贪快。

4.2 加载无人机模型

Gazebo里的无人机模型，本质上是一个SDF（Simulation Description Format）文件。它描述了：

• 机身连杆（link）的几何形状和惯性参数
• 关节（joint）的连接方式和运动范围
• 传感器插件（plugin）的配置

我常用的加载方式有两种：

方式一：直接包含模型

<include>
  <uri>model://my_quadrotor</uri>
  <pose>0 0 0.5 0 0 0</pose>
</include>

方式二：通过ROS launch文件加载

<launch>
  <arg name="model" default="$(find my_pkg)/models/quadrotor.sdf"/>
  <node name="spawn_model" pkg="gazebo_ros" type="spawn_model" 
        args="-file $(arg model) -sdf -model quadrotor -x 0 -y 0 -z 0.5"/>
</launch>

你想想看，如果每次改模型都要重启整个Gazebo，那得多浪费时间？所以我推荐用launch文件的方式，配合spawn_model节点，可以动态加载和删除模型。

4.3 传感器仿真

传感器仿真，是Gazebo最值钱的功能。没有传感器数据，飞控就是个瞎子。

4.3.1 IMU仿真

IMU（惯性测量单元）提供加速度和角速度。Gazebo的IMU插件会基于物理引擎的真实运动数据，加上噪声模型来模拟。

<plugin name="imu_plugin" filename="libgazebo_ros_imu.so">
  <robotNamespace>/quadrotor</robotNamespace>
  <topicName>imu/data_raw</topicName>
  <frameName>imu_link</frameName>
  <updateRate>200.0</updateRate>
  <noise>
    <type>gaussian</type>
    <mean>0.0</mean>
    <stddev>0.001</stddev>
  </noise>
</plugin>

这里updateRate设成200Hz，对应真实IMU的输出频率。噪声参数我建议先设小一点，等算法调通了再加大——不然你都不知道是算法问题还是传感器问题。

4.3.2 GPS仿真

GPS仿真相对简单，就是根据模型当前位置，加上经纬度偏移和噪声。

<plugin name="gps_plugin" filename="libgazebo_ros_gps.so">
  <robotNamespace>/quadrotor</robotNamespace>
  <topicName>gps/fix</topicName>
  <referenceLatitude>39.9042</referenceLatitude>
  <referenceLongitude>116.4074</referenceLongitude>
  <referenceAltitude>43.0</referenceAltitude>
  <updateRate>10.0</updateRate>
  <noise>
    <type>gaussian</type>
    <mean>0.0</mean>
    <stddev>0.5</stddev>
  </noise>
</plugin>

我曾经犯过一个低级错误——忘了设置参考经纬度，结果GPS输出的位置直接飘到太平洋中间去了。嗯，调试了整整一下午才发现。

4.3.3 相机仿真

相机仿真稍微复杂一点，需要配置图像分辨率、帧率、畸变参数等。

<plugin name="camera_plugin" filename="libgazebo_ros_camera.so">
  <robotNamespace>/quadrotor</robotNamespace>
  <topicName>camera/image_raw</topicName>
  <frameName>camera_link</frameName>
  <imageWidth>640</imageWidth>
  <imageHeight>480</imageHeight>
  <hackBaseline>0.07</hackBaseline>
  <distortionK1>0.0</distortionK1>
  <distortionK2>0.0</distortionK2>
  <distortionK3>0.0</distortionK3>
  <distortionT1>0.0</distortionT1>
  <distortionT2>0.0</distortionT2>
</plugin>

分辨率别设太高，640x480足够了。我见过有人设成1920x1080，结果仿真直接卡成PPT——因为图像传输和渲染太吃资源了。

4.4 知识体系总览

下面这张图，是我自己总结的Gazebo仿真知识结构，帮你理清思路：

4.5 实战建议

最后，分享几个我踩过的坑：

1. 模型加载失败：检查SDF文件里的路径是否绝对路径。Gazebo对相对路径的支持不太好。
2. 传感器无数据：确认robotNamespace和话题名称是否匹配。我经常在launch文件里忘了加命名空间。
3. 仿真跑不起来：先跑一个空世界文件测试，排除模型本身的问题。

---

公众号:蓝海资料掘金营，微信deep3321