MABEL 复刻全流程
MABEL 从采购、打印、组装到装软件、标定和训练的 31 个步骤,附物料表、购买链接与官方出处。
MABEL 是一款受 Boston Dynamics Handle 启发的开源自平衡双腿机器人,使用 Arduino 和 Raspberry Pi 控制。仓库提供可打印的 CAD 部件、电子与机械物料清单、机械装配说明,以及逆运动学和通信软件。
采购
- 购买或获取 MABEL 的非打印材料
购买或获取清单中的所有电子元件、机械硬件和紧固件;使用 Amazon 清单作为大致采购参考。建议多买螺母和螺栓,因为不同构建所需数量可能变化。
打印与加工
- 打印可选的电池包
打印BatteryPack.stl。它是可选部件,用于通过M5螺栓将LiPo电池固定在机器人背面。
- 打印两个BodyPanel
打印两个BodyPanel.stl。它们用于安装髋部舵机以及机器人主体的侧面板。
- 打印BodyTop
从3D打印模型目录下载并打印BodyTop.stl。
- 打印四个DriverGear
打印四个DriverGear.stl文件。
- 打印Housing
打印Housing.stl。它是MABEL的下部主体外壳。
- 打印两个LowerLeg
打印两个LowerLeg.stl文件。
- 打印两个UpperLeg
打印两个UpperLeg.stl文件。
- 打印可选的PanBracketHead
打印PanBracketHead.stl。它是可选的头部组件Pan舵机支架。
- 打印可选的TiltBracketHead
打印TiltBracketHead.stl。它是可选的头部组件Tilt舵机支架。
- 打印UpperBody
打印UpperBody.stl。它是MABEL的上部主体外壳。
- 打印或购买两个车轮
打印两个Wheel.stl文件作为可选车轮,也可以购买车轮。
组装
- 安装四个舵机
将 4 个 MG996R 舵机固定到 2 个 BodyPanel 和 2 个 UpperLeg 上,共需 16 根 M4(15mm)螺栓。舵机必须平贴在这些部件上,输出轴朝向机器人外侧;如舵机边缘有凸起,可用砂纸或锉刀去除。
- 安装伺服齿轮组件
将4个铝制伺服 horn 压入4个 DriverGear 底部的凹槽,并用伺服 horn 随附的螺钉固定。然后用每个伺服电机一颗 M3(10 mm)螺栓,将齿轮组件固定到伺服轴上。
- 安装 NEMA17 电机和车轮
用每个 LowerLeg 4颗 M3(10 mm)螺栓固定一个 NEMA17 步进电机,共使用8颗螺栓。将车轮压装到电机轴上,必要时用 M4 螺栓固定;若使用附带的 Wheel,则在外部包覆弹性圈或橡胶 O 圈等防滑材料以提供牵引力。
- 组装腿部与机身
将 UpperLeg 插入 BodyPanel,并在背面伺服器一侧用 M5 锁紧螺母固定;再用另一个 M5 锁紧螺母将 LowerLeg 固定到 UpperLeg 上,然后对另一侧重复此操作。
- 确定腿部弯曲方向
注意伺服器转子的位置,并决定腿部向哪一侧弯曲;用手手动转动伺服器齿轮,使弯曲方向具有更大的运动范围。使用标准 180 度舵机时,由于齿轮传动,两个方向的运动范围会相反。
软件与固件
- 安装 Adafruit ServoKit 库
按照安装指南安装用于 PCA9685 伺服控制器的 Adafruit ServoKit 库。
- 安装可选的 Cwiid 库
如果使用 Wiimote 控制器,则按照安装指南安装 python3 Cwiid。
- 安装可选的 approxeng.input 库
如果使用其他控制器,则安装 approxeng.input;文档推荐用它开发控制器代码。
- 将 MABEL 克隆到树莓派
按照 ServoKit 和所选控制器库的安装说明操作后,将 MABEL 仓库克隆到树莓派。
- 将控制器代码写入 raspi_code
将所有控制器代码和其他脚本写入 MABEL/raspi_code/ 目录,使其能够引用已包含的代码。
- 初始化 IKSolve
导入 IKSolve 类,并将四个舵机 home 值传给 IKSolve 构造函数。
- 按需设置腿部长度
默认使用 upper_leg=92 和 lower_leg=75;只有改变腿部组件长度时,才使用不同的腿部长度参数。
- 查找 Arduino 串行端口
先断开 Arduino,运行 ls /dev/tty*;然后重新连接 Arduino,再次运行该命令,并记录新出现的端口。
- 初始化串行连接
使用找到的端口初始化 serial.Serial,端口示例为 /dev/ttyACM0,波特率为 9600,奇偶校验为 NONE,停止位为 1,数据位为 8,超时为 1。
标定与测试
- 设置各舵机 home 值
为右上、右下、左上和左下舵机设置各自的 home 值;文档中的示例值只适用于特定舵机,实际值可能不同。
- 确认 YABR 驱动命令
YABR 固件接受字节 [0, 1, 2, 4, 8] 作为驱动输入命令,其中 0b00000000 表示不移动或保持静止。
用起来
- 计算目标舵机角度
以整数毫米输入 x 和 y,并调用 translate_xy(x, y, flip=False);flip 默认应为 False。x 表示上腿枢轴到轮中心的垂直距离,y 表示水平距离。
- 遵守运动范围
MABEL 的 x 可接受范围为 160-98mm,y 可接受范围为 -50 至 50mm。
- 发送角度至舵机控制器
translate_xy 返回的四个舵机角度保存在 servo_angle 元组中,可将这些值传递给舵机控制器代码。