2. MOTOMAN机器人硬件结构与运动学基础
MOTOMAN 系列机器人（如 MH6、MA1440、GP7 等）是典型的六轴串联关节型工业机器人。要真正用好它，不能只停留在“示教几个点、按启动”的层面，而必须理解它的机械本体、伺服驱动链路、坐标系定义以及正逆运动学求解方式。本节围绕这四块内容展开，并给出可直接用于配置与验证的示例参数。
一、机械本体结构：六轴串联与关节分工
MOTOMAN 六轴机器人的机械本体由基座、S 轴（回转）、L 轴（下臂）、U 轴（上臂）、R 轴（腕部回转）、B 轴（腕部摆动）、T 轴（腕部扭转）依次串联而成。前三个轴（S、L、U）决定手腕参考点的空间位置，后三个轴（R、B、T）决定末端工具的姿态，这种“3+3”分工是理解运动学的基础。
以 MH6 为例，其典型规格为：最大负载 6 kg，最大工作半径约 1425 mm，重复定位精度 ±0.08 mm。各轴运动范围大致为：S 轴 ±170°、L 轴 +155°/−90°、U 轴 +255°/−175°、R 轴 ±180°、B 轴 ±180°、T 轴 ±360°。这些范围直接决定了可达工作空间，也决定了逆解时哪些解是“物理可行”的。
机械本体上还有几个关键物理对象：手腕参考点（通常位于 R/B/T 三轴交点附近）、法兰安装面、以及各轴的机械零位刻线。零位刻线是校准的基准——当各轴对准刻线时，机器人处于机械零位姿态，此时各关节角被定义为 0°（部分轴有偏置，需以出厂数据为准）。
二、伺服驱动系统：从控制器到关节的功率与信号链
MOTOMAN 的伺服驱动系统是一条典型的“控制—功率—反馈”闭环链路：控制器（如 DX200、YRC1000）发出位置/速度指令，经伺服驱动器放大为三相电流，驱动各轴 AC 伺服电机；电机经减速机（通常为 RV 减速机）降速增矩后驱动关节；编码器实时反馈关节角度，形成半闭环或全闭环控制。
实际配置中需要关注几个参数：电机额定/峰值转矩、减速比、编码器分辨率（如 17 位或 23 位绝对值编码器）、以及各轴的最大速度。以某轴为例，若编码器为 17 位（131072 脉冲/转），减速比为 120:1，则关节每转对应约 131072×120 个脉冲，单脉冲对应的关节角约为 360°/(131072×120) ≈ 2.29×10⁻⁵ 度。这个数值直接决定了理论分辨率，但实际精度还受减速机背隙、机械刚度影响。
三、关节坐标系与工具坐标系
MOTOMAN 涉及多套坐标系，必须分清：
- 关节坐标系（JOINT）：以各轴角度 (S,L,U,R,B,T) 描述，单位度，是示教和运动学计算的最底层表示。
- 直角坐标系（BASE/机器人坐标系）：原点在机器人基座，X 向前、Y 向左、Z 向上（右手系），描述手腕参考点位置与姿态。
- 工具坐标系（TOOL）：以法兰为基准，通过 TCP（工具中心点）偏移和姿态定义。例如焊枪 TCP 可能在法兰前方 200 mm、偏转 45°。
- 用户坐标系（USER）：以工件或工装为基准，便于在工件坐标系下编程。
工具坐标系标定通常用“四点法”或“六点法”：让 TCP 以不同姿态触碰同一固定点，记录多组关节角，反算出 TCP 相对法兰的位置。标定质量直接影响轨迹精度，标定后应检查 TCP 偏差是否在 0.5 mm 以内。
四、正逆运动学求解方法
正运动学是“已知关节角求末端位姿”，逆运动学是“已知末端位姿求关节角”。MOTOMAN 采用标准的 DH（Denavit-Hartenberg）参数建模，每个连杆用四个参数描述：连杆长度 a、连杆扭角 α、关节偏置 d、关节角 θ。
正解过程是依次相乘各连杆变换矩阵：T = A₁·A₂·A₃·A₄·A₅·A₆，得到末端相对基座的 4×4 齐次变换矩阵。逆解则复杂得多：六轴串联机器人通常存在多解（最多 8 组），需要根据关节范围、奇异位形和避障要求筛选。MOTOMAN 控制器内部用解析法结合数值迭代求解，工程上也可用“腕部解耦”思路：先由手腕参考点位置解出前三个轴，再由姿态解出后三个轴。
奇异位形是逆解的难点：当 B 轴接近 0°（腕部奇异）或 L、U 轴共线（肩部/肘部奇异）时，逆解可能无解或关节速度趋于无穷。实际编程中应避免让机器人以奇异姿态直线运动。
五、典型运动学参数配置示例
下面给出一组用于教学验证的示例 DH 参数（非实测，仅作结构演示），对应一台类似 MH6 的六轴机器人：
轴 a(mm) α(°) d(mm) θ范围(°)
S 150 90 450 -170 ~ +170
L 600 0 0 -90 ~ +155
U 120 -90 0 -175 ~ +255
R 0 90 640 -180 ~ +180
B 0 -90 0 -180 ~ +180
T 0 0 100 -360 ~ +360
配置时需注意：DH 参数必须与控制器内部模型一致，否则示教点会偏移。若更换工具或法兰，应重新标定 TCP 并更新工具坐标系数据。验证方法：让机器人以 JOINT 模式走到一组已知关节角，再切到直角模式读取位姿，与用上述参数手算的正解结果对比，偏差应在 1 mm 以内。
理解上述四块内容后，实际配置 MOTOMAN 时的顺序通常是：先确认机械零位与 DH 参数，再检查伺服使能与编码器状态，然后标定工具坐标系，最后用一组已知关节角做正解验证。若验证偏差超限，应优先排查 DH 参数是否与控制器模型一致、TCP 标定是否准确，而不是盲目调整程序中的示教点。