如何从零构建FOC双轮腿机器人：完整实践指南

如何从零构建FOC双轮腿机器人：完整实践指南

【免费下载链接】foc-wheel-legged-robotOpen source materials for a novel structured legged robot, including mechanical design, electronic design, algorithm simulation, and software development. | 一个新型结构的轮腿机器人开源资料，包含机械设计、电子设计、算法仿真、软件开发等材料项目地址: https://gitcode.com/gh_mirrors/fo/foc-wheel-legged-robot

本项目是一个开源的双轮腿机器人项目，为初学者和中级开发者提供了一套完整的机器人开发解决方案。通过本文，您将学习如何从零开始构建一台具备自平衡能力的轮腿机器人，涵盖机械设计、电子硬件、控制算法和软件开发的完整流程。

需求分析：为什么要选择轮腿机器人？

轮腿机器人结合了轮式机器人的高速移动能力和腿式机器人的地形适应性，但传统轮腿机器人的开发面临三个核心挑战：

1. 机械结构复杂：传统四足机器人需要多个高精度关节，成本高昂且控制困难
2. 平衡控制难度大：在动态移动中维持稳定姿态需要复杂的实时控制算法
3. 系统集成困难：机械、电子、软件三者的协同开发门槛较高

本项目通过创新的设计解决了这些问题：采用双轮腿结构简化了机械复杂度，使用FOC（磁场定向控制）技术提高了电机控制精度，并通过分层控制系统实现了稳定的自平衡功能。

方案设计：创新性的系统架构

2.1 分层控制系统架构

我们的解决方案采用三层控制架构，确保系统的稳定性和实时性：

传感器层 → 数据处理层 → 执行层 (IMU) (ESP32) (STM32)

核心组件对比分析：

2.2 机械结构创新设计

轮腿机器人机械结构设计图，展示了创新的双轮腿布局

机械设计采用了模块化思路：

• 腿部结构：使用平行四边形连杆机构，简化了运动学计算
• 驱动系统：4010无刷电机负责腿部关节，2804无刷电机负责车轮驱动
• 连接方式：3D打印件与标准件结合，降低加工难度和成本

机器人爆炸图，清晰展示各部件装配关系和内部结构

实施步骤：从零开始的构建指南

3.1 准备工作清单

在开始构建前，请准备以下物料：

准备事项：

1. 确保具备基础的焊接和3D打印能力
2. 准备万用表、示波器等调试工具
3. 安装必要的开发环境：Keil MDK、PlatformIO、MATLAB

3.2 硬件系统搭建

3.2.1 电路板制作

STM32-FOC驱动板电路设计图，采用DRV8313驱动芯片和AS5600磁编码器

STM32驱动板制作步骤：

1. 使用立创EDA打开stm32-foc/hardware/STM32FOC_LCEDA_SCH.json文件
2. 检查BOM清单，采购所需元器件
3. 按照PCB布局进行焊接，特别注意电源和电机接口
4. 焊接完成后，使用万用表检查电源对地是否短路

ESP32主控板制作步骤：

1. 打开esp32-controller/hardware/ESP32CTRL_LCEDA_SCH.json文件
2. 注意MPU6050陀螺仪的安装方向，确保与程序设定一致
3. CAN总线两端需要焊接120Ω终端电阻

3.2.2 机械组装

关键组装技巧：

1. 电机安装：使用M3×8mm内六角螺丝固定电机，扭矩控制在0.8-1.0N·m
2. 轴承安装：深沟球轴承和推力轴承需要涂抹适量润滑脂
3. 线路布置：电机相线与信号线分开走线，避免电磁干扰

常见问题解决：

• 问题：关节转动卡顿
• 解决方案：使用4mm钻头手动扩孔，配合WD-40润滑剂

3.3 软件系统配置

3.3.1 驱动板固件烧录

STM32驱动板配置：

