3、超声波传感器原理与驱动：HC-SR04工作原理、时序图、GPIO触发与回声捕获、距离计算与误差分析

在机器人感知体系中，超声波传感器是近距避障与停靠定位的“经济型主力”。HC-SR04 以极低的硬件成本（约 2~5 元人民币）和简单的 GPIO 接口，成为 STM32 入门到中级项目中最常见的测距方案。然而，许多开发者只停留在“Trig 拉高 10µs，Echo 读高电平时间”的层面，对内部声波飞行时间模型、GPIO 捕获精度、温度补偿以及多径反射误差缺乏系统认知。本节将从 HC-SR04 的物理工作原理出发，逐步拆解时序图、STM32 的 GPIO 触发与回声捕获实现、距离换算公式，并结合实测数据完成误差分析与工程调优。

上图展示了 HC-SR04 在 STM32 驱动下的完整信号链路。STM32 通过 GPIO 输出触发脉冲，HC-SR04 内部电路发射 40kHz 超声波并等待回波，最终以 Echo 引脚的高电平持续时间返回飞行时间信息。图中同时标注了四个关键误差源：温度漂移、多径反射、GPIO 捕获抖动和最小盲区。这些误差源将在后续小节中逐一展开分析。

3.1 HC-SR04 核心工作原理与物理模型

HC-SR04 本质上是一个声纳测距模块，内部集成了超声波发射器、接收器以及控制电路。其工作频率为 40kHz，超出人耳听觉范围（20Hz~20kHz），因此不会对机器人运行环境造成噪音干扰。模块的测距原理基于声波在空气中的传播速度与往返时间的关系：

距离 D = (声速 v × 往返时间 t) / 2

其中，声速 v 并非固定常数，而是随环境温度变化。在 20°C 标准室温下，声速约为 343m/s；温度每升高 1°C，声速增加约 0.6m/s。这一物理特性决定了 HC-SR04 在温度变化剧烈的环境中（如户外机器人）必须进行温度补偿，否则会产生系统性测距偏差。

HC-SR04 的测距范围标称为 2cm~400cm，但实际可靠测量范围通常在 3cm~300cm 之间。小于 2cm 时，发射脉冲尚未完全结束，回波与发射波混叠，模块无法正确检测；大于 300cm 时，回波信号衰减严重，接收器灵敏度不足以稳定触发。模块的波束角约为 15°，这意味着障碍物必须大致垂直于传感器轴线，否则反射声波会偏离接收器方向，导致测距失败或数值跳变。

3.2 时序图深度解读与 GPIO 驱动流程

HC-SR04 的通信协议极其简洁，仅需两根 GPIO 线即可完成测距。其完整时序分为三个阶段：触发阶段、发射与等待阶段、回波捕获阶段。下表总结了各阶段的电气特性和时间参数：

从时序图可以看出，STM32 的驱动逻辑非常清晰：先将 Trig 引脚配置为推挽输出，拉高至少 10µs 后拉低；然后将 Echo 引脚配置为输入捕获模式，等待上升沿到来时启动定时器，下降沿到来时停止定时器。两次沿之间的计数值即为往返飞行时间。

// STM32 HAL 库驱动示例（基于定时器输入捕获）
void HC_SR04_Trigger(void) {
    HAL_GPIO_WritePin(TRIG_GPIO_Port, TRIG_Pin, GPIO_PIN_SET);
    delay_us(10);  // 至少 10µs
    HAL_GPIO_WritePin(TRIG_GPIO_Port, TRIG_Pin, GPIO_PIN_RESET);
}

// 在 Echo 上升沿中断中启动定时器
void HAL_GPIO_EXTI_Callback(uint16_t GPIO_Pin) {
    if (GPIO_Pin == ECHO_Pin) {
        if (echo_state == 0) {
            __HAL_TIM_SET_COUNTER(&htim2, 0);
            HAL_TIM_IC_Start_IT(&htim2, TIM_CHANNEL_1);
            echo_state = 1;
        } else {
            echo_duration = __HAL_TIM_GET_COUNTER(&htim2);
            HAL_TIM_IC_Stop_IT(&htim2, TIM_CHANNEL_1);
            echo_state = 0;
        }
    }
}

上述代码展示了基于定时器输入捕获的典型实现。需要注意的是，Echo 引脚必须配置为外部中断模式，且中断优先级要高于普通任务，以避免在系统繁忙时丢失沿信号。定时器时钟频率建议设置为 1MHz（即 1µs 分辨率），这样计数器的值直接等于微秒数，简化距离换算。

3.3 距离计算与温度补偿

