Webots 2025a 与 ROS 2 Jazzy e-puck 机器人集成教程

操作指令：

# 启动仅包含 e-puck 机器人的基础仿真
ros2 launch webots_ros2_epuck robot_launch.py

现象：

• Webots 2025a 自动启动，界面显示 e-puck 机器人在空场景中；
• 终端无红色报错（黄色警告可忽略，多为参数默认值提示）。

步骤 2：验证 ROS 2 节点与话题

新开终端，分步执行以下命令，逐行验证并记录结果：

（1）查看运行的节点

ros2 node list

预期输出（核心节点）：

/epuck/base_controller
/epuck/robot_state_publisher
/webots_ros2_driver
/webots_ros2_epuck_node

研究点：

• /webots_ros2_driver：Webots 与 ROS 2 的核心桥接节点，负责传感器/执行器数据转发；
• /epuck/base_controller：机器人运动控制节点，处理速度指令。

（2）查看核心话题列表

ros2 topic list | grep epuck

预期核心话题：

（3）实时查看传感器数据

# 查看激光雷达数据
ros2 topic echo /epuck/laser_scan --noarr
# 查看里程计数据
ros2 topic echo /epuck/odometry --noarr
# 查看 IMU 数据
ros2 topic echo /epuck/imu --noarr

研究点：

• 激光雷达的 angle_min/angle_max（扫描范围）、range_min/range_max（有效距离）；
• 里程计的 pose（位姿）和 twist（线/角速度）是否与 Webots 中机器人运动同步；
• IMU 数据的噪声水平。

步骤 3：手动控制机器人运动

（1）单次速度指令

# 前进：线速度 0.2m/s，角速度 0rad/s
ros2 topic pub --once /epuck/cmd_vel geometry_msgs/msg/Twist "{linear: {x: 0.2, y: 0.0, z: 0.0}, angular: {x: 0.0, y: 0.0, z: 0.0}}"
# 左转：线速度 0，角速度 1rad/s
ros2 topic pub --once /epuck/cmd_vel geometry_msgs/msg/Twist "{linear: {x: 0.0, y: 0.0, z: 0.0}, angular: {x: 0.0, y: 0.0, z: 1.0}}"
# 停止：所有速度为 0
ros2 topic pub --once /epuck/cmd_vel geometry_msgs/msg/Twist "{linear: {x: 0.0, y: 0.0, z: 0.0}, angular: {x: 0.0, y: 0.0, z: 0.0}}"

现象：Webots 中机器人对应执行前进/左转/停止动作。

（2）持续键盘控制

# 安装键盘控制工具
sudo apt install ros-jazzy-teleop-twist-keyboard
# 启动键盘控制，映射到 e-puck 的 cmd_vel 话题
ros2 run teleop_twist_keyboard teleop_twist_keyboard --ros-args -r cmd_vel:=/epuck/cmd_vel

操作说明：

• w：前进，x：后退，a：左转，d：右转，s：停止；
• z/c：调整线速度，q/e：调整角速度。

第二阶段：Rats Life 场景与地图系统研究

步骤 1：启动带地图的 Rats Life 场景

# 启动包含迷宫地图的完整场景
ros2 launch webots_ros2_epuck rats_life_launch.py

现象：

• Webots 加载 Rats Life 迷宫场景，e-puck 位于场景起点；
• ROS 2 自动加载地图服务器（map_server），发布 /map 话题。

步骤 2：解析地图配置文件

首先找到地图配置文件路径：

# 定位 map_rats_life.yaml 文件
rospack find webots_ros2_epuck
cd $(rospack find webots_ros2_epuck)/share/webots_ros2_epuck/config

打开 map_rats_life.yaml，逐行分析：

image: map_rats_life.pgm
resolution: 0.05
origin: [-10.0, -10.0, 0.0]
negate: 0
occupied_thresh: 0.65
free_thresh: 0.196
frame_id: map

