基于STM32与红外传感器的自动泊车小车:从硬件设计到算法实现
2026/9/16 22:44:44 网站建设 项目流程

简介:本资源是一份面向高校嵌入式课程设计与电子类实践教学的完整项目方案,聚焦基于STM32微控制器与红外传感器实现自动泊车功能,适用于具备C语言基础和初步硬件认知的本科生开展综合实训。压缩包共18个文件(124KB),含7个核心C源码(实现传感器采集、PID调速、停车逻辑等)、6个头文件(定义外设驱动与系统接口)、1份硬件连接说明(.txt)、1份原理图PDF、1个STM32CubeMX配置文件(.ioc)、1张系统建模示意图(.png)及1份结构化README(.md),目录组织清晰,便于分模块理解软硬件协同逻辑。已有520人学习下载,可直接用于课程答辩、实验复现或毕业设计参考。读者将获得从红外测距数据处理、STM32电机PWM控制、避障路径判断到完整工程框架搭建的全流程实践材料,特别包含端口映射说明与硬件电路原理图,显著降低调试门槛。

1. 项目概述:从零到一,用STM32和红外传感器打造你的自动泊车小车

最近在带学生做课程设计,发现“基于STM32的自动泊车系统”是个经久不衰的热门选题。它完美融合了嵌入式控制、传感器融合和简单的算法逻辑,是检验单片机应用能力的绝佳试金石。这个项目听起来高大上,但核心思路并不复杂:就是让一辆小车自己找到车位,然后规规矩矩地停进去。实现方式上,超声波方案更常见,但这次我们剑走偏锋,选用成本更低、响应更快的红外传感器来作为小车的“眼睛”。整个系统的“大脑”则是一块STM32F103C8T6核心板,也就是大家常说的“蓝桥杯”或“最小系统板”,性价比极高。通过这个项目,你不仅能深入理解STM32的GPIO、定时器、PWM和中断,还能掌握基本的传感器数据处理和运动控制策略。无论你是电子信息、自动化专业的学生,还是刚入门的嵌入式爱好者,跟着这篇实操笔记走一遍,你都能收获一辆能自己找车位停车的智能小车,以及一套扎实的嵌入式开发经验。

2. 系统整体设计与核心思路拆解

2.1 为什么选择红外传感器而非超声波?

在自动泊车系统中,测距是关键。常见的方案是超声波传感器(如HC-SR04),它通过计算声波往返时间测距,精度较高,但存在反应速度相对慢、存在最小盲区、易受温湿度影响以及成本稍高等特点。而我们选择红外测距传感器(如GP2Y0A21YK0F或夏普的GP2Y0A02YK0F),主要基于以下几点考量:

首先,响应速度极快。红外传感器基于三角测量原理,输出的是模拟电压值,STM32的ADC可以几乎实时地采集,没有超声波传感器那种触发-等待回波的时间延迟,这对于需要快速反应的小车避障和边沿检测场景非常有利。

其次,成本与集成度。一套常用的红外测距模块价格通常低于超声波模块,且接口简单(仅需电源、地、模拟输出三根线),电路连接更简洁。

再者,项目教学目的。红外传感器的模拟输出特性,迫使我们必须熟练掌握STM32的ADC(模数转换器)功能,包括多通道扫描、DMA传输等进阶应用,这对于学习者来说是一个更全面的技能锻炼。当然,红外传感器也有其短板,比如测量精度受物体颜色和材质影响较大,强光环境下可能失效。因此,在我们的设计中,需要加入软件滤波和误差补偿算法来提升可靠性。

2.2 自动泊车系统的核心工作流程

我们的自动泊车系统模拟的是最常见的“垂直泊车”场景。假设小车沿着一条直线行驶,寻找右侧的空车位。整个流程可以分解为以下几个状态:

  1. 循迹巡航状态:小车依靠底部的红外对管或灰度传感器,沿着预设的轨道(比如用黑色电工胶带贴出的车道)直线行驶。此时,侧向的红外测距传感器持续扫描右侧区域。
  2. 车位探测状态:当侧向传感器连续检测到一段“低-高-低”的距离变化时,即表示发现了一个空位(先遇到车尾,距离变近;然后是空位,距离变远;再遇到车头,距离又变近)。系统需要记录下空位的起始点和宽度。
  3. 泊车决策与执行状态:判断空位宽度是否大于小车的最小泊车需求。如果满足条件,小车在驶过空位一段距离后(为倒车入库预留空间),开始执行预设的泊车轨迹。通常是一个“两步倒车法”:先向右后方倒车,待车身与车位成一定角度后,再向左打方向调整,直至车身摆正且位于车位中央。
  4. 泊车完成状态:小车停稳,关闭电机,可能通过声光提示泊车完成。

