STM32F103ZE扫地机器人开发实战：路径规划与避障实现

1. 项目概述

这个基于STM32F103ZE的扫地机器人项目，是我花了半个月时间在正点原子精英版开发板上实现的。核心功能包括弓字形路径规划、超声波避障、WiFi远程控制和一键回充。虽然比不上商业产品，但作为创客项目已经具备了完整的扫地机器人基础功能。

硬件上采用了STM32F103ZE作为主控，搭配四个28BYJ-48步进电机负责移动，HC-SR04超声波模块实现避障，ESP8266提供WiFi连接。软件方面最核心的是路径规划算法和电机控制逻辑，通过状态机实现了稳定的弓字形行走路线。

特别说明：项目所有代码都是基于寄存器开发，没有使用HAL库，这样能更好地理解底层硬件工作原理。

2. 硬件设计与选型

2.1 主控板选择

选用正点原子精英版开发板作为核心控制器，主要考虑以下几点：

1. STM32F103ZET6芯片具有丰富的GPIO和定时器资源，足够驱动多个电机和传感器
2. 开发板自带调试接口，方便程序烧录和调试
3. 板载资源丰富，包括按键、LED等，可以快速验证功能

2.2 电机驱动方案

采用28BYJ-48步进电机配合ULN2003驱动板的方案，主要优势是：

• 成本低廉，整套驱动系统不到50元
• 控制简单，只需要4个GPIO即可驱动
• 扭矩足够推动小型扫地机器人

电机参数：

2.3 避障传感器选型

使用HC-SR04超声波模块实现避障，主要特点是：

1. 测量范围2cm-400cm，满足室内避障需求
2. 精度达到3mm，足够识别常见障碍物
3. 价格便宜，单个模块仅需10元左右

模块安装在SG90舵机上，可以实现180度环境扫描，大大提高了避障效果。

3. 软件架构设计

3.1 系统整体架构

软件采用模块化设计，主要分为以下几个部分：

1. 电机驱动模块：负责步进电机的精确控制
2. 路径规划模块：实现弓字形行走算法
3. 避障模块：处理超声波传感器数据
4. WiFi通信模块：与手机APP交互
5. 电源管理模块：监控系统电压

3.2 弓字形路径算法实现

弓字形路径的核心是状态机设计，主要状态包括：

1. 前进状态：沿Y轴直线前进
2. 转向状态：在X轴方向移动一个机身宽度
3. 避障状态：遇到障碍物时的处理

关键代码片段：

c复制// 路径规划状态机
void Path_Planner(void) {
    switch(path_state) {
        case GO_FORWARD:
            Motor_Forward(step_count);
            if(++step_count >= max_steps) {
                path_state = TURN_RIGHT;
                step_count = 0;
            }
            break;
        case TURN_RIGHT:
            Motor_Turn_Right(turn_steps);
            if(++step_count >= turn_steps) {
                path_state = GO_FORWARD;
                step_count = 0;
            }
            break;
        // 其他状态处理...
    }
}

3.3 电机控制实现

使用定时器PWM输出控制电机，相比传统的延时方法有以下优势：

1. 速度控制更精确
2. 系统资源占用少
3. 可以实现差速转向

电机驱动关键代码：

c复制// 步进电机相位序
const uint8_t phase_seq[] = {0x09,0x08,0x0C,0x04,0x06,0x02,0x03,0x01};

void STEP_Motor_Run(TIM_HandleTypeDef* htim, uint16_t pulse) {
    HAL_TIM_PWM_Start(htim, TIM_CHANNEL_1);
    __HAL_TIM_SET_AUTORELOAD(htim, pulse);    // 设置脉冲周期
    __HAL_TIM_SET_COMPARE(htim, TIM_CHANNEL_1, pulse/2); // 50%占空比
}

4. 避障系统实现

4.1 超声波测距原理

HC-SR04模块工作原理：

1. 触发引脚发送10us高电平
2. 模块发射8个40kHz超声波脉冲
3. 接收回波并计算时间差
4. 距离 = (高电平时间 * 声速)/2

4.2 避障算法优化

原始避障算法存在以下问题：

1. 对黑色物体检测距离短
2. 容易受环境噪声干扰
3. 反应速度不够快

改进后的算法增加了以下特性：

1. 深色物体距离补偿
2. 三次确认防误触发
3. 动态阈值调整

避障处理代码：

c复制if(sonar_val < 400) { // 单位mm
    obstacle_count++;
    if(obstacle_count >= 3) {
        Mode_Switch(ESCAPE_MODE); // 切换逃生模式
        BEEP_Alert(3); // 哔哔哔叫三声
    }
} else {
    obstacle_count = 0;
}

5. WiFi控制实现

5.1 ESP8266通信协议

使用AT指令与ESP8266模块通信，主要指令包括：

1. AT+CWMODE=1 // 设置为Station模式
2. AT+CWJAP="SSID","password" // 连接WiFi
3. AT+CIPSTART="TCP","192.168.1.100",8080 // 建立TCP连接
4. AT+CIPSEND=length // 发送数据

5.2 一键回充功能

回充功能实现要点：

1. 启动时记录初始位置坐标
2. 通过陀螺仪计算移动轨迹
3. 按原路径返回时步数取反

回充处理代码：

c复制void Home_Mode_Handler(void) {
    static int home_steps = 0;
    if(ABS(current_x) > 10 || ABS(current_y) > 10) {
        Motor_Go_Backward(home_steps); 
        home_steps--;
    } else {
        Motor_Stop();
        LED_Blink(5); // 到家提示灯
    }
}

6. 电源系统设计

6.1 电源问题分析

初期遇到的主要问题：

1. 电机启动时电压跌落严重
2. 系统频繁复位
3. WiFi模块连接不稳定

6.2 解决方案

最终采用的电源优化方案：

1. 电机电源线并联4个4700μF电容
2. 数字电源与电机电源分离
3. 增加电压监控电路

电源电路参数：

7. 项目调试与优化

7.1 常见问题排查

实际测试中发现的主要问题及解决方法：

1. 直线行走偏移：

   • 校准电机步距角
   • 调整左右轮PWM频率

2. 避障误触发：

   • 增加滤波算法
   • 调整检测阈值

3. WiFi连接不稳定：

   • 优化天线布局
   • 增加重连机制

7.2 性能优化建议

1. 路径规划：

   • 增加地图记忆功能
   • 实现更高效的覆盖算法

2. 避障系统：

   • 增加红外传感器辅助
   • 采用多传感器融合算法

3. 电源管理：

   • 增加电池电量检测
   • 实现低功耗模式

8. 项目总结与展望

这个项目实现了扫地机器人的基本功能，包括自动清扫、避障和远程控制。虽然还存在一些不足，但作为学习STM32和机器人控制的实践项目已经达到了预期目标。

关键收获：

1. 深入理解了步进电机控制原理
2. 掌握了多传感器系统集成方法
3. 积累了嵌入式系统调试经验

后续可以继续完善的功能：

1. 增加摄像头实现视觉导航
2. 开发手机APP实现更多控制功能
3. 优化算法提高清扫效率