跳到主要内容

运动学

运动学用于在关节位置与工具位姿之间转换。添加机器人、配置机械参数或排查目标不可达时,应先确认所选运动学与实物一致。

求解器(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 按度传入。

验证流程​

  1. 在失能或受控低速条件下核对模型零位。
  2. 分别小幅移动每个关节,确认模型方向和实物一致。
  3. 记录一个已知关节姿态,检查正解得到的工具位置。
  4. 选取工作空间内的简单目标,检查逆解和关节限位。
  5. 用 MoveJ 验证关节构型,再用 MoveL 检查整条直线路径。
  6. 对不同工作区、工具和工件坐标重复验证。
仿真不是安全证明

运动学求解成功只说明几何可达,不代表路径无碰撞,也不代表真机安全。真机仍需外部安全回路、硬件急停和操作员确认。

当前边界​

  • 工作空间点云和可操作度可用于离线评估,但没有公开的生产 SCL 查询入口。
  • 自动运动学参数辨识、外部测量设备联动和一键绝对精度补偿尚未交付。
  • 不公开固定求解时间、成功率或精度;这些指标取决于机型、参数和真实测试。
  • CNC 五轴加工的 G-code 执行链是 P5 预留,与上表“五轴求解器已落地”不是同一件事。

常见问题​

现象检查项
MoveJ 返回非零机器人类型、机械参数、关节轴和目标位姿
MoveL 中途失败直线中间点的逆解、关节限位和奇异位形
模型与实物方向相反关节轴方向和零位偏移
工具位置整体偏移底座位姿和工具坐标标定
7R 肘部构型突变当前关节种子、限位和冗余求解结果
SCARA / Delta 能算不能跑求解器可用;现场 SCL 仍只接索引 0 的 6 轴 DH

相关文档​