系统的控制核心是STM32,它需要实时读取所有传感器的数据,根据状态机做出决策,并通过PWM信号精确控制两个直流电机的转速和转向,实现差速转向。

2.3 硬件系统架构框图

一个典型的系统硬件组成如下:

[电源模块 (7.4V锂电池)] | V [降压模块 (5V/3.3V)] ---> 为单片机、传感器、电机驱动供电 | V [STM32F103C8T6 核心板] <--- 主控大脑 | | | | | | | | V V V V [红外循迹模块] [红外测距模块x3] [电机驱动模块] [OLED显示模块] (用于巡线) (左、右、侧向) (如L298N/TB6612) (显示状态、距离) | | | | V V [直流减速电机x2] [车体底盘]

关键选型解析

  • 主控:STM32F103C8T6,ARM Cortex-M3内核,72MHz主频,64KB Flash,20KB RAM,资源足够且生态丰富。
  • 电机驱动:推荐使用TB6612FNG替代经典的L298N。TB6612效率更高,发热小,支持更大电流,且逻辑控制简单。
  • 红外测距:GP2Y0A21YK0F (10-80cm) 用于侧向探测车位;GP2Y0A02YK0F (20-150cm) 或 TOF激光传感器可用于前方障碍检测,但本项目侧向用21YK0F已足够。
  • 循迹模块:常见的TCRT5000红外反射传感器,数字输出,简单可靠。

3. 核心硬件电路与传感器驱动详解

3.1 STM32最小系统与电源设计

STM32F103C8T6最小系统板需要保证其可靠运行。除了核心的晶振(8MHz)、复位电路和Boot配置电路外,电源部分的去耦电容是重中之重。每个芯片的VDD引脚(3.3V)附近,都必须放置一个0.1uF的陶瓷电容和一个10uF的钽电容,用于滤除高频和低频噪声。电机在启停时会产生很大的电流波动和电压毛刺,良好的电源滤波能极大提高系统稳定性,避免单片机无故复位。

注意:电机驱动模块(如TB6612)的电源必须与单片机的电源共地,但建议使用独立的稳压源或电池供电,或者至少在电机电源入口处并联一个大容量(如470uF)的电解电容,以吸收电机产生的反向电动势。

3.2 红外测距传感器的接口与校准

我们以GP2Y0A21YK0F为例。它有三根线:VCC(5V)、GND、Vo(模拟输出)。Vo引脚需要连接到STM32的ADC输入通道上,例如PA0(ADC1_IN0)。

驱动关键点1:ADC配置在STM32CubeMX中配置ADC时,建议采用“多通道扫描”+“DMA”的模式。这样可以将多个红外传感器的模拟值(比如左、右、侧三个)自动、不间断地搬运到内存数组中,不占用CPU资源。配置步骤:

  1. Analog标签下,使能ADC1,并为需要使用的通道(如IN0, IN1, IN2)使能扫描模式和连续转换模式。
  2. DMA Settings标签下,为ADC1添加一个DMA通道,模式设为循环模式(Circular),数据宽度都为半字(Half Word)。
  3. 在代码中启动ADC的DMA传输:HAL_ADC_Start_DMA(&hadc1, (uint32_t*)adc_value_buf, 3);其中adc_value_buf是一个长度为3的uint16_t数组。

