能保持平衡的双轮机器人|EduBal

轻轻扰动后恢复平衡,把控制理论变成看得见的动作

RWTH Aachen与ETH Zurich公开的双轮自平衡教学平台。按原CAD、三块电路板和Simulink模型复现,先验证姿态测量、轮速与停机逻辑,再尝试闭环平衡。适合有焊接和控制基础的进阶用户;需要付费MATLAB工具链。

alan000

参数信息

教学设备数量
28 台

复现文档

确认工具链与制造路线

确认 EduBal 的原版工具链、控制器和制作范围。

1. 准备 MATLAB R2019a、Simulink、Embedded Coder 与 C2000 支持工具的有效许可。

2. 按原版流程准备 TI CCS v6 和 controlSUITE。

3. 核对需要 CATIA 结构导出、三块定制 PCB、电池和线束,并分别安排加工与采购。

4. 2020 论文约 €200 为历史硬件参考,不含当前加工、许可、运费和工具。

**检查**:工具许可/版本和三块板、结构、线束制作路线已确认。

![front.jpg](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/36b21bc0-7b2f-4ed8-a565-b779789892be/files/image/6c6b8ad7abd94e048e7bc59c18e4d2f7.jpg)![guide-1.jpg](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/36b21bc0-7b2f-4ed8-a565-b779789892be/files/image/223393793b7445ec9cd82fb7803d0e70.jpg)

从CATIA总装导出结构件

从 CATIA 总装区分自制结构与采购件,并导出加工几何。

1. 打开 `Final_assembly.CATProduct`。

2. 辨认自制底盘、电池支架、支撑和电路架,以及仅作参考的采购件模型。

3. 按总装实例数核对数量、配合和嵌件位置,再导出制造格式。

4. 仓库没有即用 STL;完成 CAD 导出并确认打印件用量前,暂停结构件打印。

**检查**:自制件与采购件分组清楚,导出文件与总装实例、孔位和嵌件位置相符。

![front.jpg](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/36b21bc0-7b2f-4ed8-a565-b779789892be/files/image/6c6b8ad7abd94e048e7bc59c18e4d2f7.jpg)![guide-2.jpg](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/36b21bc0-7b2f-4ed8-a565-b779789892be/files/image/51c6ffc5d57c420294127d4d71af4cdd.jpg)

制作并贴装三块PCB

制作 PowerSupply、MotorDriver 和 MainBoard 三块 PCB。

1. 用原版 `.brd`/`.sch` 生成每种板各 1 块的制造文件。

2. 按 BOM 和原理图核对器件料号、封装与极性,特别检查 560 pF 电容单位和 JST-XH 2.50 mm 间距。

3. 按厂商要求处理电源芯片与 DRV8842 的散热焊盘。

4. 贴装后检查虚焊、桥连、短路和排针方向。

**检查**:三块板数量正确,器件封装/方向与对应板文件一致,电源网络无短路。

![guide-2.jpg](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/36b21bc0-7b2f-4ed8-a565-b779789892be/files/image/51c6ffc5d57c420294127d4d71af4cdd.jpg)

验收电源板与保护器件

单独检查电源板保护器件和电压输出。

1. 在不连接主控和电机的情况下核对保险丝、开关、电池接口和输出极性。

2. 原设计使用 9.9 V LiFePO4,产生 3.3 V 与 12 V 两路;先按原图核对板上输出。

3. 保留 5 A 保险丝,检查线束绝缘和应力释放;不以 3S LiPo 替代原电池。

4. 确认输出稳定后,再逐块连接其他板。

**检查**:保险丝与开关接入正确,电池输入及 3.3 V/12 V 输出极性符合原图。

![guide-2.jpg](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/36b21bc0-7b2f-4ed8-a565-b779789892be/files/image/51c6ffc5d57c420294127d4d71af4cdd.jpg)

安装电机、轮毂和车轮

安装两台减速电机、轮毂和车轮并检查转动。

1. 按 CAD 固定两台 30:1、带 64 CPR 编码器的 37D 电机,使用原 M3 螺丝和垫片。

2. 将两只 6 mm 轮毂分别装到电机轴,再装两只 80×10 mm 车轮。

3. 按螺纹规格区分 #4-40 与公制 M3 紧固件。

4. 手转两轮,检查同轴、间隙和转动阻力。

**检查**:两轮同轴且转动顺畅;原采购的两只装包装一包即可供两轮使用。

![front.jpg](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/36b21bc0-7b2f-4ed8-a565-b779789892be/files/image/6c6b8ad7abd94e048e7bc59c18e4d2f7.jpg)

堆叠电路板并固定电池

堆叠控制板并固定电池与缓冲垫。

1. 按原 CAD 和排针方向连接 TI LaunchPad 与三块板。

2. 用 M3 长螺丝、螺母及嵌件固定板件,确保板与板之间不接触短路。

3. 将电池放回原电池支架位置,以保持重心。

4. 安装两枚缓冲垫,并固定线束,使其远离轮胎。

**检查**:板件方向与 CAD 一致,支撑牢靠,板间绝缘,电池和线束固定。

