机器人 / 系统课时

配置关节限位与初始安全姿态

配置关节限位与初始安全姿态

本课把导入的六轴机械臂模型调整到可开展仿真点动的状态:先核对 J1~J6 的顺序和正方向,再设置位置边界、保存初始关节角,最后通过单轴运动与越界请求检查配置是否真正生效。

学习目标

  • 沿运动链识别六个关节,核对转轴、正方向与角度单位。
  • 区分模型硬限位和控制层软限位,配置并检查关节范围。
  • 保存经过碰撞检查的起始姿态,完成点动和越界验收。

核对关节链与旋转方向

在仿真器的模型树里,从基座沿父子连杆逐个找到六个驱动关节,核对 J1 基座、J2 肩、J3 肘及 J4~J6 腕部的对应关系。检查关节轴线和正角方向;使用 URDF 时,<axis xyz="..."> 定义关节坐标系中的转轴,<origin> 的姿态会影响它在空间中的朝向。

在仅连接仿真模型的关节点动模式下,从无碰撞的初始位置每次只让一个关节相对转动 +5°,记录法兰运动方向,再转回 -5°。如果方向与设备手册不符,先检查轴符号、父子关节和导入时的坐标变换,不要把全部角度直接取负。

配置模型边界与软件软限位

模型中的位置限位应以所选机器人型号的技术手册为依据。软件软限位通常比模型边界略窄,并且必须由实际使用的运动控制或轨迹规划通道执行。下表全部是教学假设值,不对应任何真实型号,5° 的收缩量也不是通用安全标准。

关节 模型限位(°) 软件软限位(°) 候选初始角(°)
J1 -170~170 -165~165 0
J2 -110~110 -105~105 -30
J3 -135~145 -130~140 60
J4 -180~180 -175~175 0
J5 -120~120 -115~115 30
J6 -360~360 -355~355 0

六轴关节正方向、限位区间与初始姿态的对应关系

若模型使用 URDF,以下是已有 joint_2 的 <joint> 元素内部的片段示例,不能作为完整机器人模型单独导入;保留原关节的父子连杆、坐标原点与轴向定义,仅按手册修改对应 <limit>。

xml
<limit lower="-1.919862" upper="1.919862"
       effort="100" velocity="1.0" />

这里 lower 和 upper 约对应 ±110°;对于旋转关节,effort 用 N·m,velocity 用 rad/s,示例值 100 和 1.0 不是实机额定值。重新导入后检查显示的 J2 范围。URDF 的 <limit> 不代表软限位自动生效;还需在仿真器支持的控制器或运动规划配置中启用 -105°~105° 的命令边界并验证。

保存经过检查的起始姿态

依表将六轴角度设成 (0, -30, 60, 0, 30, 0)°。这只是候选值,具体机械臂可能不可达或与工位碰撞;不能因各角都落在限位内就把它称为安全位。首先启用机器人本体、夹爪、输送线及夹具的碰撞体,再检查自碰撞和环境碰撞,并确认工具末端未进入工件或禁入区。

通过检查后,将这组六轴关节角保存为命名姿态 SimHome,连同机器人模型版本、工具配置和工位文件一起保存。保存关节角而非只保存 TCP 笛卡尔坐标,才能在重新打开项目时复现同一关节构型。SimHome 不等同于机械零位、校零操作或实机允许的安全待机位。

用点动和越界请求验收

  1. 重新加载工位并恢复 SimHome,确认六轴显示角度与保存值相符;本练习可用 0.1° 作为读数允许误差。
  2. 保持仿真碰撞检测开启,逐轴用低速执行相对 +5°、-5° 点动;记录正方向、能否回位以及有无碰撞。
  3. 在离线目标检查或轨迹预览中提交 J2=106° 的目标,预期被 -105°~105° 软限位拒绝或截断。若仍能生成越界轨迹,说明该命令通道没有执行软限位;不要连接真实控制柜尝试。
  4. 记录机器人型号、J1~J6 轴序、模型限位、软限位、SimHome 角度及各项验收结果,作为后续工位联调的配置基线。

下面的 Python 3 程序可独立运行,用同一组教学数据演示“发送命令前检查目标角度”;它只验证数值,不会更改仿真器或实机的限制。

python
names = ("J1", "J2", "J3", "J4", "J5", "J6")
# 教学用软限位,角度单位统一为度
soft = ((-165, 165), (-105, 105), (-130, 140),
        (-175, 175), (-115, 115), (-355, 355))
home = (0, -30, 60, 0, 30, 0)

def check(pose):
    if len(pose) != len(names):
        return "REJECT: 关节数量错误"
    # 每个轴独立验界,避免仅检查末端位姿而漏掉关节越界
    for name, angle, (lo, hi) in zip(names, pose, soft):
        if not lo <= angle <= hi:
            return f"REJECT: {name}={angle}° 超出 [{lo}, {hi}]°"
    return "PASS: 全部关节处于软限位内"

print("SimHome:", check(home))
bad = list(home)
bad[1] = 106
print("越界请求:", check(bad))

预期输出:

text
SimHome: PASS: 全部关节处于软限位内
越界请求: REJECT: J2=106° 超出 [-105, 105]°

若 +5° 的方向反了,优先排查转轴和关节局部坐标;若限位数值相差约 57.3 倍,排查度与弧度转换;若目标已越过软限位但仍可运动,检查实际执行命令的控制器是否读取了限制配置。仿真软限位和离线校验都不能替代实体机器人的安全回路、急停与现场风险评估。

按自己的节奏,确认真正理解。

目录与阅读设置

阅读设置

17

记录一个想法

配置关节限位与初始安全姿态

0 / 10000 · 笔记保存到账号。未提交的修改会在关闭、离开或刷新后丢失。

登录哪都通