Manuel 1.0 人臂尺度开源机械臂 复刻全流程
Manuel 1.0 人臂尺度开源机械臂 从采购、打印、组装到装软件、标定和训练的 58 个步骤,附物料表、购买链接与官方出处。
创作者 README 物料表合计 2,309.72 美元(美国零售价,不含税费与运费,作者注明因地区而异),其中舵机与电子件 2,020.61 美元,PLA 耗材 27.98 美元已计入;不含 3D 打印机与工具,无官方套件售价
采购
- 采购电机和硬件
采购2个DYNAMIXEL XM540-W270-T、3个DYNAMIXEL XM430-W350-T、2个DYNAMIXEL XL430-W250-T和1套包含U2D2 USB转换器的DYNAMIXEL starter set。还需采购1个95x120x13mm轴承、10个30x42x7mm轴承、4个17x23x4mm轴承、1根带滑块的100mm直线导轨、1个MGN9C滑块、81个M3x6mm热熔螺母、89个M3x5mm螺丝、4个M3x7mm螺丝和4个M3六角螺母。
打印与加工
- 打印所有零件
除齿轮外,所有零件都使用0.2mm Standard 3D打印机设置。齿轮的墙循环数增加到4,以尽量填满所有齿。
组装
- 清理螺丝孔
如果打印件螺丝孔内有悬垂塑料,先用小号内六角扳手强行穿过孔,再用更大的内六角扳手重复操作,直到螺丝能够装入。
- 准备所需工具
准备带USB端口的电脑、可打印PLA且打印床至少17 cm x 17 cm的3D打印机、烙铁、可压接JST SEH-001T-P0.6的压接工具、剥线钳、2mm十字螺丝刀、1.5mm、2.0mm、2.5mm和4mm内六角扳手、钳子、一字螺丝刀以及台夹。
- 识别线缆端头编码
FEH 表示 Female JST EH,FSM 表示 Female JST-SM,MSM 表示 Male JST-SM。
- 制作三线 JST EH 线缆
所有线缆均包含 3 根导线,所有 F/M 端头均使用 3 针 JST EH 连接器。
- 检查电机附带线缆
许多 Dynamixel 电机附带 18 cm 公对母 JST-EH 线缆,因此 FEH-18-FEH 无需自行制作。
- 安装基座 U2D2
在基座至末端顺序中的第一个位置使用带 USB 连接器的 U2D2。
- 安装 FEH-18-FSM 线缆
在基座至末端顺序中安装 18 cm 的 FEH-18-FSM 线缆。
- 安装 MSM-10-FEH 线缆
在基座至末端顺序中安装 10 cm 的 MSM-10-FEH 线缆。
- 安装腰部 XM430 电机
将 XM430-W350-T 电机安装在标记为 waist 的腰部位置。
- 安装 FEH-13-MSM 线缆
在基座至末端顺序中安装 13 cm 的 FEH-13-MSM 线缆。
- 安装 FSM-12-FEH 线缆
在基座至末端顺序中安装 12 cm 的 FSM-12-FEH 线缆。
- 安装肩部 XM540 电机
将 XM540-W270-T 电机安装在标记为 shoulder 的肩部位置。
- 安装 FEH-40-FSM 线缆
安装 40 cm 的 FEH-40-FSM 线缆;如果使用了不同长度的挤压件,则改变线缆长度。
- 安装 MSM-17-FEH 线缆
在基座至末端顺序中安装 17 cm 的 MSM-17-FEH 线缆。
- 安装肘部 XM540 电机
将 XM540-W270-T 电机安装在标记为 elbow 的肘部位置。
- 安装 FEH-32-MSM 线缆
在基座至末端顺序中安装 32 cm 的 FEH-32-MSM 线缆。
- 安装 FSM-18-FEH 线缆
安装 18 cm 的 FSM-18-FEH 线缆;如果使用了不同长度的挤压件,则改变线缆长度。
- 安装第一腕关节电机
将 XM430-W350-T 电机安装在标记为 wrist 1 的第一腕关节位置。
- 安装 FEH-18-FEH 线缆
在基座至末端顺序中安装 18 cm 的 FEH-18-FEH 线缆;若 Dynamixel 电机已附带该线缆,则无需制作。
- 安装第二腕关节电机
将 XM430-W350-T 电机安装在标记为 wrist 2 的第二腕关节位置。
- 安装 FEH-21-FEH 线缆
在基座至末端顺序中安装 21 cm 的 FEH-21-FEH 线缆。
- 安装第三腕关节电机
将 XL430-W350-T 电机安装在标记为 wrist 3 的第三腕关节位置。
- 安装 FEH-15-FEH 线缆
在基座至末端顺序中安装 15 cm 的 FEH-15-FEH 线缆。
- 安装夹爪 XL430 电机
将 XL430-W350-T 电机安装在标记为 gripper 的夹爪位置。
- 连接双模主从 Dynamixel
使用 Sync Cable 将 Slave DYNAMIXEL 连接到 Master DYNAMIXEL;普通 Sync Cable 使两者同向转动,绞合 Sync Cable 使两者反向转动。Slave DYNAMIXEL 直接由 Master 通过 Sync Cable 输出的 PWM 控制,其 Goal Position、Goal Velocity、Goal Current 和 Goal PWM 均被忽略。
- 安装双模机架
使用适当的机架将 Master 和 Slave DYNAMIXEL 物理连接。如果未通过机架连接,两者可能因各自承受的负载而无法完全同步。
- 连接 U2D2 USB 转换器
将 U2D2 USB 转换器连接到机器人、电源插座和电脑,然后打开开关。
软件与固件
- 安装 Dynamixel SDK
安装 `dynamixel-sdk`,确保 `dynamixel_sdk` 可用。
- 设置 USB 端口
在 `config.json` 中,将 `usb_port` 设置为 U2D2 模块所连接的 USB 端口名称。
- 断开其他机器人连接
确保电脑上没有其他应用连接机器人。如果 Dynamixel Wizard 已连接,请点击断开按钮或关闭该程序。
标定与测试
- 设置返回延迟时间
将 Return Delay Time(9) 设置为 0 至 254(0XFE),单位为 2 [μsec]。例如设置为 10 时,状态包将在收到指令包后 20 [μsec] 返回。
- 配置驱动模式
Set Drive Mode(10) to configure the Drive Mode of the DYNAMIXEL. Time-based Profile requires firmware V42 or later, and Torque On by Goal Update requires firmware V45 or later.
- 设置正反转方向
将 Drive Mode(10) 的 Bit 0(Normal/Reverse Mode)设置为 1,使旋转方向反转。此设置会同时反转 Position、Velocity、Current 和 PWM 的方向,可用于对称关节配置。
- 分配共享的 Secondary ID
为多个 DYNAMIXEL 分配相同的 Secondary ID(12),以便分组并同步运动。每个 DYNAMIXEL 的 ID(7) 必须唯一且不能重叠。
- 应用 ID(7) 的优先顺序
如果 Secondary ID(12) 与 ID(7) 设置为相同值,则优先应用 ID(7)。
- 仅通过 Secondary ID 修改 RAM
Secondary ID(12) 可以修改 Control Table 的 RAM 区域,但不能修改 EEPROM 区域。
- 将 Secondary ID 设为 253 以下
将 Secondary ID(12) 设置为 253 或更高值会停用 Secondary ID 功能,因此应使用低于 253 的值。
- 避免指令 ID 与 Secondary ID 相同
如果 Instruction Packet ID 与 Secondary ID(12) 相同,则不会返回 Status Packet。
- 将五个 Secondary ID 设为 5
将五个 DYNAMIXEL 的 Secondary ID(12) 设为 5。它们分配的 ID(7) 分别为 1、2、3、4、5,且互不重叠。
- 用 ID 1 点亮 LED
发送 Write Instruction Packet,将 ID(7) 设为 1、LED(65) 设为 1。ID 为 1 的 DYNAMIXEL 会点亮 LED,并返回 Status Packet。
- 用 Secondary ID 点亮全部 LED
发送 Write Instruction Packet,将 ID(7) 设为 5、LED(65) 设为 1。所有 DYNAMIXEL 都会点亮 LED,但只返回 ID 5 的 Status Packet。
- 将所有 Secondary ID 改为 100
将所有 DYNAMIXEL 的 Secondary ID(12) 改为 100。
- 用 ID 100 熄灭全部 LED
发送 Write Instruction Packet,将 ID(7) 设为 100、LED(65) 设为 0。所有 DYNAMIXEL 都会熄灭 LED;由于没有 DYNAMIXEL 使用主 ID 100,只共享相同的 Secondary ID,因此不会返回 Status Packet。
- 选择DYNAMIXEL协议类型
使用DYNAMIXEL Wizard 2.0修改Protocol Type(13)。建议多个DYNAMIXEL使用相同的协议类型;协议2.0比协议1.0更稳定、更安全。
- 调整归位偏移量
使用Homing Offset(20)调整归位位置。该偏移值会加到Present Position(132)上;当Position Control Mode(Joint Mode)旋转少于360度时,有效范围为-1,024至1,024。
- 设置机器人原点位置
将机器人移至静止位置,使手腕平放在肩部上。这个位置将作为原点位置,其他位置均相对于它。
- 保存原点位置
使用指定命令将原点位置保存在 `config.json` 中。
- 设置电机最大加速度
建议通过profile acceleration设置,将所有电机的最大加速度设置为“10”。
采数据与训练
- 读取机器人关节位置
运行 `get_positions.py` 以获取机器人的所有关节位置。
- 定时记录关节位置
设置计时器,以便在记录关节位置前有足够时间手动将机器人移动到指定位置。
- 定时冻结或解冻关节
使用 `get_positions.py` 按计时器冻结或解冻机器人的所有关节。
- 设置解冻延迟
运行 get_positions.py 并指定解冻延迟秒数。如果机器人所有关节已启用扭矩,机器人会在指定时间后解除所有关节。
- 设置记录延迟
运行 get_positions.py 并指定记录前的等待秒数。该时间从 --delay_to_unfreeze 完成后开始计算。
- 记录时冻结机器人
运行 get_positions.py 并添加 --freeze,使机器人在记录位置时冻结。
- 保存机器人位置
运行 get_positions.py 并添加 --save,将机器人位置保存到 config.json 的 origin_positions JSON 属性中。
用起来
- 运行挥手机器人示例
使用指定命令运行 `wave.py` 中的示例代码。运行前确保机器人周围有足够空旷的空间。
物料
- Robotis Dynamixel 舵机 7 个:XM540‑W270‑T ×2(肩、肘)、XM430‑W350‑T ×3(腰、腕 1、腕 2)、XL430‑W250‑T ×2(腕 3、夹爪)
- 含 U2D2 USB 转换器的 Dynamixel 入门套装;舵机经 3 芯 JST‑EH 线依次串联,README 给出每段线长
- 6 根 300 mm 4040 T 型铝型材与 4 个 90° M6 型材连接件
- 轴承:95×120×13 mm ×1、30×42×7 mm ×10、17×23×4 mm ×4;夹爪用 100 mm 直线导轨与 MGN9C 滑块
- 约 1.14 kg PLA 打印件:CAD 文件含肩部行星齿轮组(太阳轮、4 个行星轮、齿圈)与腰、肘、腕的打印齿轮
- 紧固件:M3×6 热熔螺母 81 个、M3 螺丝约 93 颗、M6 螺丝与 T 型螺母各 26 个;22 AWG 导线与 JST 端子
工具
- 可打 PLA 的 3D 打印机,热床至少 17×17 cm(作者用 Bambu Lab A1;README 称在它这类打印机上全部零件都无需支撑)
- 烙铁、剥线钳、可压 JST SEH-001T-P0.6 端子的压接钳、钳子
- 2 mm 十字与一字螺丝刀,1.5 / 2.0 / 2.5 / 4 mm 内六角扳手
- 桌面夹固定底座;带 USB 口的电脑
技能
- 没有分步装配教程:需按 STEP/STL 模型与照片自行装配,用 M3 螺丝与热熔螺母连接
- 压接 JST 端子、按 README 线长自制舵机线
- 打印设置:全部零件用 0.2 mm 标准参数,齿轮把墙层数提到 4;螺丝孔内悬垂处常留残丝、孔径偏小,用内六角扳手由小到大逐级捅开
- Python 与 Dynamixel SDK:设置 profile acceleration,记录原点位置并编写动作脚本
软件
- Python 示例(dynamixel-sdk):manuel1.py 公共函数,get_positions.py 读取并保存关节位置、定时锁定或解除扭矩,wave.py 挥手演示
- URDF(manuel1.urdf)带外观与碰撞网格
- Robotis Dynamixel SDK(Python、C++、Java、C# 等)与 Dynamixel Wizard