第 1 页 · Lab 4 超声波自动门
线路按三段想。Arduino 的 Trig 输出触发模块,Echo 输入读往返时长,Servo 控制线收目标角度。电源与地接好后先核对测距,再接舵机。角度、触发距离和保持时间按模型实物设定。
怎么算距离。 回波高了 微秒,来回走 ,单程是 。用 343 m/s 时先换为 cm/μs。比如 Echo 高 2000 μs,距离 cm。
滤波回答示例。 本地代码先取三次中位数,再做指数平滑。原始 4、180、5 cm 排成 4、5、180,中位数是 5 cm,能去掉孤立的大尖峰。若上一轮滤波值为 8 cm,新中位数为 5 cm,则 cm。较大的历史权重让输出更稳,也会延迟对真实变化的响应。本题要求滤波距离最高为 350 cm。
开门顺序。 CLOSED 发现近物体 → OPENING 逐步增加舵机角度 → OPEN 到位并持续刷新最后看到物体的时间 → 离开并等够保持时间 → CLOSING 逐步减角。关门中再靠近时回到 OPENING。可以用两个阈值防止边界抖动,例如 ≤5 cm 判有人、≥10 cm 判离开,两者之间保持原判断。
用 millis() 判断舵机步进是否到点,用 micros() 判回波边沿和超时,每轮只做当前状态允许的操作。本题要求每个循环按 Distance: xx.xx cm 输出。本地 Lab 4 每次完成测距才打印一条,以减轻打印对 Echo 轮询的影响。代码里的高低电平与时间线见《Lab 4 超声自动门》。