别再只玩小车了！用STM32F103+Android Studio，从零搭建一个能爬楼梯的六足机器人（附完整源码）

从零打造六足机器人：STM32与Android的硬核协同实战

当大多数电子爱好者还在玩智能小车时，六足机器人已经悄然成为创客圈的新宠。这种仿生机器人不仅能实现基础的移动功能，还能轻松应对楼梯、崎岖地形等复杂环境。本文将带你从零开始，用STM32F103开发板和Android Studio，构建一个真正能爬楼梯的六足机器人。

1. 六足机器人设计概览

六足机器人之所以比轮式或履带式机器人更具挑战性，关键在于其运动控制的复杂性。每条腿通常需要2-3个自由度（舵机），这意味着一个基础六足机器人可能需要控制多达18个舵机。这种多自由度带来的不仅是机械结构的挑战，更是控制算法的考验。

六足机器人的核心优势：

• 卓越的地形适应能力（可轻松跨越障碍、爬楼梯）
• 运动稳定性高（三角步态下始终有三条腿着地）
• 机动性强（可实现原地转向、侧向移动等复杂动作）

我们的设计将采用模块化思路：

• 下位机：STM32F103主控 + 18路PWM舵机控制
• 上位机：Android蓝牙/WiFi控制APP
• 机械结构：3D打印或CNC加工的定制六足框架

2. 硬件系统构建

2.1 核心组件选型

主控芯片对比表：

对于六足机器人项目，推荐使用STM32F103VET6，它在性能和成本间取得了良好平衡。

舵机选型要点：

• 数字舵机（响应快、精度高）
• 扭矩≥15kg·cm（确保足够支撑力）
• 工作电压6-8.4V（与电源系统匹配）
• 180°转动范围（满足步态需求）

推荐型号：

• LD-1501MG（性价比之选）
• MG996R（耐用性强）
• DS3218（高精度）

2.2 电源系统设计

六足机器人的电源管理至关重要，需考虑：

• 主控与舵机的独立供电
• 实时电量监测
• 突发负载应对

典型电源方案：

// 电源监测代码示例 void Power_Check(void) { float voltage = ADC_GetValue() * 3.3 / 4096 * (R1+R2)/R2; if(voltage < 10.5) { // 3S锂电报警阈值 Buzzer_Alert(); Send_Voltage_To_App(voltage); } }

提示：使用3S锂电池（11.1V）供电时，需通过DC-DC降压模块为STM32提供5V/3.3V电源。舵机可直接连接电池，但要注意瞬间电流可能超过10A。

3. 机械结构与组装

3.1 六足框架设计

关键参数：

• 单腿长度：15-20cm（兼顾灵活性与稳定性）
• 关节间距：等分设计便于步态计算
• 总重量：控制在1.5kg以内（含电池）

3D打印建议：

• 使用PETG材料（强度高、韧性好）
• 关键部位加厚至3mm以上
• 预留舵机安装孔位

# OpenSCAD设计示例（简化版） module leg_segment(length, width) { difference() { cube([length, width, width], center=true); rotate([90,0,0]) cylinder(h=width+2, d=3, center=true); } }

3.2 舵机安装技巧

1. 使用金属舵机臂替代塑料件
2. 所有活动关节添加润滑油
3. 线缆用蛇皮管或热缩管整理
4. 先单独测试每个舵机再组装

常见问题解决方案：

• 舵机抖动 → 检查电源稳定性，增加电容滤波
• 运动卡顿 → 调整机械结构间隙
• 发热严重 → 优化控制算法减少堵转

4. 控制系统开发

4.1 STM32下位机程序

PWM舵机控制核心代码：

// 定时器PWM初始化 void PWM_Init(TIM_TypeDef* TIMx, uint32_t Channel, uint16_t arr, uint16_t psc) { TIM_OCInitTypeDef TIM_OCInitStructure; TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure; // 时基配置 TIM_TimeBaseStructure.TIM_Period = arr; TIM_TimeBaseStructure.TIM_Prescaler = psc; TIM_TimeBaseStructure.TIM_ClockDivision = 0; TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up; TIM_TimeBaseInit(TIMx, &TIM_TimeBaseStructure); // PWM模式配置 TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1; TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable; TIM_OCInitStructure.TIM_Pulse = 0; TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High; switch(Channel) { case 1: TIM_OC1Init(TIMx, &TIM_OCInitStructure); break; // 其他通道类似... } TIM_Cmd(TIMx, ENABLE); } // 设置舵机角度（0-180度） void Set_Servo_Angle(TIM_TypeDef* TIMx, uint32_t Channel, uint8_t angle) { uint16_t pulse = 500 + angle * 2000 / 180; // 0.5ms-2.5ms switch(Channel) { case 1: TIMx->CCR1 = pulse; break; // 其他通道类似... } }

4.2 三角步态实现

六足机器人的三角步态是其稳定移动的关键：

1. 步态相位划分：
   • 初始状态：腿1、3、5抬起，2、4、6支撑
   • 第一步：1、3、5向前摆动，2、4、6推动身体前移
   • 第二步：角色互换，2、4、6抬起，1、3、5支撑

