机器人 / 系统课时

初始化 MoveGroupInterface 客户端

初始化 MoveGroupInterface 客户端

用一个可运行的 ROS 2 Jazzy C++ 节点接入 Panda 规划组,确认 MoveIt 已加载机器人模型,并读出规划参考帧和末端连杆。本例只完成客户端初始化与信息核验,不向机械臂下发运动指令。

学习目标

  • 创建包含 rclcpp 与 moveit_ros_planning_interface 依赖的 C++ 软件包。
  • 使用独立执行器线程初始化 MoveGroupInterface。
  • 读取 panda_arm 的规划参考帧、末端连杆,并定位常见连接失败。

创建 C++ 软件包

操作环境为 Ubuntu 24.04、ROS 2 Jazzy 和 MoveIt 2。以下假设尚未创建 ~/moveit_ws/src/moveit_probe,在新终端一次性安装依赖并创建包:

bash
source /opt/ros/jazzy/setup.bash
sudo apt update
sudo apt install -y ros-jazzy-moveit ros-jazzy-moveit-resources-panda-moveit-config python3-colcon-common-extensions
mkdir -p ~/moveit_ws/src
cd ~/moveit_ws/src
ros2 pkg create --build-type ament_cmake --dependencies rclcpp moveit_ros_planning_interface --node-name moveit_probe moveit_probe

预期结果:出现 ~/moveit_ws/src/moveit_probe/,其中包含 package.xml、CMakeLists.txt 和 src/moveit_probe.cpp。--node-name 会生成可执行目标及安装规则,两个依赖会写入包清单和构建配置;不要再次对同名目录运行创建命令。

理解节点、执行器与规划组

MoveGroupInterface 是客户端对象,不是独立的规划器。构造时传入 ROS 2 节点和 SRDF 中已有的规划组名 panda_arm,它会读取机器人描述,并准备与 move_group 交互的 ROS 2 接口。后续规划由服务端处理,本例不调用 plan() 或 execute()。

SingleThreadedExecutor 在另一线程持续 spin(),使订阅、服务和动作相关回调能够被处理。getPlanningFrame() 返回机器人模型的规划参考帧;getEndEffectorLink() 返回该组关联的末端连杆。它们读取的是已加载模型的信息,并不是一次规划请求的返回值。

MoveGroupInterface 节点、执行器、机器人模型与规划服务的数据关系

编写初始化程序

把生成的 src/moveit_probe.cpp 完整替换为以下代码。Panda 示例 SRDF 使用 panda_arm;换成自己的机器人时,必须同步改成实际规划组名。

cpp
#include <exception>
#include <memory>
#include <thread>
#include <rclcpp/rclcpp.hpp>
#include <moveit/move_group_interface/move_group_interface.hpp>

int main(int argc, char** argv)
{
  rclcpp::init(argc, argv);
  auto node = std::make_shared<rclcpp::Node>(
      "moveit_probe",
      rclcpp::NodeOptions().automatically_declare_parameters_from_overrides(true));

  rclcpp::executors::SingleThreadedExecutor executor;
  executor.add_node(node);
  // 让机器人描述等 ROS 回调在后台持续被处理
  std::thread spin_thread([&executor]() { executor.spin(); });

  int exit_code = 0;
  try
  {
    // 规划组名称来自 Panda 的 SRDF,不是自定义节点名
    moveit::planning_interface::MoveGroupInterface group(node, "panda_arm");
    RCLCPP_INFO(node->get_logger(), "Group: %s", group.getName().c_str());
    RCLCPP_INFO(node->get_logger(), "Planning frame: %s",
                group.getPlanningFrame().c_str());

    const auto& eef = group.getEndEffectorLink();
    if (eef.empty())
      RCLCPP_WARN(node->get_logger(), "End-effector link is empty; check SRDF");
    else
      RCLCPP_INFO(node->get_logger(), "End-effector link: %s", eef.c_str());
  }
  catch (const std::exception& e)
  {
    RCLCPP_ERROR(node->get_logger(), "Initialization failed: %s", e.what());
    exit_code = 1;
  }

  // 先结束回调线程,再关闭 ROS,避免线程访问失效的资源
  executor.cancel();
  spin_thread.join();
  rclcpp::shutdown();
  return exit_code;
}

预期结果:在 Panda 演示后端正常运行时,程序可读取 panda_arm、world 和 panda_link8;没有识别到末端连杆时会给出警告。代码不设置目标,也不会移动机器人。

构建、运行与核验

回到工作空间构建,生成的 CMakeLists.txt 已包含 ament_target_dependencies 和目标安装规则,无需再手写第二个可执行目标:

bash
cd ~/moveit_ws
source /opt/ros/jazzy/setup.bash
colcon build --packages-select moveit_probe
source install/setup.bash
ros2 pkg executables moveit_probe

预期输出(构建成功后的最后一条命令):

text
moveit_probe moveit_probe

打开终端 A,启动包含 move_group、机器人描述和 RViz 的 Panda 演示配置,并保持运行:

bash
source /opt/ros/jazzy/setup.bash
ros2 launch moveit_resources_panda_moveit_config demo.launch.py

预期结果:RViz 显示 Panda 模型,move_group 节点已启动。等待场景初始化完成后再执行客户端;该启动命令会持续运行,而非立即退出。

打开终端 B,运行刚构建的节点:

bash
source /opt/ros/jazzy/setup.bash
source ~/moveit_ws/install/setup.bash
ros2 run moveit_probe moveit_probe

预期输出(关键日志节选,<TIME> 是随运行变化的时间戳,MoveIt 自身还会输出初始化日志):

text
[INFO] [<TIME>] [moveit_probe]: Group: panda_arm
[INFO] [<TIME>] [moveit_probe]: Planning frame: world
[INFO] [<TIME>] [moveit_probe]: End-effector link: panda_link8

处理常见初始化问题

  • 找不到机器人描述:若出现 Could not find parameter robot_description 或等待超时,先用 ros2 node list 检查 /move_group 是否存在,并用 ros2 topic list 检查 /robot_description、/robot_description_semantic。确认终端 A 未退出,两个终端的 ROS_DOMAIN_ID 一致。
  • 规划组无效:panda_arm 来自 Panda 的 SRDF,不能直接照搬其他机器人的 manipulator。查看当前配置的 robot_description_semantic 或 SRDF,核对 <group name="panda_arm">;如果使用自定义机器人,要使用自己的组名。
  • 末端连杆为空:检查 SRDF 的末端执行器关联关系及规划链末端。Panda 示例通常返回 panda_link8;不要把夹爪组 hand 直接当成七轴机械臂规划组。
  • 节点卡在初始化阶段:确认演示环境能够发布机器人描述,且 spin_thread 正在执行;不要在等待 MoveIt 接口时把唯一的执行线程阻塞住。

当程序能稳定输出三项信息且正常退出,说明 C++ 客户端已获得对应规划组的机器人模型信息,可以在此基础上继续设置目标与发起规划;它本身不代表轨迹规划或控制器执行已经通过验收。

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

目录与阅读设置

阅读设置

17

记录一个想法

初始化 MoveGroupInterface 客户端

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

登录哪都通