驱动关键点2:电压-距离转换与校准GP2Y0A21的输出电压与距离成反比,且是非线性的。厂家会提供特性曲线图,但我们最好自己进行校准,以提高精度。校准方法:

  1. 将传感器固定,用尺子测量传感器到白色平整墙壁的实际距离D_real(单位:cm)。
  2. 读取此时ADC的值ADC_val。STM32的ADC是12位,参考电压3.3V,所以电压V_out = (ADC_val / 4095.0) * 3.3
  3. 在多个距离点(如10cm, 20cm, 30cm, ... , 80cm)重复上述步骤,得到一组(D_real, V_out)数据。
  4. 在Excel或编程软件中,拟合D_real = k / (V_out - b)D_real = a * pow(V_out, b) + c这样的曲线方程。通常反比函数拟合效果不错。将拟合得到的系数kb写入程序。
// 示例代码:根据ADC值计算距离(假设已拟合出 k=13.0, b=0.42) float IR_GetDistance_cm(uint16_t adc_value) { float voltage = (adc_value / 4095.0f) * 3.3f; if(voltage <= 0.42f) return 80.0f; // 超出量程,返回最大值 float distance_cm = 13.0f / (voltage - 0.42f); if(distance_cm > 80.0f) distance_cm = 80.0f; if(distance_cm < 10.0f) distance_cm = 10.0f; return distance_cm; }

3.3 电机驱动与PWM控制

我们使用TB6612FNG驱动两个直流减速电机。STM32需要输出四路PWM信号来控制电机的速度和方向。以控制电机A为例:

  • AIN1AIN2:控制方向。10正转,01反转,0011刹车。
  • PWMA:连接STM32的PWM输出引脚,控制速度。

配置步骤

  1. 在CubeMX中,选择一个定时器(如TIM3),配置为PWM Generation模式。选择两个通道(如CH1, CH2)对应电机的PWMA和PWMB。
  2. 设置定时器预分频器(PSC)和自动重载值(ARR)以得到合适的PWM频率。对于直流电机,1kHz到10kHz都是常见范围。假设系统时钟72MHz,PSC=71,ARR=999,则PWM频率 = 72MHz / (71+1) / (999+1) = 1kHz。
  3. 另外用两个普通的GPIO输出引脚(如PB0, PB1)控制AIN1和AIN2。
  4. 在代码中,通过__HAL_TIM_SET_COMPARE(&htim3, TIM_CHANNEL_1, speed)来改变占空比,从而调速。

实操心得:电机的实际转速与PWM占空比并非严格的线性关系,尤其是在低速时,由于静摩擦力存在,可能出现“死区”。通常需要设置一个最小启动占空比(例如对应PWM值200/1000)。更好的做法是建立“PWM值-实际转速”的查找表,通过编码器反馈进行闭环PID控制,但这属于进阶内容,课程设计中开环控制已能满足基本移动需求。

4. 软件架构与核心算法实现

4.1 多任务调度与状态机设计

对于这样一个实时性要求较高的系统,不建议在main函数里写一个庞大的while(1)超级循环。更清晰的做法是使用一个简单的时间片轮询调度器,或者直接使用FreeRTOS。考虑到课程设计的复杂度和STM32F103的资源,一个轻量级的裸机状态机是更合适的选择。

我们定义一个全局的系统状态变量System_State,它可以在以下几个状态间切换:

