Занятие 23

Ультразвуковой дальномер. Парктроник

Устройство из жизни
Парктроник в машине, электронная рулетка, урна с крышкой, которая открывается сама.
Новые понятия
эхолокация, HC-SR04, pulseIn, расчёт расстояния, ложные замеры
Детали на пару
HC-SR04, 3 светодиода, пьезоизлучатель
В PinHIL
Парктроник — чем ближе стена, тем чаще писк, ближе 10 см — непрерывный сигнал ЕСТЬ · Практика · 14. Парктроник — сцена: машина сдаёт задом к стене гаража ЕСТЬ
Игра
Битва роботов ЕСТЬ

Что делаем сегодня

Парктроник в машине пищит всё чаще, когда стена близко. Электронная рулетка меряет комнату без ленты. Сегодня вы научите плату слышать эхо и соберёте парктроник.

Новое

  • Эхолокация — расстояние по времени эха.
  • Дальномер HC-SR04.
  • pulseIn — длительность импульса.
  • Ложные замеры и защита от них.

Эхолокация

Раскадровка мультика «Эхо летучей мыши» (занятие 23)

Мультик «Эхо летучей мыши»

Летучая мышь кричит ультразвуком и слушает эхо: чем дольше ждать, тем дальше препятствие. Так же работают эхолот и парктроник. Звук в воздухе проходит около 343 м/с — 0,0343 см за микросекунду.

HC-SR04

Ультразвуковой дальномер меряет время эха и пересчитывает его в сантиметры

Дальномер меряет время эха

У дальномера два «глаза»: излучатель и приёмник. Плата даёт на TRIG импульс 10 мкс — датчик «кричит», а на ECHO держит HIGH, пока ждёт эхо. pulseIn(ECHO, HIGH) меряет это время в микросекундах. Звук идёт туда и обратно, поэтому в сантиметрах — время / 58.

Важно. Ложные замеры бывают всегда: мягкая одежда глушит эхо, угол уводит звук в сторону, эхо может не вернуться вовсе — тогда pulseIn ждёт до таймаута и возвращает 0. Лечение — таймаут в pulseIn и медиана из трёх–пяти замеров.

Расстояние в сигнал

Парктроник: расстояние превращается в частоту писка и цвет огней

Расстояние превращается в частоту писка и цвет огней

Парктроник превращает расстояние в паузу между писками: чем ближе, тем чаще. Ближе 10 см — непрерывный сигнал. Функция map() снова выручает.

Команды занятия

ЗаписьЧто делает
digitalWrite(TRIG, HIGH); delayMicroseconds(10);импульс-«крик»
pulseIn(ECHO, HIGH, 30000)время эха, мкс; 0 — эха нет за 30 мс
t / 58расстояние в сантиметрах
map(d, 10, 60, 60, 500)расстояние → пауза между писками

Практика

На вкладке «Практика» — задания в лаборатории. Расстояние меняют ползунком дальномера.

  • «Парктроник» — огни по зонам, писк всё чаще, ближе 10 см — непрерывно.
  • Сцена «Парктроник» — та же программа, а расстояние меняет машина: она сдаёт задом к стене гаража.
  • Из задачника: «Бесконтактный выключатель», «Уровень в баке», «Охрана периметра».

Соберём на плате

Понадобится: HC-SR04, 3 светодиода, резисторы 220 Ом, пассивная пищалка, макетная плата, провода.

  1. USB отключён. Дальномер: VCC — 5V, GND, TRIG — D9, ECHO — D10.
  2. Светодиоды: зелёный D5, жёлтый D6, красный D7; пищалка — D8.
  3. Сосед проверяет — подключаем USB.
  4. Сначала — расстояние в монитор порта. Сверьте с линейкой: ошибка 1–2 см — норма.
  5. Огни по зонам: дальше 60 см, от 31 до 60, ближе 30.
  6. Писк: чем ближе, тем чаще; ближе 10 см — непрерывно.

Частые ошибки

Что видноПочемуКак исправить
всегда 0 или 999TRIG и ECHO перепутаныTRIG — выход платы, ECHO — вход
программа «подвисает» на секундунет таймаута в pulseInтретий параметр — 30000 мкс
расстояние вдвое большеделение на 29 вместо 58туда и обратно: делим на 58
случайные числадатчик смотрит в мягкую тканьпроверять на твёрдой поверхности

Проверь себя

  1. Почему время эха делят на 58, а не на 29?
  2. Что вернёт pulseIn(ECHO, HIGH, 30000), если эхо не вернулось?
  3. Почему мягкая одежда мешает дальномеру?
  4. Эхо пришло через 2900 мкс. Сколько сантиметров до препятствия?
  5. Что такое медиана из пяти замеров и чем она лучше одного замера?

Для сильных

  • Медианный фильтр: сравните сырые и отфильтрованные данные в мониторе порта.
  • На вкладке «Практика» — «Бесконтактный выключатель», «Уровень в баке», «Охрана периметра».

Домой

Найдите, где вокруг вас работают датчики расстояния: в машине, в лифте, у автоматических дверей.

Практика

Задания для продвинутых

  1. ★ Рулетка. Расстояние на экране с одним знаком после запятой, среднее из пяти замеров.
  2. ★ Бесконтактный выключатель. Взмах рукой ближе 10 см переключает лампу; повторное срабатывание — не раньше чем через секунду.
  3. ★ Уровень в баке. Датчик над баком: заполнение в процентах, шкала из светодиодов, тревога ниже 20 %.
  4. ★★ Медианный фильтр. Медиана из пяти замеров против выбросов: сравните сырые и отфильтрованные данные в мониторе порта.
  5. ★★ Скорость звука. Поставьте препятствие на точно известном расстоянии, по времени эха вычислите скорость звука и сравните с формулой v = 331 + 0,6·T (температуру — с DHT).
  6. ★★ Автодверь. Сервопривод открывает дверь, когда человек ближе 50 см, и закрывает через 3 секунды после его ухода — но никогда не закрывается на человека.
  7. ★★ Охрана периметра. Тревога, если кто-то стоит ближе метра дольше 3 секунд; быстрый проход мимо не считается.
  8. ★★ Терменвокс на ультразвуке. Высота звука зависит от расстояния до руки. ПЛАТА
  9. ★★ Счётчик в проходе. Человек проходит перед датчиком — расстояние падает и возвращается. Считайте проходы без двойного счёта.
  10. ★★★ Сонар. Сервопривод поворачивает дальномер от 0 до 180°, монитор порта печатает «угол, расстояние». Постройте карту комнаты в таблице или на экране.

← Arduino в PinHIL