机器人编程
机器人编程用于在机器人、关节轴和坐标系配置完成后组织运动顺序;新程序应先在离线视图检查,再以低速度倍率逐段验证真机动作。
当前公开的机器人入口
当前现场机器人入口只用于索引 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 没有工具或工件坐标系切换调用,运动目标按项目当前配置解释。
安全与故障处理
- 急停、安全门和使能装置必须由合格的外部安全回路实现。
- 软件
Power、Reset和Stop是控制命令,不是安全认证功能。 - 任一运动返回失败时停止后续步骤,记录日志并报警。
- 首次真机运行应降低速度倍率,逐段确认点位、姿态、关节限位和工装间隙。
- 离线碰撞检查只用于发现几何问题,不能替代真机风险评估。仿真或数字孪生通过,不代表真机安全;真机仍需碰撞复核、硬件急停和操作员确认。