跳到主要内容

MoveC 圆弧运动

圆弧由当前 TCP 起点、一个辅助位姿和一个终点位姿确定。当前可用的 SCL 入口是 MC_MOVE_CIRCULAR。

当前状态

当前现场入口只用于轴组 0 的第一组 6 轴 DH 机器人。机械参数、J1 到 J6 轴或真实反馈不完整时,调用失败。

当前入口​

项内容
名称MC_MOVE_CIRCULAR
签名groupId, viaX, viaY, viaZ, viaRx, viaRy, viaRz, endX, endY, endZ, endRx, endRy, endRz, velocity, acceleration
单位位置毫米,姿态度
返回 0笛卡尔圆弧轨迹已被接受
返回非零未配关节轴或不支持 IK
完成查询现场轴组 0 使用 robot.WaitDone(0)
不要使用robot.MoveC 的单目标形式(无辅助点)

完整合同见单轴运动 API 中的轴组圆弧条目。

几何条件​

圆弧由三个位姿确定:

  1. 起点:调用时轴组的当前 TCP 位姿。
  2. 辅助点:圆弧必须经过的中间位姿;其位置决定圆弧平面和方向。
  3. 终点:运动结束位姿。

起点、辅助点和终点不能共线,也不能过近。姿态从起点向终点插值;圆弧形状主要由三个位置点确定。

当前 SCL 调用​

class CircularPath
{
int Step = 0;
int Rc = 0;

void Execute()
{
switch (Step)
{
case 0:
Rc = MC_MOVE_CIRCULAR(
0,
450.0, 100.0, 400.0, 180.0, 0.0, 180.0,
400.0, 150.0, 400.0, 180.0, 0.0, 180.0,
40.0, 200.0
);
if (Rc == 0)
Step = 10;
else
robot.Stop(0);
break;

case 10:
if (robot.WaitDone(0) == 1)
Step = 20;
break;

case 20:
// 圆弧到位,进入下一道工艺步骤。
break;
}
}
}

Rc == 0 只表示圆弧规划已被接受。不要把非零返回值解释成“已完成”。完成状态走 robot.WaitDone。

不要使用单目标圆弧调用​

当前 robot.MoveC 的签名是 robot.MoveC(arm, X, Y, Z, Rx, Ry, Rz, velocity),只有一个目标点,不能表达辅助点,因此不能唯一确定圆弧。生产程序使用 MC_MOVE_CIRCULAR。

全圆的编排​

起点和终点完全重合时不能唯一确定圆弧方向。当前没有 FullCircle、圆心模式或圈数参数;需要整圆时,将圆周拆成两个或更多经过不同辅助点的 MC_MOVE_CIRCULAR 段,并逐段确认完成。每段都必须先在仿真中验证圆弧方向和可达性。

连续圆弧与姿态边界​

当前入口没有混合半径、缓冲模式、姿态模式、顺逆时针或路径法向参数。多段圆弧应逐段执行;前瞻和连续拐角平滑仍是 P4 推进。

姿态由起点向终点插值。若工艺要求工具严格跟随切线或曲面法向,应先离散检查整段姿态;当前参数不能表达该要求时,不得进行真机验收。

工艺程序的状态顺序​

圆弧焊、圆周涂胶等工艺至少应拆为:安全接近 → 直线到起点 → 工艺允许条件 → 圆弧运动 → 确认完成 → 关闭工艺输出 → 安全撤回。所有 IO 都通过项目过程映像和安全逻辑处理;当前圆弧调用没有距离触发输出参数。

辅助点选择​

  • 辅助点应位于预期弧线上,并与起点、终点保持足够的几何间距。
  • 三点近似共线时,当前规划器可能退化为直线;生产程序应在提交前把它视为无效圆弧并阻止运行。
  • 辅助点过近会放大测量误差。优先在预期圆弧的中部选点,并在 3D 仿真中确认方向。
  • 当前入口不提供圆心模式或显式方向标志,圆弧方向由辅助点位置确定。
仿真不是安全证明

离线圆弧方向正确,不代表真机安全。真机仍需低速度倍率、硬件急停和操作员确认。CNC 圆弧插补(G02/G03)的独立 G-code 执行链是 P5 预留。

排查顺序​

  1. 返回非零:检查轴组、运动学、关节轴登记和三个位姿维度。
  2. 轨迹方向不对:移动辅助点到预期弧的另一侧,不要查找当前不存在的方向参数。
  3. 圆弧中途不可达:逐点检查逆解、关节限位和奇异位形。
  4. 路径变成直线:检查三点是否近似共线,并在程序提交前做几何校验。
  5. 多段之间停顿:前瞻和平滑转接仍是 P4。
  6. 工艺质量波动:先核对真实 TCP 反馈、实际速度、IO 时序和驱动器状态,不用命令值代替反馈。

相关文档​