🤖 roboto_origin_03 Wiki
首页 / 硬件 / 机械限位与安全防护措施

机械限位与安全防护是双足人形机器人从实验室样机走向可靠运行平台的核心工程课题。Roboto Origin V2.0 在 V1.0 的基础上,对机械硬限位、软件软限位与电气急停防护进行了系统性重构:限位销数量从 2 件增至 4 件并覆盖手臂与腿部双链;腰部新增机械限位块将偏航自由度约束在约 ±120°;背板集成物理急停按钮;同时 URDF 层对各关节的运动范围进行了更精细的重新标定。本文档面向高级开发者,从机械结构、软件配置与操作规范三个维度,剖析 V2.0 的限位与安全体系的设计原理、实现细节与使用约束。

安全防护体系总体架构

Roboto Origin V2.0 的安全防护体系采用 "机械硬限位 → 软件软限位 → 电气急停" 三级纵深防御架构。机械硬限位通过物理结构(限位销、限位块)在关节到达危险姿态前提供不可逆的物理阻挡;软件软限位在控制层通过 URDF joint limit 与驱动器参数限制电机的指令输出范围;电气急停则在异常工况下通过物理开关切断主电源,使机器人立即失能。三者互为冗余,确保单点失效不会导致人身伤害或结构损坏。

graph TD
    A[机器人运行] --> B{异常检测}
    B -->|机械干涉| C[机械硬限位<br/>限位销/限位块]
    B -->|指令越界| D[软件软限位<br/>URDF joint limit<br/>驱动器保护]
    B -->|失控/急停| E[电气急停<br/>背板急停按钮<br/>手柄X键失能]
    C --> F[物理阻挡<br/>防止结构损坏]
    D --> G[指令截断<br/>防止电机过载]
    E --> H[主电源切断<br/>全身失能]
    F --> I[安全状态]
    G --> I
    H --> I

该架构的核心理念是:任何控制算法或软件逻辑的失效,都不应突破最底层的机械硬限位;任何机械结构的磨损,都不应绕过电气急停的最终保护。

Sources: 安装手册_0428.pdf, roboto_origin.urdf

插销式机械标定与限位

插销式机械标定是 V2.0 引入的一种具有较高重复性的零位对齐方案。与 V1.0 仅在大腿部位使用 2 个限位销不同,V2.0 的限位销配置扩展至四肢,BOM 中限位销数量从 2 件增加至 4 件,分别用于手臂与腿部的姿态约束。

限位销规格与物料

V2.0 采用两种规格的圆柱定位销,均以 6061 铝合金为基材,经 120 目喷砂与黑色阳极氧化表面处理:

规格 数量 应用部位 功能说明
M4×18 2 件 手臂关节 手臂定位销插入,约束肩关节/肘关节相对位置
M4×22 2 件 腿部关节 腿部定位销插入,约束大腿与小腿相对位置

BOM 中为两种长度提供了冗余选型,使用者可根据实际加工公差与装配干涉情况自行选择合适长度。限位销零件代号为 RB000172_01,工程图纸中标注关键尺寸公差为 Φ8(-0.10/0)。

Sources: [萝博头原型机(RoboParty Roboto Origin)散件清单 V1.1.3.xlsx](V2.0/roboto_origin_mechanic/00_Docs/萝博头原型机(RoboParty Roboto Origin)散件清单 V1.1.3.xlsx), RB000172_01_限位销.pdf

安装位置与标定流程

手臂限位销与腿部限位销的安装位置呈镜像对称分布。标定操作需在机器人未上电状态下进行,具体流程如下:

flowchart LR
    A[准备限位销] --> B{区分规格}
    B -->|M4×18| C[插入手臂标定孔]
    B -->|M4×22| D[插入腿部标定孔]
    C --> E[检查转动自由度是否受限]
    D --> E
    E -->|受限| F[标定完成]
    E -->|未受限| G[调整深度或更换销钉]
    G --> E

需要特别指出的是,插销式标定对零部件的制造公差要求较高,包括尺寸误差、位置误差及形状误差。由于不同加工供应商与批次之间的工艺差异,实际零件可能出现圆柱定位销无法顺利插入、或虽可插入但无法完全插入至设计深度的情况。当插入定位销后,若转动相关关节发现其转动自由度已被限制,即可认为标定定位已经完成,无需强行插入至理论极限位置。若手动无法插入,可使用橡胶锤轻敲;若难以拔出,可借助尖嘴钳等工具。

Sources: 安装手册_0428.pdf

V1.0 与 V2.0 插销限位的关键差异

V1.0 的限位销仅用于腿部大腿左下与右上两个孔位(共 2 个),在完成标定后通过 M4×14 杯头螺丝固定。V2.0 将这一思路扩展至手臂,形成了四肢全链路的机械标定能力,使得整机零位标定的重复精度与可操作性显著提升。对于需要频繁拆装关节进行教学实验的场景,V2.0 的四销方案能有效缩短维护后的重新标定时间。

