Hexapod 复刻全流程
Hexapod 从采购、打印、组装到装软件、标定和训练的 252 个步骤,附物料表、购买链接与官方出处。
这是一个由 ESP32 驱动、拥有 18 个自由度的 3D 打印六足机器人项目。仓库提供各款机器人的物料清单、3D 打印零件、组装说明、固件与步态生成工具。
采购
- 购买 ESP32 控制器板
购买带有双 PCA9685 驱动器的控制器板;舵机直接从电池供电。
- 购买 18 个 25 kg 舵机
选择旋转范围为 180°、扭矩等级为 25 kg 的舵机;支持 8.4V 供电电压,并确保所有舵机来自同一批次。
- 购买 SPST 拨动开关
购买一个直径 12 mm 的 SPST 单极单掷拨动开关,可与控制器板一起购买。
- 购买 4 节 18650 锂电池
购买4节3.7V锂离子电池,建议容量为2000mAh或更高;为确保安全,请使用带保护电路的电池。
- 购买四节 18650 电池盒
准备一个带导线的四节2S2P 18650电池盒;可使用提供的3D打印版本,或与控制器板一起购买。
- 安全使用锂离子电池包
仅使用带保护的电芯和合适的2S充电器,并且充电时绝不能无人看管。
- 购买标准公制硬件
所需硬件为标准公制件,可从 Amazon、AliExpress 或当地五金店购买。
- 选择 18 个同批次舵机
准备 18 个旋转范围为 180° 的 MG92B Servo,并确保所有舵机来自同一批次。
- 准备两节受保护电池
准备 2 个 18650 Battery,规格为 3.7V Li-ion,推荐容量为 2000mAh 以上。为确保安全,请使用带保护功能的电池。
- 选择主控制器
选择 Raspberry Pi PICO 或 ESP32,并准备 18 个 21G 舵机。
打印与加工
- 打印所有零件
按零件表打印所有零件。
- 查找3D打印文件
所有STL文件都位于`3d print`文件夹中,其中还包含可直接打印的Bambu Studio项目`bambu_studio_*.3mf`。
- 设置层高和填充率
建议层高为0.2 mm,填充率为20–30%。
- 选择结构件和足端材料
结构件使用PLA或PETG,足端使用TPU。
- 检查支撑和STL方向
部分零件需要支撑;检查每个STL的打印方向。
- 先试打印并试装一条腿
先打印一条腿所需的全部零件并试装,确认后再打印全部六条腿。
- 区分标准关节和镜像关节
共6个关节,3个为标准关节,3个为镜像关节。左侧腿使用镜像关节,右侧腿使用标准关节;按照完整组装图片确认方向。
- 打印足部组件
准备6个 foot_bottom、6个 foot_top、6个 foot_ground 和6个 foot_tip。foot_tip 建议使用 TPU 打印。
- 打印全部机器人零件
按照下方零件列表,3D 打印所有零件。
- 准备并试打印六足机器人零件
使用 3d print 文件夹中的 STL 文件或可直接打印的 Bambu Studio 项目 hexapod_mochi.3mf。推荐层高 0.2 mm、填充率 20-30%,结构使用 PLA 或 PETG,脚尖使用 TPU;部分零件需要支撑,先打印一条腿的零件并试装。
- 打印并安装机身组件
打印 body_base 1个、body_side 6个、body_top 1个、body_head 1个、body_battery_top 1个和 body_servo_side 12个。安装舵机后再封闭机身,整理布线以免夹线,并在最终组装前试装所有零件。
- 打印并定向关节组件
为六条腿打印 joint_bottom 12个、joint_cross 6个和 joint_top 12个。左侧腿使用镜像关节,右侧腿使用标准关节,并参照完整组装机器人图片确认关节方向。
- 打印并组装腿部组件
打印 leg_bottom 6个、leg_side 12个和 leg_top 6个。确保轴承正确就位,销钉应能顺畅滑入且无需用力,并继续前检查关节旋转是否平滑。
- 打印并匹配脚部组件
为六条腿打印脚部组件,共3个标准脚和3个镜像脚。左侧腿使用与镜像关节匹配的镜像脚,右侧腿使用与标准关节匹配的标准脚。
- 打印机器人结构件
打印机器人的结构部件。这些部件采用 3D 打印设计,以增强强度并便于装配。
- 准备3D打印文件
所有STL文件位于3d print文件夹中,同时提供可直接打印的Bambu Studio项目nougat.3mf。
- 设置打印参数
层高为0.2 mm,填充率为20–30%;结构件使用PLA或PETG,脚尖使用TPU。部分零件需要支撑,并应检查STL方向。
- 先试打印一条腿
先打印一条腿所需的零件并进行试装,然后再打印全部六条腿。
- 打印并匹配脚部方向
共打印6个脚部,3个标准脚部和3个镜像脚部;左侧腿使用与镜像关节匹配的镜像脚,右侧腿使用与标准关节匹配的标准脚。
组装
- 准备硬件
整理螺丝、螺母、轴承和销钉。
- 组装机身
安装舵机和控制器。
- 构建六条腿
每条腿依次组装关节、腿和足端。
- 将腿安装到机身
把组装好的腿安装到机身。
- 闭合机身前安装舵机
在闭合机身之前安装舵机。
- 整齐布置电线
整齐布置电线,避免夹压。
- 最终组装前试装全部零件
最终组装前先试装所有零件。
- 组装六条腿的关节
使用6个 joint_cross、12个 joint_top、6个 leg_bottom、12个 leg_side 和6个 leg_top 组装腿部。确保轴承正确就位,销钉可顺畅滑入且不需用力,并确认关节转动顺畅。
- 按侧别安装六只脚
左侧腿使用镜像脚和镜像关节,右侧腿使用标准脚和标准关节。参考完整组装好的机器人图像,以确定正确的脚部方向。
- 分类整理所有硬件
组装前,将所有硬件放入有标签的容器中,以节省时间。
- 整理安装五金件
整理并分类螺钉、螺母、轴承和销钉。
- 组装机器人机身
组装机身并安装舵机和控制器。
- 逐条组装机器人腿
对每条腿依次组装关节、腿部和足端。
- 将腿部安装到机身
将组装完成的腿安装到机器人机身上。
- 保持舵机舵盘螺钉松动
组装过程中不要拧紧舵机舵盘螺钉,应保持松动,让舵机能够转动。
- 连接预装控制器板
使用预装的 Controller Board,将舵机、开关和电池线直接插入,无需焊接。
- 装配前整理硬件
将所有硬件分类放入有标签的容器中,以便随后进行装配。
软件与固件
- 接线、测试并校准
连接舵机,上传固件并校准机器人。
- 安装 Arduino IDE 2.x
安装 Arduino IDE;建议使用2.x版本。
- 连接控制器 USB 线
准备一条与控制器板兼容的 USB 数据线。
- 安装所需 Arduino 库
通过 Arduino Library Manager 安装 Adafruit_PWMServoDriver,用于控制 PCA9685;同时安装 arduino-esp32 附带的 AsyncUDP、ArduinoOTA、EEPROM 和 WebServer。
- 安装 Arduino IDE
从 arduino.cc 下载并安装 Arduino IDE。
- 添加 ESP32 开发板支持
Follow the official ESP32 Arduino installation guide, or add the specified package index under Arduino IDE’s File → Preferences → “Additional Board Manager URLs”.
- 安装 ESP32 开发板包
在 Tools → Board → Boards Manager 中搜索“ESP32”并安装。
- 安装 PWM 舵机驱动库
Open Sketch → Include Library → Manage Libraries, search for “Adafruit PWM Servo Driver”, and click Install.
- 配置 ESP32 开发板设置
选择 ESP32 Dev Module,上传速度设为 115200,闪存频率设为 80MHz,分区方案设为“Default 4MB with spiffs”。
- 打开六足机器人固件
在 Arduino IDE 中打开 ./software/hexapod_esp32/hexapod_esp32.ino。
- 选择 Macaroon 机器人配置
在 robot.h 中取消 ROBOT_MACAROON 的注释,并确保它是唯一未注释的 ROBOT_* 行。此固件通过该选择使用 Macaroon 的运动表和设置。
- 配置 WiFi 接入点
默认 SSID 为 hexapod_macaroon,密码为 hexapod_1234;SSID 的 APSSID 位于 src/robots/macaroon/robot_config.h,密码的 APPSK 位于 config.h。
- 配置自定义舵机引脚
使用自定义接线时,在代码中配置左右六条腿的三组舵机引脚映射。
- 连接 ESP32 并选择端口
通过 USB 连接 ESP32,然后在 Tools → Port 中选择正确的 COM 端口。
- 上传六足机器人固件
点击 Upload 按钮,将固件上传到已连接的 ESP32。
- 安装 Python 并编辑运动参数
安装包含 `numpy` 的 Python,然后编辑 `robots/macaroon.json`;也可以在 `path_tool.py` 中添加生成器。
- 重新生成 Macaroon 运动表
在 `software/path_tool` 中运行 `python generate_motion.py macaroon`,直接写入 `software/hexapod_esp32/src/robots/macaroon/motion.h`;`lut_generator.ipynb` 也可交互式完成相同操作。
- 重新上传 ESP32 固件
生成新的运动表后,重新上传 ESP32 固件。
- 注册新的自定义运动
全新运动表还需要在 `motion_control.ino` 的 `motion_config[]` 中添加条目,并参阅“Adding Custom Motions”。
- 刷入默认偏移固件
将代码刷入控制器,并使用默认偏移值。
- 选择安装方式
使用您熟悉的 IDE;其他选项取决于操作系统。中国用户应使用 Jihulab 镜像作为软件仓库来源。
- 检查芯片支持状态
查看“Supported Soc’s table”,确定特定芯片属于稳定版还是开发版支持。
- 添加 ESP32 软件包网址
在 Arduino Boards Manager 中输入稳定版软件包索引网址;文档也提供了开发版软件包索引网址。在中国连接 Espressif 网址或下载困难时,改用 Jihulab 软件包索引。
- 通过 Boards Manager 安装 ESP32
从 Arduino IDE 1.6.4 版本开始,可使用 Boards Manager 安装第三方平台软件包。Arduino-ESP32 软件包适用于 Windows、macOS 和 Linux。
- 完成 Windows 安装步骤 1
按照媒体 4 中显示的第一个 Windows 手动安装操作进行操作。
- 完成 Windows 安装步骤 2
按照媒体 5 中显示的第二个 Windows 手动安装操作进行操作。
- 完成 Windows 安装步骤 3
按照媒体 6 中显示的第三个 Windows 手动安装操作进行操作。
- 完成 Windows 安装步骤 4
按照媒体 7 中显示的第四个 Windows 手动安装操作进行操作。
- 完成 Windows 安装步骤 5
按照媒体 8 和媒体 9 中显示的最后的 Windows 手动安装操作进行操作。
- 更新 Arduino ESP32 代码
按照媒体 10 和媒体 11 中显示的更新操作进行操作;媒体 7 也出现在此更新章节中。
- 安装 Linux 串口工具
运行列出的命令,将用户加入 dialout 组,安装 Git,下载并安装 pip,然后安装 pyserial。
- 克隆 Arduino ESP32 支持文件
创建 Arduino 硬件目录,克隆 Arduino ESP32 仓库,并运行仓库工具安装程序。
- 使用备用克隆路径
文档还提供了备用命令序列:先创建 Espressif 目录,再克隆仓库并运行 get.py。
- 在 Fedora 上安装 ESP32 Arduino 支持
将用户加入 dialout 组,安装 Git、Python pip 和 pyserial,然后克隆 Arduino-ESP32 仓库并下载其工具。文档警告,使用 dnf 安装 arduino 软件包很可能会安装较旧的版本。
- 在 openSUSE 上安装 ESP32 Arduino 支持
将用户加入 dialout 组,并根据检测到的 Python 版本选择安装 Python 2.7 或 Python 3 软件包。然后克隆 Arduino-ESP32 仓库并下载其工具。
- 在 macOS 上安装 ESP32 Arduino 支持
在 Arduino 草图库位置中创建 Espressif 硬件目录,克隆 Arduino-ESP32 仓库并下载其工具。如果 Arduino 首选项中显示的草图库位置不同,请调整路径。
- 安装 macOS 命令行工具
如果 macOS 安装报告活动开发者路径无效并提示缺少 xcrun 命令,请使用 xcode-select 安装命令行工具。
- 安装 Arduino 库
打开 Arduino Library Manager,安装 Dependencies 表中列出的七个库。
- 安装 Arduino IDE 2.x
从 Arduino 网站安装 Arduino IDE 2.x。
- 安装 ESP32 开发板支持
按照链接中的 Espressif 指南,为 Arduino IDE 安装 ESP32 开发板支持。
标定与测试
- 调整步态帧延迟
DELAY_MS 是 LUT 帧之间的时间,帧周期现在正好为 DELAY_MS。如果步态显得过快,请在 src/robots/<name>/robot_config.h 中增大 DELAY_MS。
- 连接六足机器人 WiFi
打开六足机器人电源,并让设备连接其 WiFi 网络。首次启动时,旧版固件保存在 EEPROM 中的校准数据会自动导入。
- 打开校准界面
打开网页浏览器,访问 `http://192.168.4.1/`,然后切换到 **Calibrate** 标签页。
- 进入校准姿态
点击 **Enter calibration** 按钮。机器人将移动到其中性校准姿态。
- 调整每个关节的偏移量
使用 `+` 和 `-` 按钮微调每个关节,偏移量限制为 ±100 个 tick。调整至 coxa(肩部)与机身平行、femur(大腿)水平、tibia(小腿)垂直,并让所有腿对齐、机器人站姿均匀。
- 将校准保存到闪存
姿态满意后,点击 **Save to robot**,将校准值永久保存到闪存。保存时,网页界面会将配置的数组打印到串口监视器,以便备份偏移量。
- 退出校准模式
点击 **Exit**。机器人会平稳回到待机姿态。
- 设置步态播放速度
在命令末尾添加速度字节可组成 7 字节命令;速度值限制在 20-100%,`0` 表示保持速度不变。6 字节格式不会改变速度。
- 使用平滑的降速播放
将播放速度理解为调优帧率(`DELAY_MS`)的百分比;速度为 50% 时,每个步态周期耗时加倍。低于 100% 时,固件在相邻 LUT 帧之间进行插值,同时仍每隔 `DELAY_MS` 更新舵机。
- 保持步态过渡速度
播放速度只应用于步态 LUT 播放。步态之间的过渡保持原有速度,使机器人仍能及时停止。
- 检查默认速度
检查机器人启动后的运动速度是否为 60%,该值由 `config.h` 中的 `MOTION_SPEED_DEFAULT_PCT` 定义。仅发送 6 字节格式的客户端会以 60% 行走,除非提高了速度。
- 运动后重新启用 OTA
执行第一次运动命令或实时会话后,OTA 会被禁用。重启机器人可重新启用 OTA。
- 设置 OTA 密码
在 `config.h` 中定义 `OTA_PASSWORD`,为 OTA 更新设置密码。文档对网页及其 WiFi 设置也给出了相同的默认安全警告。
- 验证机器人 WiFi 凭据
验证 `src/robots/<name>/robot_config.h` 中的 SSID 和 `config.h` 中的密码。
- 检查机器人 IP 地址
打开串口监视器并检查 IP 地址。在接入点模式下,该地址为 192.168.4.1。
- 使用机器人 IP 地址连接
如果机器人已加入网络,但 `hexapod-<robot>.local` 无法解析,请使用串口监视器或路由器中的 IP 地址。
- 检查保存的 2.4 GHz 网络
如果机器人持续启动接入点,请检查 **WiFi** 选项卡中保存的网络和密码,并确认网络为 2.4 GHz。
- 使用支持 2.4 GHz WiFi 的客户端
确保客户端设备支持 2.4 GHz WiFi。
- 检查 PWM 驱动器地址
检查 PWM 驱动器的 I2C 地址是否与硬件地址 0x40 和 0x41 一致。
- 验证低电平有效的使能引脚
验证使能引脚是否正确连接;这些引脚为低电平有效。
- 确认舵机引脚映射
确认 `config.h` 中的舵机引脚映射。
- 单独测试舵机
使用 `posture_calibration()` 函数单独测试舵机。
- 在首次运动前使用 OTA
OTA 仅在首次运动指令之前可用。
- 重启机器人以启用 OTA
重启机器人以重新启用 OTA。
- 连接机器人 WiFi 网络
确保上传设备已连接到机器人的 WiFi 网络。
- 检查上传计算机的防火墙
检查上传计算机的防火墙设置。
- 校准 ESP32 舵机
在 ESP32 版本中,通过浏览器进行舵机校准,并实时调整。
- 首次通电前检查电池极性
首次通电前检查电池极性两次;反向极性会损坏控制板。
- 通电时让手指远离关节
机器人通电时,手指应远离关节;十八个舵机产生的扭矩足以夹伤手指。
- 首次通电时支撑机器人
首次通电时支撑机器人;当客户端加入其WiFi网络时,机器人会自动运行站立序列。
- 安全使用锂电池组
仅使用带保护的电池芯和合适的2S充电器,并且不要在无人看管时充电。
- 配置 ESP32 开发板设置
设置 Board 为“ESP32 Dev Module”,Upload Speed 为“115200”,Flash Frequency 为“80MHz”,Partition Scheme 为“Default 4MB with spiffs”。
- 选择 Nougat 机器人配置
在 robot.h 中确保 ROBOT_NOUGAT 是唯一未注释的 ROBOT_* 行。该选择为 Nougat 使用对应的运动表和设置。
- 配置默认 WiFi 信息
默认 SSID 为 hexapod_nougat,密码为 hexapod_1234。SSID 在 src/robots/nougat/robot_config.h 中设置为 APSSID,密码在 config.h 中设置为 APPSK。
- 配置自定义舵机引脚
使用自定义接线时,按照程序中的映射配置左右六条腿的舵机引脚。
- 给六足机器人上电
连接电池并拨动开关。机器人随后上电。
- 连接机器人 WiFi
让手机或电脑直接连接机器人自建的 Access Point;它不会加入家庭路由器。客户端一连接,机器人就会运行站立启动序列。
- 发送命令或打开标定界面
将命令发送到 `192.168.4.1:1234`。或者打开 `http://192.168.4.1` 使用标定界面。
- 设置步态速度
可追加可选的第七字节,以调整后速度的百分比设置步态速度,范围为 20–100,`0` 表示保持不变。ESP32 固件默认从 60% 开始,也可在 `http://192.168.4.1` 的 **Motion Speed** 滑块中调整。
- 保存舵机偏移量
在 Web 界面中点击“保存偏移量”,将校准值写入设备。
采数据与训练
- 打开控制或校准界面
向 192.168.4.1:1234 发送命令,或打开 http://192.168.4.1 使用校准界面。
- 发送前进动作命令
构造 6 字节小端序数据包,将 0xA5 放在字节 0、命令 ID 放在字节 1、32 位序列号放在字节 2 至 5,并通过 UDP 发送到 192.168.4.1:1234。
- 设置或保持运动速度
只发送 6 字节动作包时,ESP32 固件默认以 60% 速度行走。可在 http://192.168.4.1 的 Motion Speed 滑块中提高速度,也可在可选字节 6 中设置 20–100% 的步态速度;0 表示保持不变。
- 发送会话控制命令
使用与动作命令相同的 6 字节布局,将 0xA7 作为魔术字节,并在字节 1 中写入会话动作。
- 控制实时关节姿态
发送包含全部 18 个关节原始舵机刻度的 44 字节数据包。收到后机器人进入实时模式,每个关节每 20 ms 最多移动 max_step 个刻度;若 1 秒未收到数据包,则回到待机并恢复 LUT 控制。
- 保持实时模式连接
实时模式空闲时发送 ping,以避免机器人在 1 秒无数据包后回到待机。发送 0xA5 动作命令也会退出实时模式。
- 使用旧版文本命令
当数据包不匹配任何二进制布局时,固件仍可解析普通命令字符串。冒号分隔符是可选的,前导分隔符会被跳过,命令在第一个分隔符处结束;新客户端应使用二进制协议。
- 发送二进制运动命令
ESP32 固件使用二进制协议,首字节用于选择数据包类型。示例以小端序且不填充的格式打包魔术字节 `0xA5`、前进命令 ID `1` 和序列号 `0`,然后通过 UDP 发送。
- 发送纯文本命令
两个固件都接受普通命令字符串,`:` 分隔符是可选的,开头的分隔符会被跳过,命令在第一个分隔符处结束。Pico 仅支持此接口,新的 ESP32 客户端应使用二进制协议。
用起来
- 打开浏览器控制器
连接到机器人的 WiFi 网络并打开 `http://192.168.4.1/`,或打开机器人在你网络中的地址。页面会打开 Drive 标签页,控制面板铺满整个窗口。
- 使用触摸控制盘驾驶
按住并在各个区域之间滑动手指,无需抬起。右侧控制盘的内圈可向八个方向行走,顶部和底部用于快速前进或后退,两侧用于原地转向,中心用于停止;左侧网格用于执行身体动作和攀爬步态。松开后机器人会回到待机状态。
- 使用键盘驾驶
使用 **W A S D** 或方向键行走,同时按两个键可斜向移动。使用 **Q** 和 **E** 转向,使用 **Space** 停止。
- 放松并唤醒舵机
选择 **Relax** 可切断舵机电源,让机器人瘫软到地面。选择 **Wake** 或执行任意控制操作可再次为舵机供电。
- 设置控制器方向
横屏时采用 Android 应用布局,速度滑块和按钮位于两个控制盘之间;竖屏时这些控件会上下堆叠。
- 使用全屏或主屏幕
On Android, iPad and desktop, tap **Full screen** to hide the browser bars. On iPhone Safari, use **Share > Add to Home Screen** and open the page from the icon because Safari has no full-screen mode.
- 了解浏览器失效保护
按住控制项时,页面每 150 ms 通过 HTTP 使用 `POST /motion` 重新发送命令,并在每次移动时发送步态速度。如果手机掉线离开 WiFi 或页面进入后台,机器人的 500 ms 失效保护会将其停止。
- 避免同时进行远程控制
不要同时通过浏览器页面和 UDP 远程设备驾驶机器人,否则两者会争夺控制权。最后发送的命令会生效。
- 构建运动命令数据包
构建 6 字节运动命令,其中魔数为 `0xA5`,字节 1 使用枚举中的命令 ID,字节 2-5 使用 32 位无符号序列号。
- 持续发送运动数据包
机器人需要移动时持续重发 UDP 命令;如果 500 毫秒(`MOTION_TIMEOUT_MS`)内没有收到数据包,机器人会返回待机状态。
- 在周期边界切换步态
只在步态周期的起点或中点切换步态。切换到下一步态时,机器人始终会经过待机姿势。
- 使用数据包覆盖速度
发送 7 字节数据包可让每个数据包覆盖速度设置;文档以 arcade remote 作为此类客户端的示例。
- 开始编写 Python 运动客户端
在 Python 示例中先导入 socket 和 struct 模块,用于运动命令客户端。
- 注册运动路径
在 `../path_tool/generate_motion.py` 的 `gen_luts()` 中添加运动路径,以便为每台机器人生成该路径。
- 重新生成所有运动 LUT
使用 `python generate_motion.py --all` 为所有机器人重新生成 LUT,并重写每个 `src/robots/<name>/motion.h`。
- 添加自定义运动命令
在 `protocol.h` 的 `CMD_COUNT` 之前添加命令 ID,然后在 `motion_control.ino` 的 `motion_config[]` 同一位置添加匹配条目。`static_assert` 会检查两者数量是否匹配。
- 通电时让手指远离关节
通电时让手指远离关节,因为18个25 kg舵机具有很强的夹伤力。
- 腿部异常移动时切断电源
如果腿向意外方向移动,用开关切断电源,不要试图挡住腿。
- 使用 Android 应用连接六足机器人
使用 Android 设备上的六足机器人应用,连接机器人的 WiFi 网络。
- 使用屏幕按钮控制运动
点击应用中的屏幕按钮,控制六足机器人运动。
- 执行所有可用运动命令
通过应用执行六足机器人所有可用的运动命令。
- 监视连接状态
在应用中查看六足机器人的连接状态。
- 使用 Hexapod Link 实时控制
使用 Hexapod Link,通过实时姿态流协议驱动机器人。
- 断电后保留校准值
EEPROM 中的校准值具有持久性,即使六足机器人断电重启也会保留。
- 使用 Android 应用控制六足机器人
通过 Android 应用连接六足机器人的 WiFi 网络,使用屏幕按钮控制移动、执行所有可用的运动命令并监视连接状态。需要支持 WiFi 的 Android 设备。
- 使用 Hexapod Link 实时控制
使用 Hexapod Link 通过 ESP32 固件的实时姿态流协议驱动机器人。