2. MOTOMAN机器人硬件与运动控制基础

在进入视觉抓取之前，必须先建立对 MOTOMAN 机器人硬件组成与运动控制逻辑的整体认识。视觉系统最终输出的抓取位姿，必须通过机器人控制器翻译成各关节的运动指令，再由本体执行。理解这条链路，是后续标定、通信与抓取程序编写的前提。

一、硬件组成：本体、控制柜与示教器

一台典型的 MOTOMAN 机器人系统由三大部分构成：机器人本体、控制柜和示教器。

机器人本体是执行机构，常见六轴结构（如 MH6、GP7、SIA20 等型号）。六个关节从基座到末端依次为 S、L、U、R、B、T 轴，分别对应回转、下臂、上臂、腕部回转、腕部摆动和腕部扭转。每个关节由伺服电机驱动，配有编码器反馈角度。本体末端是法兰盘，用于安装夹爪、吸盘或视觉相机等工具。

控制柜（如 YRC1000、DX200）是系统的“大脑”，内部包含伺服驱动器、运动控制板卡、I/O 模块和通信接口。它负责解析程序指令、进行轨迹插补运算、输出伺服控制信号，并管理与外部设备（PLC、视觉相机、上位机）的通信。控制柜通常提供 EtherNet/IP、PROFINET、EtherCAT 或串口等接口，视觉系统一般通过这些通道与机器人交换数据。

示教器是手持操作终端，用于手动示教点位、编写和调试程序、查看报警与 I/O 状态。在视觉抓取调试阶段，示教器常用于确认坐标系设置、验证抓取点位置以及手动触发程序段。

二、坐标系体系

MOTOMAN 机器人涉及多个坐标系，理解它们之间的转换关系是视觉抓取的核心。

• 关节坐标系：以各关节角度描述机器人姿态，是控制器最底层的表达方式。
• 直角坐标系（基座坐标系）：以机器人基座为原点，X、Y、Z 轴固定，描述末端在基座空间中的位置和姿态。
• 工具坐标系（TCP）：以工具末端为原点，定义夹爪或吸盘的作用点。视觉抓取时，相机标定得到的抓取点必须与 TCP 对齐。
• 用户坐标系：在工作台或料框上建立的局部坐标系，便于以工件为参照编写程序。

视觉系统通常输出的是相机坐标系下的目标位姿，需要经过手眼标定矩阵转换到机器人基座坐标系或用户坐标系，再结合工具坐标系偏移，最终生成机器人可执行的位姿指令。

三、运动指令入门

MOTOMAN 的 INFORM 语言中，最常用的运动指令包括 MOVJ、MOVL 和 MOVC。

MOVJ 是关节插补运动，各关节以各自最优速度到达目标点，路径不一定是直线，适合大范围快速移动。例如：

MOVJ P001 VJ=50.0
MOVJ P002 VJ=30.0

其中 P001 是示教点位，VJ=50.0 表示关节速度百分比。视觉抓取中，MOVJ 常用于从待机位快速接近抓取区域上方。

MOVL 是直线插补运动，末端沿直线到达目标点，适合抓取接近和离开阶段，避免碰撞。例如：

MOVL P003 V=200.0
MOVL P004 V=100.0

V=200.0 表示末端线速度（mm/s）。视觉抓取时，通常先用 MOVJ 到达抓取点上方安全高度，再用 MOVL 垂直下降到抓取点，夹取后再 MOVL 垂直提升。

MOVC 是圆弧插补，需要三个点定义圆弧，用于避障或轨迹过渡，视觉抓取中较少使用，但在复杂料框取件时可能用到。

四、视觉抓取中的坐标转换示例

假设相机检测到目标在相机坐标系下的位置为 (120, -45, 380) mm，手眼标定矩阵将相机坐标转换到机器人基座坐标系，得到基座坐标 (450, 120, 200) mm。再根据工具坐标系 TCP 偏移（例如夹爪长度 150 mm，Z 方向偏移 -150 mm），最终机器人末端法兰需要到达的位置为 (450, 120, 350) mm。控制器根据该目标位姿进行逆运动学求解，得到六个关节角度，再通过伺服驱动执行。

五、关键参数与安全注意事项