保姆级教程：基于ROS Melodic和MoveIt!，手把手搭建双RM65机械臂协同控制系统

基于ROS Melodic和MoveIt!的双RM65机械臂协同控制系统实战指南

在工业自动化与智能制造领域，双机械臂协同作业正成为提升生产效率的关键技术。想象一下，两台机械臂如同默契的舞者，在装配线上精准配合，完成单台设备难以企及的复杂任务——这正是RM65机械臂与MoveIt!框架结合所能实现的场景。本文将带您从零构建一个完整的双机械臂控制系统，涵盖运动规划、控制器配置到底层通信的全流程。

1. 系统架构设计与环境准备

双机械臂协同系统的核心在于分层架构设计。我们需要构建一个从上层运动规划到底层硬件驱动的完整控制链：

规划层（MoveIt!） → 控制层（ROS控制器） → 驱动层（以太网通信） → 物理机械臂

1.1 硬件与软件环境配置

硬件要求：

• 两台RM65六轴机械臂（支持以太网通信）
• 工控机（推荐Ubuntu 18.04 LTS）
• 千兆以太网交换机

软件依赖安装：

sudo apt-get install ros-melodic-moveit ros-melodic-industrial-core sudo apt-get install ros-melodic-joint-state-publisher-gui

1.2 工作空间初始化

创建专属的工作空间和功能包：

mkdir -p ~/dual_arm_ws/src cd ~/dual_arm_ws/src catkin_create_pkg dual_arm_moveit_config moveit_core moveit_ros_planning_interface catkin_create_pkg dual_arm_control roscpp actionlib control_msgs catkin_create_pkg dual_arm_driver roscpp socketcan_interface

2. MoveIt!配置与双臂命名空间隔离

2.1 控制器配置文件定制

在dual_arm_moveit_config/config/controllers.yaml中定义双控制器：

controller_list: - name: left_rm65_controller action_ns: follow_joint_trajectory default: True type: FollowJointTrajectory joints: - L1_joint - L2_joint - L3_joint - L4_joint - L5_joint - L6_joint - name: right_rm65_controller action_ns: follow_joint_trajectory default: True type: FollowJointTrajectory joints: - R1_joint - R2_joint - R3_joint - R4_joint - R5_joint - R6_joint

2.2 真实机械臂启动文件修改

关键修改点对比：

在demo_realrobot.launch中需移除仿真关节状态发布器，并添加执行监控参数：

<param name="trajectory_execution/execution_duration_monitoring" value="false"/>

3. 双控制器开发与轨迹处理

3.1 动作服务器实现

左右机械臂控制器需要分别实现FollowJointTrajectoryAction接口。以下是左臂控制器的核心代码框架：

// l_arm_control.cpp #include <actionlib/server/simple_action_server.h> #include <control_msgs/FollowJointTrajectoryAction.h> void executeTrajectory(const control_msgs::FollowJointTrajectoryGoalConstPtr &goal, Left_Arm_Server* as) { // 轨迹点处理逻辑 for(auto& point : goal->trajectory.points) { // 三次样条插值计算 // 20ms周期发送关节角度 } as->setSucceeded(); } int main(int argc, char** argv) { ros::init(argc, argv, "l_arm_controller"); ros::NodeHandle nh("left_arm"); Left_Arm_Server server(nh, "left_rm65_controller/follow_joint_trajectory", boost::bind(&executeTrajectory, _1, &server), false); server.start(); ros::spin(); return 0; }

3.2 轨迹插值算法优化

为确保运动平滑性，建议采用五次多项式插值：

1. 获取MoveIt!输出的路径点
2. 计算各关节的速度、加速度约束
3. 按20ms控制周期细分轨迹
4. 添加关节限位保护逻辑

提示：实际项目中建议加入关节扭矩监控，当检测到异常接触力时立即停止运动。

4. 底层驱动与通信实现

4.1 以太网通信模块

针对RM65机械臂的驱动开发要点：

• 使用BSD Socket API建立TCP连接
• 自定义二进制协议传输关节角度
• 心跳机制维持连接稳定性
• 双缓冲机制处理实时数据

// l_arm_driver.cpp 片段 int connectToArm(const char* ip, int port) { int sockfd = socket(AF_INET, SOCK_STREAM, 0); struct sockaddr_in serv_addr; memset(&serv_addr, 0, sizeof(serv_addr)); serv_addr.sin_family = AF_INET; serv_addr.sin_port = htons(port); inet_pton(AF_INET, ip, &serv_addr.sin_addr); if(connect(sockfd, (struct sockaddr*)&serv_addr, sizeof(serv_addr)) < 0) { ROS_ERROR("Connection failed to %s:%d", ip, port); return -1; } return sockfd; }

4.2 状态反馈与同步控制

为实现双臂精确协同，需要：

1. 在每个控制周期比较双臂状态
2. 当偏差超过阈值时进行速度调节
3. 通过ROS Topic发布同步状态信息
4. 使用条件变量实现硬件级同步

5. 系统集成与调试技巧

5.1 完整启动流程

建议的启动顺序：

1. 启动ROS核心节点

   roscore

2. 加载机械臂驱动

   roslaunch dual_arm_driver dual_driver.launch

3. 启动MoveIt!规划系统

   roslaunch dual_arm_moveit_config demo_realrobot.launch

5.2 常见问题排查指南

在实际部署中，我们发现机械臂的校准精度会显著影响最终操作准确性。建议每次上电后执行以下步骤：

1. 进行各关节的零点校准
2. 运行标准轨迹测试重复定位精度
3. 使用激光跟踪仪验证末端精度（可选）
4. 记录校准参数到配置文件

双机械臂系统的魅力在于它们能完成单臂无法实现的复杂任务。比如在装配作业中，一台机械臂固定工件，另一台执行精密安装；或者在物料搬运时，两台机械臂协同托举大型物件。这些场景都需要精细的轨迹规划和实时协调控制。