机器人控制
本页说明机器人项目中的奇异点、关节限位、TCP 标定、运动方式、速度、协同、安全和现场偏差。它用于路径设计与真机调试;仿真和碰撞检查不能替代安全回路、低速试运行和操作员审批。
什么是奇异点
奇异点是机器人在某些姿态下丧失一个或多个有效运动方向的位置。靠近奇异点时,微小 TCP 运动可能要求很高的关节速度,造成速度超限、轨迹偏差或拒绝执行。
| 类型 | 常见表现 |
|---|---|
| 腕部奇异 | 腕部轴线接近共线,姿态变化引起关节速度突增 |
| 肩部奇异 | TCP 接近基座轴线附近,逆解分支不稳定 |
| 肘部奇异 | 手臂接近完全伸直或折叠,位于工作空间边界 |
处理原则:
- 在规划阶段检查可达性、逆解分支、关节速度和离限位余量。
- 增加引导点或改变工具姿态,避免路径贴着奇异区。
- 关节运动可用于改变姿态,但不能笼统理解为“完全不受奇异影响”。
- 接近奇异区时降低速度,并监视每个关节的速度与报警。
- 任何自动降速或奇异处理都必须用当前机器人模型和真机轨迹验证。
关节超限怎么处理
关节超限表示目标、插补中间点或逆解结果超出项目中该机器人轴的允许范围。
- 在点位和轨迹预览中检查所有关节,而不只看目标 TCP。
- 核对机器人型号、轴方向、零位、减速比和编码器比例。
- 核对工具、工件和基坐标系是否使用正确版本。
- 检查逆解分支是否与当前姿态连续。
- 软限位必须来自机器人手册和现场风险评估,并在机械硬限位前保留经批准的安全余量。
- 需要扩大范围时先确认机械、电缆和驱动器限制,不为通过规划直接放宽参数。
关节限位按项目机器人配置设置,不把某台六轴机器人的角度复制为通用默认值。
如何进行 TCP 标定
TCP 标定用于求工具相对法兰的偏移。使用四点法时:
- 固定一个刚性参考尖点,确认工具和负载安装牢固。
- 从四个差异明显且可安全到达的姿态,让工具尖端接触同一参考点。
- 在工具标定界面逐点采集当前关节位置。
- 计算后检查残差,残差超出项目阈值时不要保存。
- 保存到明确命名和版本化的工具坐标系。
- 用未参与计算的姿态回到参考点,验证位置和姿态变化下的重复性。
标定精度取决于机器人、工具刚度、负载、参考件和采集质量,不能承诺统一的 0.1 mm。采集与保存只使用当前标定界面实际提供的操作。
关节、直线和圆弧运动怎么选
| 运动 | 路径特性 | 常见用途 |
|---|---|---|
| 关节运动 | 各关节按规划轨迹运动,TCP 空间路径通常不是直线 | 空间转移、姿态调整和远离工件的移动 |
| 直线运动 | TCP 按笛卡尔直线插补 | 接近、离开、焊接或涂胶直线段 |
| 圆弧运动 | TCP 按已定义圆弧插补 | 圆弧工艺轨迹 |
实际命令名和参数以 IDE 联想与项目运动库为准。无论哪种运动,都必须检查可达性、关节限位、速度/加速度、工具和工件坐标系以及碰撞风险。
运动速度怎么设置
首次真机运行使用现场安全评估批准的低速和低加速度,并准备有效的急停、使能装置和观察员。不存在适用于所有机器人的固定 5%/10%/100% 表;倍率还要受机器人额定值、负载、工具、工艺、停止距离和人员隔离条件约束。
按以下步骤逐级提高:
- 手动模式验证单点、方向、限位和坐标系。
- 低速空载验证完整路径和停止行为。
- 带实际工具与负载验证姿态、振动和驱动报警。
- 在人员隔离和安全门有效时按工艺要求提高。
- 每级记录最大关节速度、跟随误差、停止距离和热状态。
多机器人如何协调
每台机器人必须有独立状态、目标、限位和安全许可。同步启动、同步到达或路径比例协调只有在当前项目运动库明确提供相应能力并完成真机验证时才能使用;未出现在 IDE 联想和项目配置中的能力不能用于交付。
多机器人共域时还需处理共享工作区互锁、资源占用、通信失效和一台急停对另一台的影响。离线碰撞检查通过不代表真机安全。
仿真和实机有差异怎么办
常见来源包括机械尺寸和零位误差、减速比/编码器比例、工具与工件坐标系、负载重心与惯量、机械间隙、柔性和真实驱动限制。
- 用受控测量更新机器人、工具和工件参数。
- 在多个姿态和工作区位置验证,而不是只补一个固定偏差。
- 区分可重复误差、随位置变化的标定误差和随机机械误差。
- 真机仍需运行时限位、碰撞检测、使能装置和急停。
- 不把仿真通过写成“真机已安全”。
现场调试问题
现场调试通过 IDE 连接 Runtime(DarraLink 18821),不要用 RDP、SSH 登录工控机代替产品通道。
TCP 标定后仍有偏差
按以下顺序区分根因:
| 检查 | 说明 |
|---|---|
| 工具安装 | 松动、变形或带载挠曲会改变 TCP |
| 采集姿态 | 姿态过于相近会使计算条件变差 |
| 参考点 | 四次接触必须是同一稳定物理点 |
| 坐标系 | 确认当前工具、工件和基坐标系版本 |
| 零位与机械参数 | 零位、减速比和机器人模型误差会随姿态变化 |
用多个未参与标定的姿态回到参考点,记录三轴偏差和重复性。合格阈值由项目工艺和测量系统决定,不使用固定 0.5 mm。
零位或关节限位报警
先比较监视值、机械标记、驱动器位置和项目软限位。零位校准必须按机器人与驱动器手册执行,并保持低速、使能装置和人员隔离。不要在不知道机械、电缆和硬限位余量时扩大软限位。
奇异区走不动
保存目标、当前关节、逆解分支、关节速度和报警。通过改变姿态或增加引导点绕开奇异区,并在低速下重新验证。不要假设某个固定关节角适用于所有机器人型号。
负载参数错误导致抖动
核对工具重量、重心、惯量、安装方向和驱动器参数。参数来源可以是工具/机器人手册、受控 CAD 计算或经批准的实测。当前公开能力不承诺自动负载辨识向导;界面中若没有生产调用链,不得把预留入口用于交付。
Q: 使能回路断机器人就停
使能回路 (Enable Chain) 是安全关键信号, 包含:
急停按钮(NC) → 安全门开关(NC) → 三位使能开关(中位) → 驱动器使能
任一安全信号断开后,设备必须按项目风险评估和驱动器安全手册进入规定的安全状态。停止类别、制动和下使能时序不能用一条通用规则替代。
现场调试时机器人"一下使能就停":
| 原因 | 处理 |
|---|---|
| 急停按钮被拍下未复位 | 旋转急停按钮复位, 复位前必须确认安全 |
| 安全门未关好 | 检查安全门开关磁铁/限位到位 |
| 三位开关只按到中位没轻握 | 示教盒三位开关轻握 = 使能, 松开/重按 = 断使能 |
| 急停回路继电器故障 | 用万用表量通断, 老化元件更换 |
| 安全控制配置不一致 | 按项目安全设计核对允许条件和停止类别 |
有些现场为"快速调试"短接急停, 严重违反安全标准, 一旦发生伤害责任人承担全部法律责任。
Q: 机器人与 PLC 协同时序问题
机器人作为 PLC 下的子系统, 常见三信号握手协议:
| PLC → 机器人 | 机器人 → PLC | 含义 |
|---|---|---|
| Start (上升沿) | — | 请求执行 |
| — | Busy | 正在执行 |
| — | Done | 执行完成 (保持到 Start 下降) |
| — | Error | 错误, 带 ErrorCode |
下面使用 C# 风格 SCL 表示常见握手;变量名需映射到当前项目符号:
if (ReadyToPick && !RobotBusy)
{
RobotStart = true;
}
if (RobotDone)
{
RobotStart = false;
PickedCount = PickedCount + 1;
}
if (RobotError)
{
RobotStart = false;
AlarmRobotError = true;
}
时序常见陷阱:
| 陷阱 | 修正 |
|---|---|
| Start 持续置位, 机器人反复启动 | 必须检测上升沿或等待 Done |
| 未等 Done 就发下一个 Start | 增加 !RobotBusy 条件 |
| Busy 和 Done 同时为 TRUE | 状态机设计错误, 只能一个 |
Q: 视觉给坐标但机器人抓偏了
抓偏通常来自三个环节之一: 手眼标定、视觉精度、抓手精度。
排查顺序:
-
固定视觉给的坐标, 不动真实物体, 让机器人去抓
- 如果每次抓到同一位置, 视觉坐标是稳定的
- 机器人系统误差 = 固定偏差, 补偿即可
-
固定视觉视野, 换不同位置的物体
- 视觉每次给的坐标与实际误差一致 = 标定精度问题
- 误差随位置变化 = 视觉畸变 (镜头/标定板)
-
检查手眼标定
- Eye-in-hand: 相机随机器人末端移动, 重新标定
- Eye-to-hand: 相机固定, 标定板在机器人末端多姿态采集
- 标定点
>=9个, 分散在视野内
-
抓手夹具精度
- 夹具本身变形? 换钢制或加厚
- 物体摆放不稳? 加导向结构
- 抓取姿态错误导致物体翻转? 约束摆放方向
Q: 机器人运行后速度降低
持续运行后自动降速通常与驱动器热保护、负载、供电或机械阻力有关。先读取驱动器报警、温度、负载率和跟随误差,再核对工具重量、重心、润滑、散热和环境温度。
预警阈值和降速比例必须来自具体机器人及驱动器手册,并经现场验证;不要把通用温度或固定倍率写进项目。
Q: 机器人断电后再开机位置丢失
绝对位置能否保持取决于编码器类型、备用电源和驱动器配置。出现电池或绝对位置报警时,应按机器人与驱动器手册更换电池、确认零位并完成低速验证;不要在带电状态下按通用步骤拆装。
电池寿命和更换周期以厂商手册、报警状态和现场维护计划为准。
Q: 现场维护周期怎么定
维护周期由机器人、减速机、驱动器、工具和现场环境共同决定,应以各设备手册和风险评估为准。计划至少覆盖清洁与电缆检查、零位与精度、润滑、电池、紧固件、制动器、风扇滤网和安全功能测试,并保留测量记录。