研究操作：

# 查看地图话题数据
ros2 topic echo /map --noarr
# 可视化地图（需启动 RViz2）
rviz2

在 RViz2 中配置：

1. Fixed Frame 选择 map；
2. 添加 Map 组件，Topic 选择 /map；
3. 添加 RobotModel 组件，Robot Description 选择 /robot_description；
4. 添加 LaserScan 组件，Topic 选择 /epuck/laser_scan。

步骤 3：场景自定义修改

1. 添加/删除障碍物：在 Webots 中拖拽 Box 节点，调整尺寸/位置；
2. 修改机器人传感器：选中 e-puck → 双击 LaserEmitter → 调整扫描角度/精度；
3. 调整地面材质/摩擦力：影响机器人运动模型；
4. 保存修改后，重新启动 rats_life_launch.py 验证效果。

第三阶段：ROS 2 Control 底层控制研究

步骤 1：解析 ros2_control.yml 配置

cd $(rospack find webots_ros2_epuck)/share/webots_ros2_epuck/config
cat ros2_control.yml

核心内容解析：

controller_manager:
  ros__parameters:
    update_rate: 100
joint_velocity_controller:
  type: velocity_controllers/JointGroupVelocityController
  ros__parameters:
    joints:
      - left_wheel_joint
      - right_wheel_joint
    interface_name: velocity

研究点：

• update_rate：控制频率越高，运动越平滑，但占用资源越多；
• 关节名称必须与机器人 URDF 中的定义一致。

步骤 2：底层关节控制测试

# 查看关节状态
ros2 topic echo /epuck/joint_states
# 发布关节速度指令（直接控制左右轮）
# 左轮 1rad/s，右轮 1rad/s → 前进
ros2 topic pub /epuck/joint_velocity_controller/commands std_msgs/msg/Float64MultiArray "{data: [1.0, 1.0]}"
# 左轮 -1rad/s，右轮 1rad/s → 原地旋转
ros2 topic pub /epuck/joint_velocity_controller/commands std_msgs/msg/Float64MultiArray "{data: [-1.0, 1.0]}"
# 停止关节运动
ros2 topic pub /epuck/joint_velocity_controller/commands std_msgs/msg/Float64MultiArray "{data: [0.0, 0.0]}"

研究对比：

• 对比 /epuck/cmd_vel（高层运动指令）和 /epuck/joint_velocity_controller/commands（底层关节指令）的控制差异；
• 分析关节速度与 /epuck/odometry 中速度的映射关系。

第四阶段：Nav2 航点导航全流程研究

步骤 1：启动导航系统

# 启动包含 Nav2 的航点导航场景
ros2 launch webots_ros2_epuck rats_life_waypoints_launch.py

启动后自动加载的模块：

步骤 2：验证 Nav2 核心组件

# 查看 AMCL 定位结果
ros2 topic echo /amcl_pose --noarr
# 查看全局路径规划结果
ros2 topic echo /plan --noarr
# 查看 Nav2 状态
ros2 topic echo /nav2_controller/status --noarr

关键验证：

• /amcl_pose 的 pose 应与 Webots 中机器人位置一致（误差 < 0.1m）；
• /nav2_controller/status 的 status 应为 1（就绪）。

步骤 3：发送导航目标点

# 安装 Nav2 命令行工具
sudo apt install ros-jazzy-nav2-cli
# 发送目标点 1：x=2.0, y=1.0, 朝向 0°
ros2 action send_goal /navigate_to_pose nav2_msgs/action/NavigateToPose "{ pose: { header: {frame_id: 'map'}, pose: { position: {x: 2.0, y: 1.0, z: 0.0}, orientation: {x: 0.0, y: 0.0, z: 0.0, w: 1.0} } } }"

现象：

• Webots 中机器人自动规划路径，避开障碍物到达目标点；
• 终端显示 result: {success: True} 表示导航成功。