![front.jpg](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/36b21bc0-7b2f-4ed8-a565-b779789892be/files/image/6c6b8ad7abd94e048e7bc59c18e4d2f7.jpg)![guide-2.jpg](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/36b21bc0-7b2f-4ed8-a565-b779789892be/files/image/51c6ffc5d57c420294127d4d71af4cdd.jpg)

配置工程并运行离线仿真

打开原版工程并先运行离线仿真。

1. 启动 MATLAB R2019a,打开 `EduBalEmbedded.prj`。

2. 核对模型配置中的路径、编译器和 F28069M 目标。

3. 运行 `02_Simulation` 或 `07_Exercises` 中的原示例仿真,观察角度与轮位移曲线。

4. 若编译失败,先修复工具链配置;保留模型中的保护模块。

**检查**:模型使用 F28069M 目标并运行,角度和轮位移输出可见。

![paper-p5-0.png](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/36b21bc0-7b2f-4ed8-a565-b779789892be/files/image/5a965bf77ce04317a8ddabd32e22c832.png)

校准IMU并检查编码器

禁用电机输出,分别检查 IMU 零偏与编码器方向。

1. 运行 `03_Identification` 中的 IMU 校准,保持车体静止并检查零偏。

2. 缓慢倾斜机身,查看角度符号是否随倾斜方向变化。

3. 手动转动左右轮,观察编码器计数方向和比例。

4. 硬件接口图用于识别模块位置,实际接线以原理图为准。

**检查**:静止时 IMU 读数稳定,倾斜方向和轮编码器计数方向均已记录。

![imu.png](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/36b21bc0-7b2f-4ed8-a565-b779789892be/files/image/65ce393177e948ef9949e9e33e508c22.png)![wheel.png](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/36b21bc0-7b2f-4ed8-a565-b779789892be/files/image/58e108d0b46046ce8259e94735a1230f.png)

架空辨识电机并部署主模型

先架空车轮辨识电机,再部署主控制模型。

1. 稳定支撑车体并使两轮离地。

2. 运行原低层电机辨识示例,检查两轮方向和速度反馈符号。

3. 确认反馈方向后打开 `04_MainModel/MainModel.slx`,按本机测量参数配置。

4. 通过原 USB 链路部署,在 External mode 观察状态。

5. 部署或反馈符号异常时停止,不直接使用论文增益值。

**检查**:两轮方向和速度反馈符号正确,主模型能连接并显示 External mode 数据。

![motor.jpg](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/36b21bc0-7b2f-4ed8-a565-b779789892be/files/image/edc522dbbe0b4d2c96f179b7b273f490.jpg)![paper-p5-0.png](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/36b21bc0-7b2f-4ed8-a565-b779789892be/files/image/5a965bf77ce04317a8ddabd32e22c832.png)

测试软件保护与闭环停机

确认三类软件保护,再进行短时闭环测试。

1. 检查低电压监测是否启用。

2. 检查角度越界时电机是否禁用,以及拿起/轮滑检测是否生效。

3. 论文给出的角度范围为 −30° 至 40°;核对当前模型版本与参数,再决定是否采用。

4. 保护功能属于软件控制,首次闭环时仍需保持可立即触及的物理断电开关。

5. 方向或传感器未确认、失联或异常加速时立刻断电。

**检查**:低电压、倾角越界和拿起/轮滑保护均按模型触发,异常时可物理断电。

![guide-3.jpg](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/36b21bc0-7b2f-4ed8-a565-b779789892be/files/image/a0f5f89f95ae4831a95ddda600eeba3d.jpg)

在有边界区域验证平衡

在平整、有边界的区域逐步验证平衡恢复。

1. 从有支撑的姿态开始,保持电源开关可触及,再逐步进入地面闭环测试。

2. 记录稳定时长、姿态曲线、轮速、轻微扰动后的恢复和停机响应。

3. 原结构平衡角约 10.5° 来自重心偏置,核对姿态角定义后再比较外观直立程度。

**检查**:日志包含平衡时长、传感器/轮速曲线和扰动恢复情况;未稳定时停止并调整参数。

![front.jpg](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/36b21bc0-7b2f-4ed8-a565-b779789892be/files/image/6c6b8ad7abd94e048e7bc59c18e4d2f7.jpg)![guide-3.jpg](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/36b21bc0-7b2f-4ed8-a565-b779789892be/files/image/a0f5f89f95ae4831a95ddda600eeba3d.jpg)

保存制造版本与验收记录

归档制造、软件和闭环测试所用的版本与结果。

1. 保存采购差异、CAD 导出版本和 PCB 制造文件。

2. 记录固件 commit 与 IMU/编码器校准参数。

3. 保存姿态曲线、轮速和实际平衡录像。

4. 参考图中的额外视觉模块不属于基础 BOM,不作为本路线交付要求。

**检查**:记录能对应到这台设备的结构、PCB、固件和测试结果。

![paper-p6-0.png](https://orecord-files.oss-cn-zhangjiakou.aliyuncs.com/sbp/projects/36b21bc0-7b2f-4ed8-a565-b779789892be/files/image/1bb79de871594002a0661826d8514446.png)

相关科技单元