步态参数表：

// 三角步态实现示例 void Tripod_Gait(float speed, int direction) { static uint8_t phase = 0; float lift_height = 40.0; float step_length = 60.0; // 相位切换 if(phase == 0) { // 第一组腿抬起并前摆 Move_Leg(1, step_length/2, lift_height); Move_Leg(3, step_length/2, lift_height); Move_Leg(5, step_length/2, lift_height); // 第二组腿推动身体 Move_Leg(2, -step_length, 0); Move_Leg(4, -step_length, 0); Move_Leg(6, -step_length, 0); } else { // 角色互换 Move_Leg(2, step_length/2, lift_height); Move_Leg(4, step_length/2, lift_height); Move_Leg(6, step_length/2, lift_height); Move_Leg(1, -step_length, 0); Move_Leg(3, -step_length, 0); Move_Leg(5, -step_length, 0); } phase = !phase; HAL_Delay(1000/(speed*2)); }

5. Android控制APP开发

5.1 蓝牙通信实现

Android端核心代码：

// Bluetooth连接管理 public class BluetoothService { private static final UUID MY_UUID = UUID.fromString("00001101-0000-1000-8000-00805F9B34FB"); private BluetoothSocket mmSocket; private ConnectedThread connectedThread; public void connect(BluetoothDevice device) { try { mmSocket = device.createRfcommSocketToServiceRecord(MY_UUID); mmSocket.connect(); connectedThread = new ConnectedThread(mmSocket); connectedThread.start(); } catch (IOException e) { try { mmSocket.close(); } catch (IOException e2) {} } } private class ConnectedThread extends Thread { private final InputStream mmInStream; private final OutputStream mmOutStream; public ConnectedThread(BluetoothSocket socket) { InputStream tmpIn = null; OutputStream tmpOut = null; try { tmpIn = socket.getInputStream(); tmpOut = socket.getOutputStream(); } catch (IOException e) {} mmInStream = tmpIn; mmOutStream = tmpOut; } public void write(byte[] bytes) { try { mmOutStream.write(bytes); } catch (IOException e) {} } } }

5.2 控制界面设计

推荐布局方案：

1. 摇杆区域：虚拟摇杆控制方向
2. 模式选择：行走/表演/自定义模式
3. 动作库：预设动作快捷按钮
4. 状态显示：电量、连接状态、实时数据

通信协议设计：

6. 系统集成与调试

6.1 联调步骤

1. 单独测试：

   • 用串口调试助手验证每个舵机
   • 测试Android APP蓝牙连接功能

2. 基础动作验证：

   • 单腿三自由度运动
   • 两组腿的交替抬起

3. 完整步态测试：

   • 平地前进/后退
   • 转向测试
   • 障碍跨越

6.2 常见问题排查

问题1：动作不协调

• 检查所有舵机零点是否一致
• 确认机械结构安装无偏差
• 调整步态时序参数

问题2：蓝牙控制延迟

• 优化通信协议（减少数据量）
• 增加指令缓冲队列
• 检查STM32中断优先级

问题3：电源不稳定

• 增加大容量电容（1000μF以上）
• 采用低内阻电池
• 分开舵机与主控供电

注意：调试时建议先用USB供电（仅主控），确认逻辑正确后再接入大功率电源。安全第一，避免舵机失控造成伤害。

7. 进阶功能扩展

7.1 传感器融合

可集成传感器：

• MPU6050（姿态感知）
• HC-SR04（避障）
• 压力传感器（触地检测）

// 姿态补偿算法示例 void Balance_Compensate(float pitch, float roll) { // 根据机身倾斜调整各腿高度 for(int i=0; i<6; i++) { float comp = pitch * leg_pos[i].x + roll * leg_pos[i].y; Adjust_Leg_Height(i, comp); } }

7.2 视觉导航

低成本方案：

• ESP32-CAM图像传输
• OpenMV简单视觉处理
• AprilTag定位

高级方案：

• Jetson Nano边缘计算
• SLAM实时建图
• 深度学习目标识别

7.3 云端控制

实现架构：

手机APP → 云服务器 → WiFi模块 → STM32 ↑ 数据库存储运动日志

关键技术点：

• MQTT轻量级通信协议
• 数据加密传输
• 离线指令缓存

8. 项目优化建议

1. 机械方面：

   • 采用碳纤维材料减重
   • 优化关节结构降低摩擦
   • 添加被动减震元件

2. 控制算法：

   • 实现CPG（中枢模式发生器）控制
   • 加入自适应地形算法
   • 开发能量最优步态

3. 能源管理：

   • 太阳能辅助充电
   • 运动发电回收
   • 智能休眠机制

4. 用户体验：

   • APP增加动作编程功能
   • 添加VR第一视角控制
   • 实现手势识别控制

这个六足机器人项目最令人兴奋的部分是看着自己编写的代码让机械结构"活"起来。当第一次看到它按照指令稳健地爬过障碍时，所有的调试痛苦都变成了成就感。建议先从基础移动功能做起，再逐步添加更复杂的控制模式，这样能保持持续的项目动力。