步骤 4：航点导航源码研究

1. 自定义航点修改：修改 waypoints 列表中的坐标，重启 Launch 文件；
2. 核心代码解析：

waypoints = [
    (0.0, 0.0, 0.0), # 起点
    (1.5, 0.5, 1.57), # 航点 1
    (3.0, -0.5, 3.14), # 航点 2
    (0.0, 0.0, 0.0) # 终点
]

步骤 5：Nav2 参数调优

打开 Nav2 参数文件：

cd $(rospack find webots_ros2_epuck)/share/webots_ros2_epuck/config
cat nav2_params.yaml

关键参数调优方向：

第五阶段：高级研究与扩展

1. 仿真时间同步研究

# 查看仿真时间
ros2 topic echo /clock --noarr
# 检查节点是否启用 use_sim_time
ros2 param get /amcl use_sim_time
ros2 param get /webots_ros2_driver use_sim_time

研究点：

• 若 use_sim_time 为 false，导航会出现严重偏差；
• Webots 的 real time factor（实时因子）调整对时间同步的影响。

2. 机器人 URDF 模型解析

# 查看机器人 URDF 描述
ros2 topic echo /robot_description --noarr

研究点：

• URDF 中的连杆（link）和关节（joint）定义；
• 传感器的坐标系（frame_id）是否与 RViz2/Nav2 对齐；
• 修改 URDF 中的轮子半径，观察里程计精度变化。

3. 多机器人仿真扩展

修改 robot_launch.py，添加第二个 e-puck 机器人：

# 在 launch 文件中复制机器人节点，修改命名空间
epuck2_node = Node(
    package='webots_ros2_driver',
    executable='driver',
    namespace='epuck2',
    parameters=[
        {'robot_description': robot_description},
        {'use_sim_time': True},
        {'robot_name': 'epuck2'}
    ]
)

验证：

ros2 topic list | grep epuck2

4. 数据记录与分析

# 记录核心话题
ros2 bag record /epuck/laser_scan /epuck/odometry /amcl_pose /map
# 回放数据
ros2 bag play <bag 文件名称>

分析工具：

• 使用 rqt_bag 可视化 bag 数据；
• 用 Python 脚本解析激光雷达/里程计数据，绘制运动轨迹。

常见问题与解决

1. Webots 启动后机器人无响应

• 原因：仿真时间未同步（use_sim_time=false）
• 解决：所有 Nav2/机器人节点启用 use_sim_time: true，在 Launch 文件中添加：

launch.actions.SetParameter(name='use_sim_time', value=True)

2. Nav2 定位漂移

• 原因：激光雷达话题不匹配/AMCL 参数错误
• 解决：
  1. 确认 amcl 配置中 laser_topic: "/epuck/laser_scan"
  2. 调整 AMCL 的 alpha 参数（如 alpha1=0.1）
  3. 检查 /epuck/odometry 话题是否有数据

3. 编译报错（Jazzy 兼容）

• 原因：webots_ros2 分支不匹配
• 解决：确保克隆 jazzy 分支：

cd ~/webots_ws/src/webots_ros2
git checkout jazzy
colcon build --cmake-force-configure

4. 话题名称不匹配

• 原因：机器人命名空间未统一
• 解决：所有话题添加 /epuck 命名空间，如 cmd_vel → /epuck/cmd_vel

总结与研究路径建议

1. 基础层：掌握节点/话题/参数的通信逻辑，验证传感器/执行器数据；
2. 控制层：对比高层（cmd_vel）和底层（关节控制）的差异，理解运动学模型；
3. 导航层：拆解 Nav2 的定位/规划/控制流程，调优参数验证效果；
4. 扩展层：自定义场景/航点/URDF，研究多机器人仿真和时间同步。

通过这种方式，可逐步深入理解 Webots 与 ROS 2 的集成逻辑，掌握 e-puck 机器人的仿真与控制核心。