4. 机器人运动学与轨迹规划基础
在机器人工作站虚拟调试中，运动学与轨迹规划决定了机器人“能不能到、怎么到、到得稳不稳”。虚拟调试阶段如果只验证逻辑信号，而忽略关节空间与笛卡尔空间的差异、逆解多解与奇异点，往往会在现场出现姿态突变、关节超速或轨迹偏离。本节围绕关节空间与笛卡尔空间运动、正逆运动学、轨迹插补、奇异点规避与可达性验证展开，并结合一个六轴工业机器人搬运示例说明关键参数与判断依据。
一、关节空间与笛卡尔空间：两种描述方式
关节空间用各关节角度（或位移）描述机器人状态，例如六轴机器人的 q = [q1, q2, q3, q4, q5, q6]，单位通常为度或弧度。笛卡尔空间用末端执行器在基坐标系下的位姿描述，包括位置 (x, y, z) 和姿态 (rx, ry, rz) 或四元数。两者通过正运动学与逆运动学相互转换。
关节空间运动只对关节变量插值，计算简单、不会出现逆解失败，但末端轨迹通常不是直线；笛卡尔空间运动对末端位姿插值，能保证直线或圆弧轨迹，但每个插补点都需要逆解，可能遇到奇异点或不可达。虚拟调试中，搬运的接近段、离开段常用关节空间以节省节拍，而涂胶、焊接、装配等工艺段必须用笛卡尔空间保证轨迹精度。
二、正运动学与逆运动学
正运动学是已知关节角求末端位姿，通常用 DH 参数建立连杆坐标系，通过相邻连杆变换矩阵连乘得到：
T = T01(q1) · T12(q2) · T23(q3) · T34(q4) · T45(q5) · T56(q6)
末端位姿 = T 中的旋转矩阵 R 与位置向量 p逆运动学是已知末端位姿求关节角，六轴串联机器人一般存在多组解。以常见的球形手腕机器人为例，前三个关节决定手腕中心位置，后三个关节决定姿态。逆解需要根据“腕部翻转”“肘部上/下”“肩部前/后”等构型选择一组解。虚拟调试中必须固定构型标志，否则同一目标点在不同程序段可能切换到不同解，导致机器人“翻腕”或大范围重定位。
示例：某六轴机器人基坐标系下目标点 P = (800, 200, 500) mm，姿态为绕 Z 轴 90°。逆解可能得到两组以上关节角，例如 q = [10°, -30°, 60°, 0°, 40°, 10°] 与 q = [10°, -150°, -60°, 180°, -40°, 10°]。两者末端位姿相同，但关节行程、是否接近限位、是否与夹具干涉完全不同。虚拟调试时应把构型选择写入程序或配置，而不是依赖控制器默认。
三、轨迹插补：从点到连续运动
轨迹插补把离散路径点变成控制器可执行的连续轨迹。常见方式包括关节空间多项式插补、笛卡尔空间直线插补和圆弧插补。虚拟调试中要关注插补周期、速度、加速度和加加速度限制。
以笛卡尔直线插补为例，起点 P0 = (600, 0, 400)，终点 P1 = (900, 0, 400)，长度 300 mm，设定速度 200 mm/s，插补周期 4 ms，则每个周期前进 0.8 mm，约 375 个插补点。每个插补点都要逆解并检查关节速度、加速度是否超限。若某段关节速度接近上限，应降低笛卡尔速度或改用关节空间过渡。
关节空间常用五次多项式保证位置、速度、加速度连续，适合点到点搬运；笛卡尔空间直线插补保证末端沿直线运动，适合工艺段。虚拟调试时可在仿真中显示末端轨迹偏差、关节速度曲线和奇异点警告。
四、奇异点规避
奇异点是机器人雅可比矩阵降秩的位姿，此时某些方向无法运动或需要无穷大关节速度。六轴机器人常见奇异包括：腕部奇异（q5 接近 0°，关节 4 和 6 轴线重合）、肩部奇异（腕部中心位于关节 1 轴线上）、肘部奇异（手臂完全伸直）。
虚拟调试中可通过以下方式规避：在路径规划时让 q5 远离 0°，例如保持 |q5| > 15°；在接近奇异区时降低笛卡尔速度；使用关节空间过渡绕过奇异区；或在逆解失败时自动切换到备用构型。若仿真中出现关节速度突然飙升、末端抖动或逆解无解，应检查是否进入奇异区。
五、可达性验证
可达性验证包括几何可达、关节限位、速度加速度约束和碰撞干涉。虚拟调试时，可在仿真环境中对每个路径点执行逆解，检查关节角是否在软限位内、关节速度是否超过额定值、是否与夹具或围栏碰撞。对于搬运示例，目标点 (800, 200, 500) 若逆解得到 q2 = -150°，而关节 2 下限为 -140°，则该点不可达，需要调整机器人基座位置或目标点。
六、虚拟调试中的实施要点
在虚拟调试软件中，通常先导入机器人模型与工作站布局，建立工具坐标系和工件坐标系，再编写轨迹程序。对于搬运任务，可把路径分为接近点、抓取点、提升点、过渡点、放置点和离开点。接近点和离开点用关节空间，抓取和放置段用笛卡尔空间直线。每个点都执行逆解并记录关节角、速度、奇异点距离。
若发现某段轨迹在奇异点附近，可插入一个过渡点，使 q5 偏离 0°；若发现关节超速，可降低该段速度倍率或改用关节空间。虚拟调试的价值在于：在不停机、不损坏设备的情况下，把运动学问题提前暴露并修正。
最后，把验证通过的轨迹参数、构型标志、速度倍率和奇异点规避策略整理成配置表，作为现场调试的基准。这样，虚拟调试不仅验证了逻辑，也验证了运动学与轨迹规划的可行性。