Sources: Assembly_Guide_v1.14.pdf, BOM_Mechanical.xlsx, 限位销.pdf

腰部关节机械限位

腰部 yaw 关节是连接下半身与上半身的核心自由度,其失控可能导致上半身过度旋转,拉扯内部线束并造成结构干涉。V2.0 在该部位引入了机械限位块设计,这是 V1.0 所不具备的重要安全改进。

限位块结构原理

腰部关节的限位与定位通过 "腰部支撑结构"(RB000174_03)"电池底盖"(RB000159_02) 上的限位槽/限位块共同实现。腰部支撑零件上设有轴承固定限位槽,电池底盖上对应设有限位凸块。若装配位置正确,上半身在顺时针或逆时针方向转动约 ±120° 时即可与限位结构接触,从而将腰部 yaw 关节的机械运动范围约束在 240° 以内。

安装方向约束

腰部支撑与电池底盖的安装具有严格的方向性,装反将导致限位功能失效:

两者配合后,在视觉上形成前后互补的阻挡面,确保无论上半身向哪个方向旋转,都会在到达约 120° 时遇到物理阻挡。

Sources: 安装手册_0428.pdf, RB000174_03_腰部支撑.pdf, RB000159_02_电池底盖.pdf

软件层关节限位保护

机械硬限位是最后一道防线,而日常运行中首要依赖的是软件层的 joint limit 保护。V2.0 的 URDF 模型对所有 23 个关节均配置了 <limit> 标签,约束各关节的 lower/upper 范围、最大力矩(effort)与最大角速度(velocity)。

V2.0 关节限位配置总览

以下表格汇总了 V2.0 URDF 中各关节的软件限位参数:

关节名称 类型 Lower (rad) Upper (rad) Effort (N·m) Velocity (rad/s)
left_thigh_yaw_joint 腿部 -1.00 0.20 80 10.47
left_thigh_roll_joint 腿部 -0.20 1.00 80 10.47
left_thigh_pitch_joint 腿部 -1.57 1.57 80 10.47
left_knee_joint 腿部 -0.20 2.50 80 10.47
left_ankle_pitch_joint 腿部 -0.60 0.60 18 3.7692
left_ankle_roll_joint 腿部 -0.50 0.50 18 3.7692
right_thigh_yaw_joint 腿部 -0.20 1.00 80 10.47
right_thigh_roll_joint 腿部 -1.00 0.20 80 10.47
right_thigh_pitch_joint 腿部 -1.57 1.57 80 10.47
right_knee_joint 腿部 -0.20 2.50 80 10.47
right_ankle_pitch_joint 腿部 -0.60 0.60 18 3.7692
right_ankle_roll_joint 腿部 -0.50 0.50 18 3.7692
torso_joint 腰部 -3.14 3.14 80 10.47
left_arm_pitch_joint 手臂 -1.57 1.57 18 3.7692
left_arm_roll_joint 手臂 -0.25 1.00 18 3.7692
left_arm_yaw_joint 手臂 -1.57 1.57 18 3.7692
left_elbow_pitch_joint 手臂 -0.60 1.57 18 3.7692
left_elbow_yaw_joint 手臂 -1.57 1.57 18 3.7692
right_arm_pitch_joint 手臂 -1.57 1.57 18 3.7692
right_arm_roll_joint 手臂 -1.00 0.25 18 3.7692
right_arm_yaw_joint 手臂 -1.57 1.57 18 3.7692
right_elbow_pitch_joint 手臂 -0.60 1.57 18 3.7692
right_elbow_yaw_joint 手臂 -1.57 1.57 18 3.7692

值得注意的是,URDF 中 torso_joint 的软件限位为 ±3.14 rad(±180°),但实际机械结构通过腰部支撑与电池底盖的限位块将其约束为约 ±120°。这意味着软件限位在此关节上不构成首要约束,机械硬限位才是真正的安全边界。开发者在进行二次开发时,应避免在控制算法中依赖 URDF 的 ±180° 范围,而应以机械限位块的 ±120° 为实际运动边界。

Sources: roboto_origin.urdf

V1.0 与 V2.0 软件限位的关键调整

V2.0 对多项关节的软件限位进行了收紧或重新平衡,反映了在实际运行中发现的结构干涉与电机负载问题:

关节 V1.0 Lower/Upper V2.0 Lower/Upper 调整说明
left_thigh_pitch -1.0 / 1.0 -1.57 / 1.57 范围扩大,匹配实际结构行程
left_knee -1.5 / 1.5 -0.2 / 2.5 非对称调整,避免膝关节反曲
left_ankle_pitch -1.5 / 1.3 -0.6 / 0.6 大幅收紧,防止脚踝过度翻转
right_ankle_pitch -1.5 / 1.3 -0.6 / 0.6 大幅收紧,防止脚踝过度翻转
left_elbow_pitch -0.6 / 3.14 -0.6 / 1.57 上限从 180° 收紧至 90°
right_elbow_pitch -0.6 / 3.14 -0.6 / 1.57 上限从 180° 收紧至 90°

