如何在Arduino中为现有超声波传感器程序添加移动平均计算功能
Arduino超声波程序添加移动平均滤波实现方案
核心实现逻辑
移动平均滤波的逻辑无需改动你现有程序的采集流程,仅需3步嵌入即可:
- 维护一个长度固定的历史采样缓存数组
- 每次新采样值产生后,丢弃数组中最旧的1个值,替换为新值
- 计算数组内所有值的平均值,作为最终输出的距离值
分步实现代码
1. 全局变量定义(放在你现有程序的全局变量区)
// 定义移动平均的采样窗口大小,可根据需求调整 // 数值越大滤波效果越强、采样响应速度越慢 const int WINDOW_SIZE = 5; // 存储历史采样值的缓存数组 int distanceBuffer[WINDOW_SIZE]; // 缓存写入位置的索引 int bufferIndex = 0; // 首次采样初始化标记,避免前几次采样平均值失真 bool bufferInitialized = false;
2. 移动平均计算函数
可直接复制到你现有代码的函数区域(比如setup()和loop()之间):
float getMovingAverage(int newDistance) { // 首次调用时填充全部缓存,避免初始值混乱 if (!bufferInitialized) { for (int i = 0; i < WINDOW_SIZE; i++) { distanceBuffer[i] = newDistance; } bufferInitialized = true; return newDistance; } // 覆盖数组中最旧的采样值 distanceBuffer[bufferIndex] = newDistance; // 索引循环移动,到数组末尾后回到开头 bufferIndex = (bufferIndex + 1) % WINDOW_SIZE; // 计算所有缓存值的平均值 long sum = 0; for (int i = 0; i < WINDOW_SIZE; i++) { sum += distanceBuffer[i]; } return (float)sum / WINDOW_SIZE; }
3. 对接现有采集流程
找到你现有代码中采集到原始距离值的位置,用滤波后的值替换原有原始值即可:
// 这里替换成你现有代码里读取超声波原始距离的代码 long rawDistance = /* 原有超声波读取逻辑的返回值 */; // 调用函数得到滤波后的距离值 float filteredDistance = getMovingAverage(rawDistance); // 后续你原有逻辑(串口输出、阈值判断等)全部用 filteredDistance 替代原有的 rawDistance 即可 Serial.println(filteredDistance);
调整说明
- 窗口大小
WINDOW_SIZE可自行调整:常规超声波场景选3~10即可,5是平衡滤波效果和响应速度的常用值 - 如果你的超声波返回值是浮点类型,只需把上述代码中
int/long类型对应改成float/double即可,逻辑完全兼容 - 如果需要过滤极端跳变的异常值,可在传入函数前加简单判断:若本次采样值与上一次滤波值差值超过20cm,直接丢弃本次采样,滤波效果会更稳定
内容的提问来源于stack exchange,提问作者Marius
相关产品推荐
相关产品推荐