// 在stm32-foc/software/Src/main.c中修改关键参数 #define OFFSET_ANGLE 15.6f // 编码器零点偏移角度 #define TORQUE_RATIO 0.85f // 扭矩系数 #define DIR_CW true // 旋转方向

烧录步骤：

1. 连接ST-Link调试器到驱动板SWD接口
2. 打开Keil工程stm32-foc/software/MDK-ARM/C6T6SimpleFoc.uvprojx
3. 编译并下载程序到STM32芯片

3.3.2 主控板程序配置

ESP32主控板配置：

1. 安装PlatformIO开发环境
2. 打开esp32-controller/software目录
3. 修改platformio.ini中的串口配置
4. 编译并上传程序到ESP32

关键参数调整：

// 在esp32-controller/software/src/main.cpp中 const float Kp = 0.8f; // 比例系数 const float Kd = 8.0f; // 微分系数 const float Ki = 0.08f; // 积分系数

3.4 系统调试与校准

3.4.1 电机参数校准

自动标定流程：

1. 按住驱动板设置按钮上电
2. LED闪烁3次后松开按钮，进入标定模式
3. 电机自动旋转一周（约10秒），期间不要触碰
4. 标定成功后LED常亮2秒，参数自动保存

3.4.2 平衡算法调试

机器人加速过程中姿态变化图，展示了控制算法的响应效果

平衡参数调试步骤：

1. 初始调试：将机器人放在平坦地面，调整Kp参数使机器人能短暂直立
2. 抑制震荡：加入Kd参数，初始值为Kp的10倍
3. 消除误差：最后调整Ki参数，通常设置为Kp的0.1倍

调试建议：

• 使用蓝牙串口助手实时监控姿态数据，采样率设置为100Hz
• 逐步增加参数值，避免过度调整导致系统不稳定

效果验证：性能测试与优化

4.1 基础性能测试

稳定性测试结果：

• 静态平衡：在平坦地面上可保持直立超过30分钟
• 动态平衡：以0.5m/s速度移动时，倾角偏差小于3°
• 抗干扰能力：施加5N侧向推力后，能在0.5秒内恢复平衡

机器人跌落测试展示，验证了机械结构的缓冲能力和控制算法的恢复能力

4.2 算法仿真验证

使用MATLAB Simscape Multibody进行的机器人物理仿真

仿真验证流程：

1. 打开MATLAB，运行matlab/leg_func_calc.m进行腿部解算
2. 运行matlab/sys_calc.m计算系统状态方程和反馈矩阵
3. 打开Simulink模型matlab/sys_sim.slx进行整体算法验证

仿真结果：

• 平衡算法响应时间：<50ms
• 最大稳定速度：1.2m/s
• 能量效率：比传统PID控制提升约25%

4.3 实际运行测试

测试项目与结果：

进阶应用：功能扩展与优化

5.1 手机APP遥控功能

Android遥控APP界面，支持多种控制模式和参数调整

APP功能特点：

• 三种控制模式：
  1. 手动模式：直接控制关节角度（-30°~+30°）
  2. 平衡模式：自动维持直立，摇杆控制速度
  3. 编程模式：录制和回放动作序列

APP安装与使用：

1. 下载android/balancebot.apk到Android手机
2. 打开蓝牙，搜索并连接机器人
3. 按照界面提示进行参数配置

5.2 图传模块集成（可选）

图传系统架构：

摄像头 → 图传模块 → WiFi → 手机APP ↓ ↓ ↓ ↓ OV5640 NanoPi ffmpeg 实时显示

安装步骤：

1. 按照linux-fpv/README.md中的说明配置NanoPi
2. 连接摄像头到CSI接口
3. 启动图传服务：sudo systemctl start mjpg-ffserver

5.3 算法优化建议

性能优化方向：

1. 控制算法优化：尝试使用模型预测控制（MPC）替代LQR
2. 状态估计改进：融合编码器和IMU数据进行更准确的状态估计
3. 能耗优化：根据负载动态调整控制参数，延长续航时间

代码优化示例：

