Dummy-Robot(Dummy 机械臂) 复刻全流程
Dummy-Robot(Dummy 机械臂) 从采购、打印、组装到装软件、标定和训练的 22 个步骤,附物料表、购买链接与官方出处。
README 未给整机成本;原版谐波减速模组为二手购入,约 600 元一个,结构为铝 CNC。README 计划的 3D 打印“青春版”目标整机 2000 元以内,尚未发布
采购
- 准备四块核心控制板
准备REF核心板、机械臂底座内的REF底板、步进电机驱动板和Peak示教器。
- 选择20或42步进驱动
项目使用20步进和42步进驱动方案;57步进文件仅供扩展使用。
打印与加工
- 制作低成本摆线减速器
低成本方案采用自制摆线针轮减速器配合3D打印;摆线减速器预计使用PC或亚克力切割件结合3D打印件制作。
组装
- 串联电机并布置CAN总线
以串联方式连接所有电机并使用CAN总线,整体布线为四根线:两根电源正负线和两根CAN信号线。
- 配置电机 CAN 同步网络
通过 CAN 总线连接六个电机,每个电机接收自己的 ID 和 0 号 ID。0 号 ID 用于信息广播与同步,电机收到运动指令后先存入影子寄存器,收到广播同步信号再开始运动。
软件与固件
- 下载并烧录驱动固件
下载项目提供的已编译二进制固件,并将其直接烧录到步进电机驱动器。
- 配置零点与运动参数
通过代码或通信协议设置home零点、PID参数、CAN节点ID和各种运动参数。
- 查阅CAN与串口指令
在UserApp文件夹中查看interface_can.cpp和interface_uart.cpp,了解CAN与UART指令。
- 阅读Peak示教器说明
打开SubModules文件夹中的README,查看Peak示教器软硬件的使用说明。
- 初始化 DummyRobot 参数
创建 DummyRobot 实例时,设置步进电机驱动信息及其自身的 DH 参数。驱动信息包括 CAN 节点 ID、是否反向、减速器减速比和运动限制范围。
- 替换机械臂 DH 参数
确保机械臂构型满足 Pieper 判据:三个相邻关节轴交于一点,或三轴线平行。根据修改后的 Dummy 结构替换 DH 参数,以便移植代码。
- 配置逆解构型选择
传统 DH 参数逆解可能得到多组解,一般为 8 组。选择上一姿态与目标姿态之间六关节变化角最大的一组中最小的一组,作为逆解采用的 config,使姿态切换保持最小转角。
- 实现 MoveJ 同步轨迹规划
收到关节角运动指令后,计算六个关节的运动差分角,并取最大差分角 θ。根据 JointSpeed 参数及加减速要求计算 θ 的运动时间,再据此计算其余五个电机的加减速度与最高速度,使六个电机同步运动。
标定与测试
- 执行首次编码器校准
固件烧录后首次上电时,电机自动进行编码器校准;校准成功后,下次上电按按键1进入闭环模式。
- 重新执行编码器校准
首次校准失败时,同时按住两个按键并上电,驱动器会自动重新进行编码器校准。
- 切换闭环使能状态
短按按键1,在使能闭环和失能闭环之间切换。
- 重启驱动器板
长按按键1,驱动器板会重启。
- 清除堵转保护
短按按键2,清除驱动器的堵转保护。
- 将目标位置归零
长按按键2,将目标值归零;在位置模式下会将当前位置归零。
- 执行上电零点校准
上电后利用电机驱动电流环进行低力矩、无零点定向运动。碰到机械臂限位时确认粗零点且不使用限位开关归零,再根据单圈绝对值编码器位置精调零点。
用起来
- 通过CAN或串口控制电机
通过CAN或串口发送指令控制电机;总线模式支持力矩、速度、位置和轨迹模式。
- 连接 RoboDK 串口驱动
在 RoboDK 中进行软件仿真时,使用连接 Dummy 的驱动。原驱动基于 TCP 网络接口,文档中的版本已改为串口并兼容 Dummy 协议。
常见问题
物料
- REF 核心板(STM32F405RG,FreeRTOS)与底座 REF 底板
- Ctrl‑Step 闭环步进驱动(STM32F103,参考 XDrive 并加 CAN),20 与 42 步进电机各用一版
- 6 个关节:步进电机 + 减速器(原版用谐波减速模组;固件减速比 50/30/30/24/30/50)
- 夹爪模块与 LED 灯环 PCB、无线空间定位控制器 PCB、Peak 无线示教器
- STEP 模型:机械臂、42 电机上下盖与便携手提箱
工具
- 铝件 CNC 加工(原版)
- Altium Designer(PCB 与原理图为 Altium 工程)
- ST‑Link 等 STM32 烧录器与贴片焊接工具
技能
- STM32 HAL/CubeMX、FreeRTOS 与 C++11
- CAN 总线与闭环步进驱动调试(编码器校准、PID)
- 机器人运动学(DH 参数、正逆解)
- Python 命令行工具(reftool)
软件
- Core‑STM32F4‑fw:运动学解算、梯形加减速规划与 USB/串口/CAN 指令
- Ctrl‑Step‑Driver‑STM32F1‑fw 与编译好的 HEX
- DummyStudio(Unity,Windows 可执行文件)与 reftool(基于 odrivetool 与 fibre)
- Peak 示教器固件(基于 X‑Track,子模块)