上述调整表明,V1.0 部分关节的软件限位过于宽松,未能反映真实机械结构的干涉边界。V2.0 通过缩小脚踝 pitch 与肘部 pitch 的范围,降低了步态推理或遥控操作中因指令越界导致结构碰撞的风险。

Sources: Atom01_urdf.urdf, roboto_origin.urdf

电气与操作安全防护

背板急停与开关系统

V2.0 在机器人背部集成了两类关键电气控件:金属按钮开关急停按钮。金属按钮开关用于日常的功能触发(如电源指示、模式切换),而急停按钮则用于紧急工况下的主电源切断。

急停按钮的安装具有明确的机械要求:外部螺纹需拧紧固定,内部电路板需使用卡扣夹紧在机器人背部,确保在高频振动或意外碰撞下不会发生松动。建议开发者在进行二次开发时,将急停回路设计为常闭触点串联在主电源正极回路中,确保任何线缆松脱或触点失效都会导致电源断开,符合故障安全(Fail-Safe)原则。

Sources: 安装手册_0428.pdf

核心安全作业规程

装配与调试阶段的安全规程是防止人身伤害的第一道屏障。V2.0 安装手册中明确强制执行以下规程:

断电作业原则:关节的安装、调试与更换,必须在急停按下且断开电源的状态下进行。严禁带电插拔电机或触碰电池接口。

防夹手规范:严禁将手指伸入关节活动的缝隙或限位槽内。限位销安装/拔出过程中,关节可能因重力滑落或惯性闭合,造成手指挤压骨折。手动盘车时需佩戴防护手套,并确保有第二人在场监护。

悬空标零与吊架保护:电机使能、零位初始化与 Reset 操作均涉及扭矩瞬间输出,必须在配备承重安全吊架的受控场地内进行。Reset 前需手动干预肢体,保证物理姿态与预设零位姿态尽可能相近;若偏差过大,Reset 瞬间的阶跃响应极易扯坏电机减速器与结构件。

电池安全:电池组为高能量密度锂电池,跌落高度超过 30cm 或受到剧烈撞击后严禁再次装机,必须隔离观察 24 小时。电池插头在未连接主板前必须保留原厂护套或贴绝缘胶带,严禁裸露正负极。

Sources: 安装手册_0428.pdf

异常响应与应急处置

在运行阶段,操作员需遵循 "物理急停至上" 原则。遇到不可控的关节抖动、步态偏离或结构干涉时,优先按下遥控手柄的 "X" 键触发软件失能;若软件失控,立即拍下物理急停开关切断主电源。

对于二次开发者,官方协议强制要求:任何修改后的代码部署至物理样机前,必须在仿真环境中进行充分验证,并确保软件层的急停(E-Stop)逻辑和硬件层的限流、限位保护机制始终有效。这是 V2.0 安全协议中的核心工程条款,不可绕过。

Sources: 安装手册_0428.pdf

V1.0 与 V2.0 限位与安全设计演进总结

维度 V1.0 V2.0 工程意义
限位销数量 2 件(仅腿部) 4 件(手臂+腿部) 四肢全链路机械标定,维护后复装效率提升
腰部机械限位 腰部支撑+电池底盖限位块(±120°) 防止上半身过度旋转,保护内部线束
背板急停 未明确集成 急停按钮+金属按钮开关 实现物理层面的紧急失能
脚踝软件限位 ±1.5 rad / ±1.3 rad ±0.6 rad 大幅收紧,防止步态中脚踝过度翻转导致失稳
肘部软件限位 -0.6 / +3.14 rad -0.6 / +1.57 rad 避免手臂结构干涉,降低减速器扫齿风险
安全标定流程 基础标定说明 插销标定+3D打印件标定+PPT 详解 多方案互补,降低单点标定失效风险

V2.0 的安全演进体现了从 "功能实现""失效安全" 的设计范式转变:不再假设控制算法始终正确,而是通过机械硬限位、软件软限位与电气急停的三级冗余,确保系统在极端工况下仍能将风险收敛到可控范围内。

Sources: 安装手册_0428.pdf, Assembly_Guide_v1.14.pdf, roboto_origin.urdf, Atom01_urdf.urdf

延伸阅读与调试前置条件

理解机械限位与安全防护措施后,建议按以下顺序继续深入:

在进行任何实机调试前,请务必确认:机械硬限位已正确装配、软件 joint limit 已按本章节参数配置、急停回路经手动测试有效。三者缺一不可。