// 在esp32-controller/software/src/leg_pos.c中优化计算效率 // 原代码使用浮点运算，可优化为定点运算 int16_t leg_position_fixed = (int16_t)(angle_rad * 32767.0f / M_PI);

常见问题与解决方案

6.1 硬件相关问题

Q1：电机转动不顺畅或有异响

• 可能原因：编码器零点偏移不正确
• 解决方案：重新执行自动标定流程，检查编码器磁铁安装位置

Q2：机器人无法保持平衡，向一侧倾斜

• 可能原因：MPU6050安装方向错误或校准不准确
• 解决方案：检查esp32-controller/software/src/main.cpp中的陀螺仪方向设置，重新校准MPU6050

6.2 软件相关问题

Q3：CAN通信失败

• 检查步骤：
  1. 使用示波器检查CAN总线波形
  2. 确认终端电阻已正确安装（120Ω）
  3. 检查stm32-foc/software/Inc/can.h中的波特率设置

Q4：平衡算法参数如何调整

• 调试建议：
  1. 先调整Kp使机器人能短暂直立
  2. 加入Kd抑制震荡，初始值为Kp的10倍
  3. 最后调整Ki消除静态误差，通常为Kp的0.1倍

6.3 机械相关问题

Q5：关节松动或晃动

• 解决方案：
  1. 检查所有螺丝是否拧紧
  2. 在关节处增加垫片减少间隙
  3. 使用螺纹胶固定关键连接处

Q6：3D打印件强度不足

• 改进方案：
  1. 增加打印层厚到0.2mm
  2. 提高填充率到50%以上
  3. 考虑使用PLA+或ABS材料

项目资源与社区贡献

7.1 项目文件结构

foc-wheel-legged-robot/ ├── solidworks/ # 机械结构设计文件 ├── matlab/ # 算法仿真文件 ├── stm32-foc/ # STM32驱动板设计 ├── esp32-controller/ # ESP32主控板设计 ├── linux-fpv/ # 图传模块 └── android/ # Android遥控APP

7.2 获取项目代码

git clone https://gitcode.com/gh_mirrors/fo/foc-wheel-legged-robot cd foc-wheel-legged-robot

7.3 参与项目贡献

我们欢迎社区成员通过以下方式参与项目改进：

1. 代码贡献：优化平衡算法效率，当前算法约占用25%CPU资源
2. 硬件改进：提交PCB设计优化或新功能模块设计
3. 文档完善：补充装配过程视频或调试案例
4. 功能扩展：添加新的传感器或通信模块

进阶提示：对于有经验的开发者，可以尝试将控制算法移植到其他平台，如ROS2，实现更高级的导航和避障功能。

总结与展望

通过本文的指导，您已经了解了如何从零开始构建一台FOC双轮腿机器人的完整流程。从机械设计到电子硬件，从控制算法到软件实现，每个环节都经过实际验证，确保项目的可行性。

ESP32主控板电路设计图，集成了MPU6050陀螺仪和CAN通信接口

本项目的核心价值在于：

1. 完整的开源方案：提供从设计到实现的全部资料
2. 成本可控：总成本约550元，适合个人和学校项目
3. 技术栈全面：涵盖机械、电子、控制、软件多个领域
4. 扩展性强：模块化设计便于功能扩展和二次开发

无论您是机器人爱好者、学生还是工程师，这个项目都为您提供了一个绝佳的学习和实践平台。通过动手实践，您不仅能掌握轮腿机器人的核心技术，还能培养跨学科的系统工程思维。

开始您的机器人构建之旅吧！如果在实施过程中遇到问题，欢迎参考项目文档或向社区寻求帮助。祝您构建成功！

【免费下载链接】foc-wheel-legged-robotOpen source materials for a novel structured legged robot, including mechanical design, electronic design, algorithm simulation, and software development. | 一个新型结构的轮腿机器人开源资料，包含机械设计、电子设计、算法仿真、软件开发等材料项目地址: https://gitcode.com/gh_mirrors/fo/foc-wheel-legged-robot