📚 课程目录第4章 TRUMPF激光设备坐标系与运动学建模

4. TRUMPF激光设备坐标系与运动学建模

在TRUMPF激光加工设备中，无论是TruLaser系列平面切割机，还是TruLaser Cell系列三维五轴激光加工系统，运动控制的核心问题都可以归结为一句话：让激光焦点以正确的姿态、沿正确的路径、在正确的位置作用于工件。而“正确”二字的数学基础，就是坐标系定义与运动学建模。坐标系是运动控制的“语言”，运动学变换是“语法”，标定则是保证这套语言在真实机床上被准确使用的校准过程。

一、三类坐标系及其物理含义

机床坐标系（MCS，Machine Coordinate System）是设备的绝对基准，原点通常由制造商在装配时确定，例如固定在床身某一机械基准点或工作台参考角点。MCS不随工件、夹具或程序变化，是伺服轴位置反馈的最终参照。在TRUMPF系统中，各直线轴（X/Y/Z）和旋转轴（如B轴、C轴）的编码器值最终都映射到MCS下的位姿。

工件坐标系（WCS，Workpiece Coordinate System）是编程和加工的直接参照，原点一般设在工件角点、孔位或夹具定位基准上。操作员通过寻边、对刀或使用工件定位传感器，把WCS相对MCS的偏移量（X/Y/Z平移，必要时含旋转）写入数控系统。这样，同一段加工程序可以不加修改地用于不同装夹位置。

工具坐标系（TCS，Tool Coordinate System）描述激光加工头末端——即激光焦点与光轴方向——相对于机床或法兰的位姿。对激光设备而言，工具坐标系的原点通常定义在焦点位置，Z轴沿光轴指向工件表面，X/Y轴定义焦点平面内的方向。TCS的准确性直接决定焦点是否落在期望位置。

记忆要点：MCS是“机床在哪”，WCS是“工件在哪”，TCS是“焦点在哪、朝哪”。三者通过齐次变换矩阵串联：T_MCS←WCS 与 T_WCS←TCS 相乘，得到焦点在机床坐标系中的实际位姿。

二、五轴/六轴运动学变换的基本结构

以典型的五轴激光加工头为例，常见结构为X/Y/Z三个直线轴加两个旋转轴（如B轴摆头、C轴回转），形成“3+2”或联动五轴。运动学建模的任务是建立关节空间（各轴位移/角度）到笛卡尔空间（焦点位姿）的映射，即正运动学；反之，由期望焦点位姿反解各轴位置，即逆运动学。

正运动学通常用Denavit-Hartenberg（DH）参数或改进DH法描述。每个关节对应一个齐次变换矩阵，串联相乘得到末端位姿：

T_0_n = T_0_1(q1) · T_1_2(q2) · … · T_(n-1)_n(qn)

其中 qi 为第 i 轴变量：
  直线轴 qi = 位移 (mm)
  旋转轴 qi = 角度 (rad 或 °)

末端焦点位姿 P = [x, y, z, Rx, Ry, Rz]^T
由 T_0_n 的平移分量与旋转矩阵解出

逆运动学则更具工程挑战：五轴系统通常存在多解（例如B轴可取正负两个角度配合C轴翻转180°），需要根据机床行程、奇异点规避和光轴方向约束选择合理解。TRUMPF控制系统在插补前会进行逆解筛选，避免轴超程或姿态突变。

三、标定：让模型与真实机床对齐

运动学模型中的几何参数（连杆长度、轴间偏置、旋转中心位置）在装配后必然存在误差。标定的目的就是通过测量，辨识并补偿这些误差，使模型输出的焦点位姿与实测一致。

典型标定流程包括：

直线轴标定：使用激光干涉仪或球杆仪测量各直线轴的实际位移与编码器读数偏差，拟合螺距误差补偿表。
旋转轴中心标定：在B轴或C轴旋转中心附近放置标准球或基准销，用测头或视觉系统测量不同角度下的球心位置，拟合出旋转轴线在MCS中的位置和方向。
工具坐标系标定：使用焦点位置测量装置（如焦点分析仪或带十字靶的标定板），确定焦点相对法兰的偏移量及光轴方向，写入TCS参数。
联动精度验证：执行标准圆弧或“8”字形轨迹，用激光跟踪仪或球杆仪测量实际轨迹与理论轨迹的偏差，若超出允差则迭代修正模型参数。

以某五轴激光加工中心为例，标定后要求焦点位置重复定位精度优于±0.05 mm，姿态角误差小于0.02°。若实测偏差在X方向呈周期性波动，往往提示直线轴螺距补偿表需要更新；若偏差随B轴角度变化呈正弦规律，则可能是旋转中心标定不准。

四、工程实践中的关键判断

在实际调试中，坐标系与运动学问题往往表现为“焦点偏了”“切缝不直”“转角过烧”等现象。排查时可按以下顺序判断：先确认WCS偏移是否正确（寻边结果是否稳定），再检查TCS焦点位置是否漂移（保护镜污染、喷嘴更换后未重新标定），最后验证旋转轴中心是否因碰撞或温升发生偏移。若仅在五轴联动时出现偏差，而单轴运动正常，则优先怀疑逆运动学参数或旋转中心标定。

此外，TRUMPF部分机型支持在线焦点位置补偿，通过电容式或光学式传感器实时测量喷嘴到工件距离，动态修正Z轴和焦点位置。这本质上是在TCS层面增加一个闭环修正量，建模时需将其视为时变偏移，而非固定参数。

注意：不同TRUMPF机型对旋转轴正方向、光轴定义可能不同。编程前务必查阅对应机床的坐标系约定，避免因符号相反导致焦点落在工件背面或碰撞保护镜。

总结来说，坐标系定义了“在哪里”，运动学变换回答了“怎么到那里”，标定则保证了“到了之后确实在那里”。三者构成TRUMPF激光设备轨迹协同的底层骨架，后续的插补、速度规划和多轴同步都建立在这一基础之上。