距离计算的核心公式为：

D_cm = (echo_duration_us × v) / (2 × 10000)

其中，echo_duration_us 是定时器捕获的微秒数，v 是声速（单位 m/s）。若不做温度补偿，通常取 v = 343m/s（20°C 标准值）。但工程实践中，温度变化对测距精度的影响不可忽视。下表给出了不同温度下的声速和对应的距离误差：

从表中可以看出，在 0°C 到 40°C 的温度跨度内，3m 距离的误差可达 ±10cm 以上。对于避障机器人而言，10cm 的误差可能导致碰撞或路径规划失败。因此，在温度变化明显的场景中，建议通过 STM32 内置温度传感器或外部 DS18B20 采集环境温度，实时修正声速：

float temperature = read_temperature();  // 读取温度，单位 °C
float sound_speed = 331.4f + 0.6f * temperature;
float distance_cm = (echo_duration_us * sound_speed) / 20000.0f;

3.4 误差分析与实战案例：多径反射与滤波策略

HC-SR04 在实际应用中最大的误差来源并非温度，而是多径反射和障碍物表面特性。当超声波遇到非垂直表面（如斜面、圆柱面）时，反射声波不会沿原路返回，导致 Echo 引脚捕获到的是二次反射或边缘绕射信号，测距结果会出现随机跳变。此外，如果障碍物表面是吸音材料（如海绵、布料），回波强度不足，模块可能完全无法触发。

以下是一个典型的实战案例：某轮式机器人使用 HC-SR04 进行前方避障，在实验室环境中测距稳定，但移动到走廊拐角处时，测距值频繁从 80cm 跳变到 150cm 甚至 300cm。初步排查发现，走廊拐角处存在金属消防栓和玻璃门，超声波在光滑表面产生镜面反射，导致回波路径异常。

案例分析过程：

1. 现象记录：连续采集 100 次测距数据，发现约 30% 的数据偏离真实距离超过 20cm，且跳变无规律。
2. 数据诊断：将测距数据按时间序列绘制，发现跳变点集中在机器人转向时，此时传感器轴线与墙面夹角大于 15°。
3. 根因定位：波束角限制导致非垂直反射失效；同时玻璃门产生镜面反射，回波路径长度与实际距离不符。
4. 解决方案：采用“中值滤波 + 滑动平均”双重滤波策略。先对连续 5 次采样取中值，剔除异常跳变；再对中值结果进行 3 次滑动平均，平滑输出。
5. 结果对比：滤波后，测距误差从 ±20cm 降低到 ±3cm，满足避障需求。

// 中值滤波 + 滑动平均示例
uint16_t samples[5];
uint16_t median_filter(uint16_t *arr, uint8_t len) {
    // 冒泡排序取中值
    for (int i = 0; i < len - 1; i++) {
        for (int j = 0; j < len - 1 - i; j++) {
            if (arr[j] > arr[j + 1]) {
                uint16_t tmp = arr[j];
                arr[j] = arr[j + 1];
                arr[j + 1] = tmp;
            }
        }
    }
    return arr[len / 2];
}

除了软件滤波，硬件安装角度也至关重要。传感器应尽量垂直于预期障碍物方向，且避免与多个反射面形成“声波陷阱”。对于需要全向避障的机器人，建议采用 3~5 个 HC-SR04 环形布置，每个传感器负责一个扇区，通过 STM32 的 DMA 或定时器轮询实现多通道测距。

3.5 常见误区与工程复盘

在 STM32 驱动 HC-SR04 的过程中，开发者常犯以下错误，导致测距不稳定或系统卡死：

• 误区一：Echo 引脚未配置为输入捕获模式。有些开发者将 Echo 配置为普通 GPIO 读取，通过轮询电平变化来计时。这种方式在系统繁忙时会丢失沿信号，导致测距超时。正确做法是使用定时器输入捕获或外部中断。
• 误区二：忽略超时处理。当障碍物超出量程或回波丢失时，Echo 引脚可能长时间保持高电平，导致程序阻塞在等待下降沿的循环中。必须设置超时阈值（如 30ms），超时后强制复位状态机。
• 误区三：连续触发间隔过短。HC-SR04 完成一次测距需要约 20ms（对应 4m 量程），如果触发间隔小于 20ms，上一次回波尚未处理完，下一次触发会干扰测量。建议触发周期 ≥50ms。
• 误区四：未考虑最小盲区。当障碍物距离小于 2cm 时，模块输出不可靠。在机器人停靠或对接场景中，应结合红外或编码器数据进行融合，避免依赖超声波近距离数据。