跳到主要内容

机器人编程

机器人编程用于在机器人、关节轴和坐标系配置完成后组织运动顺序;新程序应先在离线视图检查,再以低速度倍率逐段验证真机动作。

当前公开的机器人入口​

当前现场机器人入口只用于索引 0 的第一组 6 轴 DH 机器人。其他索引和机器人构型不能按在线能力使用。

入口参数返回值与用途
robot.Arm(id)常量机器人索引取得静态机器人句柄
robot.Power(robot, enable)机器人索引、使能值整组使能或失能;负值表示不可用或失败
robot.Reset(robot)机器人索引整组故障复位;复位不替代安全确认
robot.SetSpeed(robot, percent)机器人索引、速度倍率影响后续新提交的机器人运动
robot.MoveJ(robot, X, Y, Z, Rx, Ry, Rz, velocity)目标 TCP 位姿、速度提交关节空间 PTP 运动
robot.MoveL(robot, X, Y, Z, Rx, Ry, Rz, velocity)目标 TCP 位姿、速度提交笛卡尔直线运动
robot.WaitDone(robot)机器人索引1 已完成,0 运动中,负值表示不可用
robot.Stop(robot)机器人索引提交整组受控停止
robot.ReadPos(robot, register)机器人索引、目标寄存器基址读取关节反馈和当前位姿,返回执行结果

robot.MoveC 的单目标形式不能表达辅助点,当前不作为生产圆弧入口。圆弧请使用 MoveC 中的三点轴组调用。

机器人程序使用 SCL 或 LAD 编写,项目文件扩展名为 .dplc。不支持导入或导出 RAPID、KRL、INFORM 或 Fanuc TP 等竞品工程;后置代码生成仍在规划中。

非阻塞编程规则​

  • 运动命令只负责提交或轮询,不能用死循环等待机械到位。
  • 提交成功后进入独立步骤,再用 robot.WaitDone 判断完成。
  • 每次检查返回值;负值不能当作“已完成”。
  • 到位条件应结合真实反馈、状态字、工艺 IO 和项目安全逻辑。
  • PLC 调试使用监视、趋势、日志和报警,不使用断点或单步。

取放状态机​

下面示例只演示当前入口的调用顺序。夹爪变量应在项目中映射到真实输出,并受安全条件约束。

class PickAndPlace
{
int Step = 0;
int Result = 0;
bool GripClosed = false;
bool CycleEnabled = true;
string Status = "待机";

void Execute()
{
if (!CycleEnabled)
{
robot.Stop(0);
Status = "停止";
return;
}

switch (Step)
{
case 0:
Result = robot.Power(0, true);
if (Result == 0)
{
Step = 10;
}
break;

case 10:
Result = robot.SetSpeed(0, 25.0);
if (Result == 0)
{
Step = 20;
}
break;

case 20:
Result = robot.MoveJ(0, 450.0, 0.0, 520.0, 180.0, 0.0, 180.0, 100.0);
if (Result >= 0)
{
Step = 30;
}
break;

case 30:
if (robot.WaitDone(0) == 1)
{
Step = 40;
}
break;

case 40:
Result = robot.MoveL(0, 450.0, 0.0, 420.0, 180.0, 0.0, 180.0, 30.0);
if (Result >= 0)
{
Step = 50;
}
break;

case 50:
if (robot.WaitDone(0) == 1)
{
GripClosed = true;
Status = "已取料";
Step = 60;
}
break;

case 60:
Result = robot.MoveL(0, 450.0, 0.0, 520.0, 180.0, 0.0, 180.0, 30.0);
if (Result >= 0)
{
Step = 70;
}
break;

case 70:
if (robot.WaitDone(0) == 1)
{
Status = "已撤回";
Step = 80;
}
break;
}
}
}

单轴入口​

单轴场景使用当前 MC_* 函数,并直接检查返回值和真实反馈。

用途当前调用
使能MC_POWER(axis, enable)
回零MC_HOME(axis)
绝对定位MC_MOVE_ABS(axis, position, velocity)
相对定位MC_MOVE_REL(axis, distance, velocity)
速度模式MC_MOVE_VEL(axis, velocity)
点动MC_JOG(axis, direction, velocity)
受控停止MC_STOP(axis)
故障复位MC_RESET(axis)
读位置、速度、状态MC_READ_POS(axis) / MC_READ_VEL(axis) / MC_READ_STS(axis)
设置软件位置MC_SET_POS(axis, position)
class AxisPositioning
{
int Step = 0;
int Result = 0;
double ActualPosition = 0.0;

void Execute()
{
switch (Step)
{
case 0:
Result = MC_POWER(1, true);
if (Result == 0)
{
Step = 10;
}
break;

case 10:
Result = MC_MOVE_ABS(1, 100.0, 25.0);
if (Result == 0)
{
Step = 20;
}
break;

case 20:
ActualPosition = MC_READ_POS(1);
if (ActualPosition >= 99.9 && ActualPosition <= 100.1)
{
Step = 30;
}
break;
}
}
}

读取反馈失败时可能得到无效数值;不要把无反馈替换为零,也不要用命令值回显冒充实际位置。

轨迹选择​

  • MoveJ:安全空行程和姿态转换,速度快,但 TCP 中间路径不固定。
  • MoveL:接近、撤回和直线工艺段,整条直线都要检查可达性和奇异位形。
  • MoveC:当前使用起点、辅助点和终点定义圆弧。
  • 样条、NURBS、连续 Zone、轨迹前瞻:规划中,不能作为已交付指令。
  • 电子齿轮、电子凸轮、相位和力矩控制:尚未作为现场功能交付。

坐标系边界​

工具和工件坐标系可在 IDE 中标定并保存。当前 SCL 没有工具或工件坐标系切换调用,运动目标按项目当前配置解释。

安全与故障处理​

  1. 急停、安全门和使能装置必须由合格的外部安全回路实现。
  2. 软件 Power、Reset 和 Stop 是控制命令,不是安全认证功能。
  3. 任一运动返回失败时停止后续步骤,记录日志并报警。
  4. 首次真机运行应降低速度倍率,逐段确认点位、姿态、关节限位和工装间隙。
  5. 离线碰撞检查只用于发现几何问题,不能替代真机风险评估。仿真或数字孪生通过,不代表真机安全;真机仍需碰撞复核、硬件急停和操作员确认。

相关文档​