ROS 机械臂组件能力支持全解析

一、ROS 机械臂开发生态概览

ROS 为机械臂（Manipulator / Robot Arm / Cobot）开发提供了业界最完善的软件栈，其中 MoveIt! 是事实上的标准运动规划框架，被 Universal Robots、KUKA、ABB、Franka Emika、Fanuc 等几乎所有主流机械臂厂商官方支持。一个典型的 ROS 机械臂系统，其软件栈分层如下：

二、MoveIt! 核心组件与能力

MoveIt! 是 ROS 机械臂开发的核心引擎，目前最新版本为 MoveIt2（适配 ROS2）。它由一组松耦合的 ROS 节点和 C++ 库组成，通过 MoveGroup 接口对外提供统一服务。其内部核心组件如下：

三、九大核心能力详解

3.1 运动规划器对比

四、典型应用场景

五、完整应用示例：视觉引导抓取工作站

以下展示一个典型的 3D 视觉引导抓取工作站的完整架构与话题流，使用 UR5e + Realsense D435i + OnRobot RG2 夹爪：

5.1 工作流程步骤

六、基础代码实战（C++ / Python）

6.1 C++：MoveGroupInterface 规划到目标位姿

// C++ MoveIt2 示例：规划到目标位姿并执行
#include <moveit/move_group_interface/move_group_interface.h>
#include <rclcpp/rclcpp.hpp>
#include <geometry_msgs/msg/pose_stamped.hpp>

int main(int argc, char **argv) {
    rclcpp::init(argc, argv);
    auto node = rclcpp::Node::make_shared("pick_demo");

    // MoveGroup 绑定规划组（UR5e 的 manipulator 规划组）
    moveit::planning_interface::MoveGroupInterface move_group(node, "manipulator");
    move_group.setPlanningTime(5.0);   // 规划最长 5 秒
    move_group.setMaxVelocityScalingFactor(0.5);  // 速度 50%
    move_group.setMaxAccelerationScalingFactor(0.3);

    // 设置末端目标位姿（世界坐标系下，单位 m + 四元数）
    geometry_msgs::msg::PoseStamped target_pose;
    target_pose.header.frame_id = "base_link";
    target_pose.pose.position.x = 0.5;
    target_pose.pose.position.y = 0.2;
    target_pose.pose.position.z = 0.3;
    // 四元数：绕 Z 轴 0° 抓取姿态（WXYZ 顺序）
    target_pose.pose.orientation.w = 1.0;
    target_pose.pose.orientation.x = 0.0;
    target_pose.pose.orientation.y = 0.0;
    target_pose.pose.orientation.z = 0.0;
    move_group.setPoseTarget(target_pose);

    // 规划一条无碰撞轨迹
    moveit::planning_interface::MoveGroupInterface::Plan plan;
    auto success = (move_group.plan(plan) == moveit::core::MoveItErrorCode::SUCCESS);
    RCLCPP_INFO(node->get_logger(), "规划结果: %s", success ? "成功 ✓" : "失败 ✗");

    // 执行轨迹（阻塞直到完成）
    if (success) move_group.execute(plan);

    rclcpp::shutdown();
    return 0;
}

6.2 Python：笛卡尔直线规划 + 夹爪控制

# Python MoveIt2 示例：笛卡尔直线运动 + 夹爪开闭 Service
import rclpy
from rclpy.node import Node
from moveit.planning import MoveItPy
from geometry_msgs.msg import Pose
import sys

