运动学
运动学用于在关节位置与工具位姿之间转换。添加机器人、配置机械参数或排查目标不可达时,应先确认所选运动学与实物一致。
求解器(PRODUCT §6.1)
下列类型的正逆解求解器已经落地,可用于模型检查和离线计算:
| 运动学类型 | 状态 | 说明 |
|---|---|---|
| 6R 串联(6 轴工业机器人) | 已落地 | 含 11 种 IK 解法 |
| 7R 冗余(7 轴协作) | 已落地 | 依赖当前关节种子选择冗余解 |
| SCARA(4 轴水平关节) | 已落地 | |
| Delta(3 轴并联) | 已落地 | |
| Gantry 龙门(直角坐标) | 已落地 | |
| Stewart(6 自由度并联平台) | 已落地 | |
| 五轴(AC/BC 摆头 + 转台) | 已落地 | |
| 协作单臂 / 双臂 | 已落地 | |
| DOF≥9 冗余 | 已落地 | |
| 通用 DH 数值解 | 已落地 | 用于非标准串联机构 |
求解器已落地 ≠ 该构型已接入现场 SCL 运动链。 当前现场机器人运动只装配第一组 6 轴 DH 机器人,索引为 0,关节轴为 J1 到 J6。其他模型即使能在模型库、求解器或 3D 视口中使用,也不能据此判断真机 SCL 运动可用。
正解和逆解
- 正运动学:根据当前关节位置计算工具位姿,用于在线显示、点位记录和起点确认。
- 逆运动学:根据目标工具位姿计算关节目标,用于 MoveJ、MoveL 和圆弧执行。
- 多解选择:应优先满足关节限位,并选择接近当前关节构型的有效解。
- 失败处理:目标不可达、接近奇异位形或机械参数不完整时,运动调用返回非零,不会伪造结果。
当前没有公开的 SCL 正解、逆解、工作空间或机械参数修改接口。运动学由机器人配置和运动命令使用。
现场入口只消费已经配置好的运动学:
| 入口 | 如何使用运动学 |
|---|---|
robot.MoveJ | 目标 TCP → 关节空间 PTP |
robot.MoveL | 目标 TCP → 笛卡尔直线上的逐点 IK |
MC_MOVE_LINEAR | 轴组笛卡尔直线,IK 依赖关节轴配置 |
MC_MOVE_CIRCULAR | 三点圆弧,IK 依赖关节轴配置 |
robot.ReadPos | 读关节真反馈后做 FK,写入寄存器 |
必填机械参数
| 参数 | 用途 |
|---|---|
| 机器人类型 | 选择对应求解方法 |
| 关节轴顺序 | 将 J1 到 Jn 映射到实际轴 |
| 连杆尺寸或 DH 参数 | 定义串联机械结构 |
| 关节类型 | 区分旋转轴和直线轴 |
| 零位偏移 | 对齐模型零位和实物零位 |
| 关节限位 | 排除机械不可达解 |
| 底座位姿 | 将机器人放入项目世界坐标 |
参数单位必须与项目配置一致。旋转关节反馈按弧度进入运动链,界面可以换算为度;直线轴使用项目工程单位。SCL 运动调用中的 TCP 姿态 Rx/Ry/Rz 按度传入。
验证流程
- 在失能或受控低速条件下核对模型零位。
- 分别小幅移动每个关节,确认模型方向和实物一致。
- 记录一个已知关节姿态,检查正解得到的工具位置。
- 选取工作空间内的简单目标,检查逆解和关节限位。
- 用 MoveJ 验证关节构型,再用 MoveL 检查整条直线路径。
- 对不同工作区、工具和工件坐标重复验证。
仿真不是安全证明
运动学求解成功只说明几何可达,不代表路径无碰撞,也不代表真机安全。真机仍需外部安全回路、硬件急停和操作员确认。
当前边界
- 工作空间点云和可操作度可用于离线评估,但没有公开的生产 SCL 查询入口。
- 自动运动学参数辨识、外部测量设备联动和一键绝对精度补偿尚未交付。
- 不公开固定求解时间、成功率或精度;这些指标取决于机型、参数和真实测试。
- CNC 五轴加工的 G-code 执行链是 P5 预留,与上表“五轴求解器已落地”不是同一件事。
常见问题
| 现象 | 检查项 |
|---|---|
| MoveJ 返回非零 | 机器人类型、机械参数、关节轴和目标位姿 |
| MoveL 中途失败 | 直线中间点的逆解、关节限位和奇异位形 |
| 模型与实物方向相反 | 关节轴方向和零位偏移 |
| 工具位置整体偏移 | 底座位姿和工具坐标标定 |
| 7R 肘部构型突变 | 当前关节种子、限位和冗余求解结果 |
| SCARA / Delta 能算不能跑 | 求解器可用;现场 SCL 仍只接索引 0 的 6 轴 DH |