typedef enum { STATE_TRACKING, // 循迹巡航 STATE_DETECTING, // 车位探测 STATE_PARKING, // 泊车执行 STATE_PARKED, // 泊车完成 STATE_ERROR // 异常处理 } SysState_t; SysState_t g_sys_state = STATE_TRACKING;

在主循环中,根据当前状态执行相应的函数,并处理状态迁移。

while (1) { switch(g_sys_state) { case STATE_TRACKING: Tracking_Task(); // 执行巡线,并调用车位探测子函数 break; case STATE_DETECTING: Detecting_Task(); // 精确测量车位尺寸 break; case STATE_PARKING: Parking_Task(); // 执行泊车轨迹 break; // ... 其他状态 } HAL_Delay(10); // 给系统一个基本的时间片 }

4.2 车位探测算法详解

这是项目的核心算法之一。我们使用一个侧向的红外传感器(假设接在ADC通道0)来探测。

基本逻辑

  1. 在循迹过程中,持续读取侧向距离side_dist
  2. 定义一个距离阈值DETECT_THRESHOLD(例如15cm)。当side_dist < DETECT_THRESHOLD时,认为遇到了障碍物(其他车的车身);当side_dist >= DETECT_THRESHOLD时,认为是空位。
  3. 我们需要识别出一个“低(障碍)-高(空位)-低(障碍)”的脉冲。

算法实现(简化版)

#define DETECT_THRESHOLD 15.0f // 单位:cm #define MIN_PARK_WIDTH 50.0f // 最小车位宽度,需大于小车长度 typedef struct { uint8_t is_detecting; float start_distance; // 开始探测时的行驶距离(估算) float current_width; } ParkDetector_t; ParkDetector_t park_detector = {0}; void Parking_Detection_Task(float side_dist, float travel_speed) { static uint8_t last_state = 0; // 0:空位, 1:障碍 uint8_t current_state = (side_dist < DETECT_THRESHOLD) ? 1 : 0; // 状态从“空位”变为“障碍”:可能遇到了车尾,开始记录 if(last_state == 0 && current_state == 1) { park_detector.is_detecting = 1; park_detector.start_distance = estimated_travel_distance; // 需要有一个估算行驶距离的变量 park_detector.current_width = 0.0f; } // 状态为“障碍”时,持续探测到“空位”:进入空位区域,开始累加宽度 else if(park_detector.is_detecting && last_state == 1 && current_state == 0) { // 空位宽度累加:宽度 = 速度 * 时间 // 更准确的做法是用编码器计算实际移动距离 park_detector.current_width += travel_speed * SAMPLE_PERIOD; } // 状态从“空位”变回“障碍”:遇到车头,探测结束 else if(park_detector.is_detecting && last_state == 0 && current_state == 1) { park_detector.is_detecting = 0; if(park_detector.current_width > MIN_PARK_WIDTH) { // 发现合格车位!触发状态迁移 g_sys_state = STATE_DETECTING; // 可以记录下空位的中心位置等信息 } } // 其他情况保持或重置 last_state = current_state; }

这个算法非常基础,实际应用中需要加入软件去抖动(防止因传感器噪声导致的误判)和移动平均滤波(让距离值更平滑)。

4.3 泊车轨迹规划与控制

发现合格车位后,小车需要执行泊车动作。我们采用经典的“两步倒车入库”法。假设小车宽度为W,长度为L,目标车位宽度为P。

  1. 起始位置:小车驶过空位,使车尾大约与空位后部车辆的车头平齐,车身与路沿平行,距离路沿约1.5W。
  2. 第一步倒车:方向盘向右打满(对于差速小车,即右轮反转,左轮正转,形成原地旋转的趋势),以固定半径R向后倒车。通过陀螺仪或编码器积分,当车身与初始方向成约45度角时(或根据几何关系,当后轮中心到达某个特定点),进入下一步。
  3. 第二步调整:方向盘向左打满(左轮反转,右轮正转),继续倒车,直到车身与路沿平行。
  4. 微调入库:直线倒车,通过左右红外传感器调整与两侧障碍物的距离,使小车停在车位中央。

在代码中的实现: 我们需要一个更底层的控制函数来控制小车的运动模型。对于两轮差速小车,其运动学模型是:

  • 线速度v = (v_left + v_right) / 2
  • 角速度ω = (v_right - v_left) / (2 * d),其中d是轮距的一半。

我们可以封装一个函数,给定目标线速度和角速度,计算出左右轮的目标PWM值。

void SetChassisSpeed(float target_v, float target_w) { float v_left = target_v - target_w * WHEEL_BASE / 2.0f; float v_right = target_v + target_w * WHEEL_BASE / 2.0f; // 将速度转换为PWM值(这里需要你根据小车特性标定一个比例系数K) int pwm_left = (int)(v_left * SPEED_TO_PWM_FACTOR); int pwm_right = (int)(v_right * SPEED_TO_PWM_FACTOR); // 限制PWM值在有效范围内 pwm_left = LIMIT(pwm_left, -MAX_PWM, MAX_PWM); pwm_right = LIMIT(pwm_right, -MAX_PWM, MAX_PWM); // 调用底层电机驱动函数 Motor_SetPWM(MOTOR_LEFT, pwm_left); Motor_SetPWM(MOTOR_RIGHT, pwm_right); }

在泊车状态STATE_PARKING中,我们就可以按照预设的轨迹,分时段调用SetChassisSpeed(v, w)。例如,第一步倒车时,设置v为负(倒车),w为正(向右转);持续一段时间或达到特定角度后,切换到v为负,w为负(向左转)。

5. 系统调试与性能优化实战

5.1 传感器数据滤波与融合

原始的红外传感器数据噪声很大,直接使用会导致系统抖动甚至误动作。移动平均滤波(Moving Average Filter)是最简单有效的方法。

#define FILTER_WINDOW_SIZE 5 float IR_Filter_MA(float new_sample) { static float buffer[FILTER_WINDOW_SIZE] = {0}; static uint8_t index = 0; static float sum = 0; sum -= buffer[index]; // 减去最旧的值 buffer[index] = new_sample; // 存入新值 sum += new_sample; index = (index + 1) % FILTER_WINDOW_SIZE; return sum / FILTER_WINDOW_SIZE; }

对于更复杂的场景,可以结合侧向和前方的多个传感器进行数据融合。例如,当侧向传感器判断可能进入车位时,用前向传感器确认前方是否有障碍,避免碰撞。

5.2 电机控制与速度标定

开环控制下,电机的实际速度受电池电压、负载、地面摩擦影响很大。为了获得更精确的移动,可以进行简单的标定:

  1. 让小车在平整地面上直线行驶固定时间(如2秒)。
  2. 测量实际移动距离S。
  3. 计算平均速度v_real = S / t
  4. 记录下此时设置的PWM值pwm_set
  5. 改变PWM值,重复多次,得到一组(pwm_set, v_real)数据点。可以拟合出一条近似的直线或曲线,用于将目标速度更准确地转换为PWM值。

如果小车装有编码器,则可以实现闭环PID控制,速度控制精度会大幅提升。PID算法虽然复杂,但对于STM32来说完全可行,网上有大量开源代码可以参考。

5.3 系统集成调试步骤

调试这样一个多模块系统,切忌一开始就全部组装好上电。应该遵循“分模块调试,逐步集成”的原则:

  1. 基础驱动调试:先确保STM32能正常下载程序,点亮LED,串口能打印信息。
  2. 传感器单独调试:将红外测距模块接上,用ADC读取数值,通过串口打印出电压和计算出的距离,用手在传感器前移动,观察数据变化是否合理。用同样的方法测试循迹模块。
  3. 电机驱动调试:将电机驱动模块与STM32连接,但不接电机。用万用表测量输出端电压,通过程序控制正反转,看电压极性是否正确。然后接上电机,测试单个电机能否正反转、调速。
  4. 底盘运动调试:将两个电机装上车底盘,编写简单的测试程序,让小车前进、后退、左转、右转、原地旋转,检查运动是否正常,左右轮速度是否基本一致(不一致可通过软件PWM补偿)。
  5. 巡线算法调试:在地面贴好黑线,让小车只运行巡线程序,调整传感器阈值和PID参数(如果用了PID),使小车能平稳沿黑线行走。
  6. 车位探测调试:用纸箱模拟两侧的车辆,让小车巡线经过,通过串口或OLED实时输出侧向距离和探测状态,观察算法是否能正确识别出“空位”。
  7. 泊车动作调试:先将泊车轨迹的每一步分解,手动控制小车走到起始位置,然后单步执行倒车动作,观察轨迹是否与预期相符。反复调整第一步和第二步的转向角度或行驶距离。
  8. 全系统联调:将所有功能整合,进行完整的自动泊车测试。此时可能会发现新的问题,如状态切换不流畅、传感器误触发等,需要回头优化相关模块的代码或参数。

6. 常见问题排查与进阶优化方向

6.1 典型问题速查表

问题现象可能原因排查思路与解决方案
红外测距数据跳动剧烈1. 电源噪声
2. 环境光干扰
3. ADC参考电压不稳
1. 检查传感器电源处是否并联了10uF和0.1uF电容。
2. 避免在阳光直射或强光下使用,或给传感器加遮光罩。
3. 确保STM32的VDDA和VSSA引脚连接稳定,并启用ADC的参考电压缓冲(如果芯片支持)。
小车巡线时左右摇摆1. 循迹传感器阈值设置不当
2. 电机响应速度不一致
3. 控制算法过于灵敏
1. 动态校准阈值:记录传感器在黑白线上的读数,取中间值。
2. 对左右轮PWM进行微调补偿。
3. 在控制算法中加入死区或使用PD控制代替简单的P控制。
无法识别车位1. 探测阈值DETECT_THRESHOLD设置不合理
2. 传感器安装高度/角度不对
3. 算法去抖时间太短或太长
1. 用实测数据调整阈值,确保能稳定区分车身和空位。
2. 确保侧向传感器水平指向侧面,探测面与地面平行,高度与模拟车辆障碍物匹配。
3. 增加状态保持计数器,例如连续N个采样周期都为“空位”才判定状态改变。
泊车轨迹偏离严重1. 起始位置不准确
2. 左右轮实际转速与设定值差异大
3. 地面打滑
1. 在巡线阶段增加更精确的停车定位,例如使用编码器精确控制驶过空位的距离。
2. 进行电机速度标定,或引入编码器进行速度闭环控制。
3. 使用摩擦力更大的轮胎,或在算法中引入陀螺仪进行航向角闭环控制。
系统偶尔死机或复位1. 电机干扰导致电源跌落
2. 堆栈溢出
3. 中断冲突
1. 加强电源滤波,电机电源与单片机电源隔离。
2. 检查局部大数组是否定义在函数内导致栈溢出,可移至全局区或增大栈大小。
3. 检查中断优先级配置,避免在中断服务程序中执行耗时操作。

6.2 从课程设计到竞赛项目的进阶优化

如果你不满足于基本功能,想让你的自动泊车系统更智能、更稳定,甚至参加竞赛,可以考虑以下优化方向:

  1. 传感器升级与融合

    • 增加编码器:在电机轴上安装光电或霍尔编码器,实现精确的里程计计算和速度闭环控制,让移动和转角控制更精准。
    • 增加陀螺仪:使用MPU6050等IMU传感器获取小车的实时姿态角(Yaw),用于泊车过程中的航向角闭环控制,彻底解决因打滑导致的轨迹偏离问题。
    • 多传感器融合:结合红外、超声波甚至低成本的激光雷达(如RPLIDAR A1)进行环境感知,提高车位识别和障碍物检测的鲁棒性。
  2. 控制算法升级

    • PID控制:对小车速度、巡线偏差、航向角等变量实施PID控制,系统响应更平滑、更快速。
    • 路径规划算法:研究更优的泊车路径,如基于圆弧和直线的组合,或者使用更高级的规划算法,使泊车过程更高效、更接近人类驾驶员。
    • 状态估计:使用卡尔曼滤波器融合编码器和陀螺仪数据,得到更准确的小车位置和速度估计。
  3. 架构与性能优化

    • 引入RTOS:使用FreeRTOS管理巡线、探测、控制、显示等不同任务,提高代码的模块化程度和实时响应能力。
    • 无线调试与监控:通过蓝牙模块(如HC-05)或Wi-Fi模块(如ESP8266)将小车的传感器数据、状态信息实时发送到电脑或手机端,方便远程调试和数据分析。
    • 人机交互优化:增加按键选择模式、语音提示、更丰富的OLED图形界面等。

这个基于STM32和红外传感器的自动泊车系统项目,就像一把钥匙,为你打开了嵌入式系统、机器人控制以及传感器应用的大门。从最基础的GPIO点灯,到复杂的多传感器数据融合与决策控制,每一步的调试成功都会带来巨大的成就感。我个人的体会是,硬件项目的调试过程就是与不确定性斗争的过程,耐心和系统性的方法比单纯的编程技巧更重要。当你看到小车第一次颤颤巍巍却成功地自己停进“车位”时,你会觉得所有熬的夜、掉的头发都是值得的。最后一个小建议:务必用好版本控制(如Git),为每个能正常工作的阶段打上标签,这样当你的修改把系统搞崩溃时,总能快速回退到一个稳定点。

本文还有配套的精品资源,点击获取

需要专业的网站建设服务?

联系我们获取免费的网站建设咨询和方案报价,让我们帮助您实现业务目标

立即咨询