def main():
    rclpy.init()
    node = Node("cartesian_demo")

    # 初始化 MoveItPy，加载机器人描述与规划组配置
    robot = MoveItPy(node_name="moveit_helper")
    arm = robot.get_planning_component("manipulator")

    # 设置起始状态为当前关节位置
    arm.set_start_state_to_current_state()

    # 构造一系列笛卡尔空间目标点（每个点相距 5cm 向下，共 5 段直线）
    waypoints = []
    current_pose = arm.get_pose_target()
    for i in range(1, 6):
        p = Pose()
        p.position.x = current_pose.pose.position.x
        p.position.y = current_pose.pose.position.y
        p.position.z = current_pose.pose.position.z - 0.05 * i  # 每次下降 5cm
        p.orientation = current_pose.pose.orientation
        waypoints.append(p)

    # computeCartesianPath：按顺序走直线，返回 (轨迹, 完成率)
    (traj, fraction) = arm.compute_cartesian_path(waypoints, eef_step=0.01, jump_threshold=0.0)
    node.get_logger().info(f"笛卡尔路径完成率: {fraction*100:.1f}%")

    if fraction > 0.9:
        # 执行轨迹
        arm.execute(traj, controllers=["joint_trajectory_controller"])

        # 调用夹爪服务关闭（标准 GripperCommand Action）
        from control_msgs.action import GripperCommand
        grip = robot.get_action_client("/rg2_gripper/gripper_cmd", GripperCommand)
        goal = GripperCommand.Goal()
        goal.command.position = 0.0      # 0 = 完全闭合
        goal.command.max_effort = 40.0  # 最大夹紧力 40N
        grip.send_goal(goal).result()

        # 提升 10cm
        arm.set_start_state_to_current_state()
        p2 = arm.get_pose_target()
        p2.pose.position.z += 0.1
        arm.set_pose_target(p2)
        plan = arm.plan()
        if plan:
            arm.execute(plan)

    rclcpp.shutdown()

if __name__ == "__main__":
    main()

6.3 Launch 文件：一键启动 MoveIt2 + RViz + 驱动

# launch/ur5e_moveit_demo.launch.py：典型机械臂启动脚本
from launch import LaunchDescription
from launch_ros.actions import Node

def generate_launch_description():
    return LaunchDescription([
        # 1) 机器人状态发布器：根据关节角发布 TF 变换
        Node(
            package="robot_state_publisher",
            executable="robot_state_publisher",
            parameters=[{"robot_description": Command(["xacro ", urdf_path])}]
        ),
        # 2) ros2_control 控制器管理器 + 关节轨迹控制器
        Node(
            package="controller_manager",
            executable="ros2_control_node",
            parameters=[ur5e_controllers_yaml]
        ),
        # 3) MoveGroup 运动规划核心节点
        Node(
            package="moveit_ros_move_group",
            executable="move_group",
            parameters=[
                moveit_controllers_yaml,
                {"use_sim_time": use_sim_time},
                {"planning_plugin": "ompl_interface/OMPLPlanner"},
                {"request_adapters": "default_planner_request_adapters/AddTimeOptimalParameterization"}
            ]
        ),
        # 4) RViz + Motion Planning 交互插件
        Node(
            package="rviz2",
            executable="rviz2",
            arguments=["-d", rviz_config_path]
        ),
    ])

6.4 SRDF 片段：定义规划组与末端执行器

<!-- ur5e.srdf：MoveIt! 语义机器人描述，定义规划组 -->
<robot name="ur5e_robot">
  <!-- 6 轴机械臂规划组（链状：base_link → tool0） -->
  <group name="manipulator">
    <chain base_link="base_link" tip_link="tool0"/>
  </group>

  <!-- 夹爪规划组（2 指平行夹爪） -->
  <group name="gripper">
    <joint name="finger_joint1"/>
    <joint name="finger_joint2"/>
  </group>

  <!-- 末端执行器与规划组绑定 -->
  <end_effector
      name="rg2_gripper"
      parent_link="tool0"
      group="gripper"
      parent_group="manipulator"/>

  <!-- 禁用默认自碰撞检测的连杆对（允许接触的部分） -->
  <disable_collisions link1="forearm_link" link2="wrist_1_link" reason="Adjacent"/>

  <!-- 预设位姿（一键回 home） -->
  <group_state name="home" group="manipulator">
    <joint name="shoulder_pan_joint" value="0.0"/>
    <joint name="shoulder_lift_joint" value="-1.57"/>
    <joint name="elbow_joint" value="1.57"/>
    <joint name="wrist_1_joint" value="-1.57"/>
    <joint name="wrist_2_joint" value="0.0"/>
    <joint name="wrist_3_joint" value="0.0"/>
  </group_state>
</robot>

七、总结与选型建议