Контакты

Ардуино: ультразвуковой дальномер HC-SR04. Ультразвуковой дальномер hc-sr04 - Измерительная техника - Инструменты Ультразвуковой дальномер на микроконтроллере своими руками схема

Bruno Gavand

Проект, в котором рассматривается простое и дешевое решение ультразвукового сенсора для измерения расстояния, выполнен на базе микроконтроллера PIC16F877A компании , но пользователями исходный код может быть адаптирован под другие микроконтроллеры. Сенсор может быть встроен в пользовательские разработки и устройства: детекторы присутствия, роботы, автомобильные системы парковки, устройства измерения расстояния и пр.

Отличительные особенности:

  • небольшое количество внешних компонентов;
  • размер кода 200 Байт;
  • диапазон рабочих расстояний: 30 см - 200 см;
  • точность измерений ±1 см;
  • индикация при выходе за пределы измерений.

Как известно, скорость звука в воздухе равна около 340 м/с. Таким образом, принцип ультразвукового сенсора состоит в посылке ультразвуковой импульса частотой 40 кГц и отслеживание отраженного сигнала (эхо). Конечно, звука вы не услышите, но ультразвуковой датчик способен определить отраженный импульс. Следовательно, зная время прохождения импульса и отраженного ультразвукового сигнала, мы сможем получить расстояние. Разделив на два, мы получим расстояние от ультразвукового датчика до первого препятствия, от которого был отражен сигнал.

В устройстве применен пьезокерамический ультразвуковой излучатель MA40B8S и пьезокерамический ультразвуковой датчик MA40B8R открытого типа. Основные параметры приведены в таблице ниже.

Устройство Назначение Частота Направленность,
град
Емкость,
пФ
Область
детектирования,
м
Входное
напряжение,
макс, В
MA40B8S Излучатель 40 кГц 50 (симметричный) 2000 0.2 … 6 40
MA40B8R Датчик 40 кГц 50 (симметричный) 2000 0.2 … 6

Для тестирования была применена отладочная платформа компании .

Однако пользователь может использовать любой микроконтроллер PIC, у которого имеется хотя бы один канал АЦП и один канал ШИМ.

Принципиальная схема ультразвукового сенсора

Управление излучателем осуществляется посредством транзистора BD135 . Диод 1N4007 служит для защиты транзистора от обратного напряжения. Благодаря использованию транзистора и резонансной цепочки, которая образована параллельным включением дросселя L1 330 мкГн и конденсатора, образованного самим излучателем, напряжение питания излучателя составит около 20 В, что обеспечивает дальность обнаружения до 200 см. Стоит заметить, что управлять излучателем возможно непосредственно с вывода микроконтроллера, однако в таком случае диапазон расстояний не превышает 50 см.

Датчик подключен непосредственно к АЦП микроконтроллера (при использовании PIC16F877A - канал 1 АЦП), резистор, включенный параллельно датчику, необходим для согласования импеданса.

Для начала необходимо послать ультразвуковой импульс. Сигнал с частотой 40 кГц легко получить с использованием аппаратного ШИМ микроконтроллера. Отраженный сигнал с датчика поступает в АЦП, разрешение АЦП составляет 4 мВ, что вполне достаточно для считывания данных с датчика, и дополнительные компоненты не нужны.

Внешний вид макетной платы ультразвукового сенсора


Этот сенсор - самое простое решение, и поэтому имеет несколько недостатков: небольшая вибрация ультразвукового приемника может привести к неправильным измерениям. Так как посылаемый импульс не модулирован и не кодирован, посторонние источники ультразвуковой частоты могут влиять на измерение, и все это может привести к неправильным результатам (выход за пределы измерений).

Надписи на изображении:

ultrasonic burst - ультразвуковой импульс;
mechanical echo (removed by software) - механическое эхо (исключается программно);
ultrasonic wave reflected by remote object - ультразвуковая волна, отраженная от удаленного объекта.

Цена деления осциллографа: по горизонтали - 1 мс/дел, по вертикали - 5 мВ/дел.

Механическое эхо исключается программно путем введения задержки. Отраженная волна, имеющая амплитуду около 40 мВ, получена через 9.5 мс после отправленного импульса. Учитывая, что скорость звука 340 м/с, получаем:

0.0095 / 2×340 = 1.615 м.

В реальности - это был потолок помещения на расстоянии от датчика 172 см, на ЖК дисплее, установленном на отладочной плате было отображено значение 170 см.

Загрузки

Исходный код к проекту на микроконтроллере PIC16F877A (компилятор mikroC) -

Некоторые замечания:
Все детали, нужные для создания ультразвукового дальномера по этой схеме продаются в чипидипе, стоит около 500-900р за все(точно не помню - денег много было, не считал:-). (корпус, пищалки, разъемы прочее)
Некоторые коментарии по схеме ультразвукового дальномера:
1. Пищалки можно юзать любые, под разные задачки лучше разные ... для моей задачи - чем болше габариты тем лучше, угол 50.
2. Можно попробывать использовать только одну относительно дорогую AD822 а на место компаратора чего-нить по дешевле (у меня просто не было ничего другого под рукой вообще)
3. В меге для генерации 40 килогерц можно использовать таймер, для этого нужно подобрать другой резонатор. (у меня были только 16 и 12.. они не подходят)
4. Скорость звука в воздухе вообще-то зависит от температуры - если очень важна точность (мне она пофигу) то учитывай это
5. Заметь- что на картинке дальномера в корпусе - пищалки не касаются пластмассы - один чел говорил, что при мегаточной настройки (данная схема способна и на такое) звук от пищалки до микрофона будет передаваться по корпусу, по этому лучше перестраховаться
6. Пример простейшей прошивки меги на си(под эту схему) можно посмотреть
7. Программатор лучше использовать STK200/300 он же avreal - софт и схему можно дернуть
8. По уму в прошивке надо отслеживать и начало и конец "пачки", в примере только начало(точность вырастет конкретно).. может допишу - выложу.
9. Пищалка очень любит 40кгц - чуть в сторону уже совсем не то... наверное правду в мануале пишут, что резонансная:-)
10. НА схеме неспроста в излучателе понапиханы транзисторы - желающим дать больше вольт чем 12 - велком - один чел говорил, что будет пищать громче(считай дальше). Я этого делать не стал по трем причинам: во первых 24 вольта еще где-то найти надо, во вторых текущаа версия при соотв настройке ризистора итак видит стену за 4 метра, т.е. мне не где испытывать его, да и не нужно. Ну а третья причина этот же чел говорил, что пищалки имеют тенденцию дохнуть на этом вольтаже
11. Общий совет: можно найти все резисторы и конденсаторы в нерабочем блоке питания от компа ATX(они там все где-то 1/8 вата) - денег сэкономишь!
12. Ошибочное мнение, что ультразвук издаваемый пищалкой как-то могут услышать собики и прочие твари, он на них плохо влияет: у меня собака пришла как то ночью и уснула напротив пищалки включенной.
13. Еще - так просто к сведенью - меги и прочие 8битный контроллеры от атмела - гонятся отлично.. у меня в некоторых задачках вместо положенных 16 работают на 24 и нормально.
14. При устрановке R5 выше килоома (10, 50, 100) получится очень большое усиление, и скорее всего понадобятся рупора, зато дальность измерений сильно вырастет.
15. Вместо устрановки рупоров (при большом R5) см. выше, можно модернизировать прошивку, что б она не ждала в начальный момент времени полезный сигнал. Но тогда нельзя будет мерять расстояния около 10 см и меньше.

Коментраий к совету 8 - желтым обозначен момент срабатывания прерывания МК ультразвукового дальномера на приеме, собственно можно ограничится именно этим первым моментом, подождать чуть-чуть и делать следующее измерение, генерая следущюю пачку импульсов - а время полета звука считать временем от первого посланного импульса(или последнего не суть важно) до ПЕРВОГО принятого.
Второй вариант - обозначен красным - более точный - поскольку пачка импульсов как правило доходит отнюдь не в идеальном виде и не полностью (может не быть пары тройки первых или последних импульсов), собствено даже на картинке видно, что она "сплющилась" по краям, хотя отправлялся идеальный прямоугольник импульсов - так вот: суть в том, что середина пачки должна оставаться на месте несмотря на то, что края ее уже могут не почувствоваться компаратором. Так что точность в несколько.. (милиметров надо думать) зависит от того учитывалась в прошивке ультразвукового дальномера середина или только начало пачки при приеме ее обратно.

Ультразвуковые датчики расстояния Ардуино очень востребованы в робототехнических проектах из-за своей относительной простоты, достаточной точности и доступности. Они могут быть использованы как приборы, помогающие объезжать препятствия, получать размеры предметов, моделировать карту помещения и сигнализировать о приближении или удалении объектов. Одним из распространенных вариантов такого устройства является датчик расстояния, в конструкцию которого входит ультразвуковой дальномер HC SR04. В этой статье мы познакомимся с принципом действия датчика расстояния, рассмотрим несколько вариантов подключения к платам Arduino, схему взаимодействия и примеры скетчей.

Способность ультразвукового датчика определять расстояние до объекта основано на принципе сонара – посылая пучок ультразвука, и получая его отражение с задержкой, устройство определяет наличие объектов и расстояние до них. Ультразвуковые сигналы, генерируемые приемником, отражаясь от препятствия, возвращаются к нему через определенный промежуток времени. Именно этот временной интервал становится характеристикой помогающей определить расстояние до объекта.

Внимание! Так как в основу принципа действия положен ультразвук, то такой датчик не подходит для определения расстояния до звукопоглощающих объектов. Оптимальными для измерения являются предметы с ровной гладкой поверхностью.

Описание датчика HC SR04

Датчик расстояния Ардуино является прибором бесконтактного типа, и обеспечивает высокоточное измерение и стабильность. Диапазон дальности его измерения составляет от 2 до 400 см. На его работу не оказывает существенного воздействия электромагнитные излучения и солнечная энергия. В комплект модуля с HC SR04 arduino также входят ресивер и трансмиттер.

Ультразвуковой дальномер HC SR04 имеет такие технические параметры:

  • Питающее напряжение 5В;
  • Рабочий параметр силы т ока – 15 мА;
  • Сила тока в пассивном состоянии < 2 мА;
  • Обзорный угол – 15°;
  • Сенсорное разрешение – 0,3 см;
  • Измерительный угол – 30°;
  • Ширина импульса – 10 -6 с.

Датчик оснащен четырьмя выводами (стандарт 2, 54 мм):

  • Контакт питания положительного типа – +5В;
  • Trig (Т) – выход сигнала входа;
  • Echo (R) – вывод сигнала выхода;
  • GND – вывод «Земля».

Где купить модуль SR04 для Ардуино

Датчик расстояния – достаточно распространенный компонент и его без труда можно найти в интернет-магазинах. Самые дешевые варианты (от 40-60 рублей за штуку), традиционно на всем известном сайте.

Модуль датчика расстояния HC-SR04 для Ардуино Еще один вариант ультразвукового сенсора HC-SR04 у надежного поставщика
Датчики расстояния SR05 Ultrasonic HC-SR05 (улучшенные характеристики) Модуль HC-SR05 HY-SRF05 для UNO R3 MEGA2560 DUE от надежного поставщика

Схема взаимодействия с Arduino

Для получения данных, необходимо выполнить такую последовательность действий:

  • Подать на выход Trig импульс длительностью 10 микросек;
  • В ультразвуковом дальномере hc sr04 подключенном к arduino произойдет преобразование сигнала в 8 импульсов с частотой 40 кГц, которые через излучатель будут посланы вперед;
  • Когда импульсы дойдут до препятствия, они отразятся от него и будут приняты приемником R, что обеспечит наличие входного сигнала на выходе Echo;
  • На стороне контроллера полученный сигнал при помощи формул следует перевести в расстояние.

При делении ширины импульса на 58.2, получим данные в сантиметрах, при делении на 148 – в дюймах.

Подключение HC SR04 к Arduino

Выполнить подключение ультразвукового датчика расстояния к плате Arduino достаточно просто. Схема подключения показана на рисунке.

Контакт земли подключаем к выводу GND на плате Arduino, выход питания соединяем с 5V. Выходы Trig и Echo подсоединяем к arduino на цифровые пины. Вариант подключения с помощью макетной платы:

Библиотека для работы с HC SR04

Для облегчения работы с датчиком расстояния HC SR04 на arduino можно использовать библиотеку NewPing. Она не имеет проблем с пинговыми доступами и добавляет некоторые новые функции.

К особенностям библиотеки можно отнести:

  • Возможность работы с различными ультразвуковыми датчиками;
  • Может работать с датчиком расстояния всего через один пин;
  • Отсутствие отставания на 1 секунду при отсутствии пинга эха;
  • Для простой коррекции ошибок есть встроенный цифровой фильтр;
  • Максимально точный расчет расстояния.

Скачать бибилотеку NewPing можно

Точность измерения расстояния датчиком HC SR04

Точность датчика зависит от нескольких факторов:

  • температуры и влажности воздуха;
  • расстояния до объекта;
  • расположения относительно датчика (согласно диаграммы излучения);
  • качества исполнения элементов модуля датчика.

В основу принципа действия любого ультразвукового датчика заложено явление отражения акустических волн, распространяющихся в воздухе. Но как известно из курса физики, скорость распространения звука в воздухе зависит от свойств этого самого воздуха (в первую очередь от температуры). Датчик же, испуская волны и замеряя время до их возврата, не догадывается, в какой именно среде они будут распространяться и берет для расчетов некоторую среднюю величину. В реальных условиях из-за фактора температуры воздуха HC-SR04 может ошибаться от 1 до 3-5 см.

Фактор расстояния до объекта важен, т.к. растет вероятность отражения от соседних предметов, к тому же и сам сигнал затухает с расстоянием.

Также для повышения точности надо правильно направить датчик: сделать так, чтобы предмет был в рамках конуса диаграммы направленности. Проще говоря, “глазки” HC-SR04 должны смотреть прямо на предмет.

Для уменьшения ошибок и погрешности измерений обычно выполняются следующие действия:

  • усредняются значения (несколько раз замеряем, убираем всплески, потом находим среднее);
  • с помощью датчиков (например, ) определяется температура и вносятся поправочные коэффициенты;
  • датчик устанавливается на серводвигатель, с помощью которого мы “поворачиваем голову”, перемещая диаграмму направленности влево или вправо.

Примеры использования датчика расстояния

Давайте рассмотрим пример простого проекта с платой Arduino Uno и датчиком расстояния HC SR04. В скетче мы будем получать значение расстояния до предметов и выводить их в монитор порта в среде Arduino IDE. Вы сможете легко изменить скетч и схему подключения, чтобы датчик сигнализировал о приближении или отдалении предмета.

Подключение датчика к ардуино

При написании скетча использовалась следующий вариант распиновки подключения датчика:

  • VCC: +5V
  • Trig – 12 пин
  • Echo – 11 пин
  • Земля (GND) – Земля (GND)

Пример скетча

Начнем работу с датчиком сразу с относительного сложного варианта – без использования внешних библиотек.

В данном скетче мы выполняем такую последовательность действий:

  • Коротким импульсом (2-5 микросекунды) переводим датчик расстояния в режим эхолокации, при котором в окружающее пространство высылаются ультразвуковые волны с частотой 40 КГц.
  • Ждем, пока датчик проанализирует отраженные сигналы и по задержке определит расстояние.
  • Получаем значение расстояния. Для этого ждем, пока HC SR04 выдаст на входе ECHO импульс, пропорциональный расстоянию. Мы определяем длительность импульса с помощью функции pulseIn, которая вернет нам время, прошедшее до изменения уровня сигнала (в нашем случае, до появления обратного фронта импульса).
  • Получив время, мы переводим его в расстояние в сантиметрах путем деления значения на константу (для датчика SR04 это 29.1 для сигнала «туда», столько же для сигнала «обратно», что в сумме даст 58.2).

Если датчик расстояния не выполняет считывание сигнала, то преобразование выходного сигнала никогда не примет значения короткого импульса – LOW. Так как у некоторых датчиков время задержки варьируется в зависимости от производителя, рекомендуется при использовании указанных скетчей выставлять его значение вручную (мы это делаем в начале цикла).

Если расстояние составляет более 3 метров, при котором HC SR04 начинает плохо работать, время задержки лучше выставлять более 20 мс, т.е. 25 или 30 мс.

#define PIN_TRIG 12 #define PIN_ECHO 11 long duration, cm; void setup() { // Инициализируем взаимодействие по последовательному порту Serial.begin (9600); //Определяем вводы и выводы pinMode(PIN_TRIG, OUTPUT); pinMode(PIN_ECHO, INPUT); } void loop() { // Сначала генерируем короткий импульс длительностью 2-5 микросекунд. digitalWrite(PIN_TRIG, LOW); delayMicroseconds(5); digitalWrite(PIN_TRIG, HIGH); // Выставив высокий уровень сигнала, ждем около 10 микросекунд. В этот момент датчик будет посылать сигналы с частотой 40 КГц. delayMicroseconds(10); digitalWrite(PIN_TRIG, LOW); // Время задержки акустического сигнала на эхолокаторе. duration = pulseIn(PIN_ECHO, HIGH); // Теперь осталось преобразовать время в расстояние cm = (duration / 2) / 29.1; Serial.print("Расстояние до объекта: "); Serial.print(cm); Serial.println(" см."); // Задержка между измерениями для корректной работы скеча delay(250); }

Скетч с использованием библиотеки NewPing

Теперь давайте рассмотрим вариант скетча с использованием библиотеки NewPing. Код существенно упростится, т.к. все описанные ранее действия спрятаны внутри библиотеки. Все, что нам нужно сделать – создать объект класса NewPing, указав пины, с помощью которых мы подключаем датчик расстояния и использовать методы объекта. В нашем примере для получения расстояния в сантиметрах нужно использовать ping_cm().

#include #define PIN_TRIG 12 #define PIN_ECHO 11 #define MAX_DISTANCE 200 // Константа для определения максимального расстояния, которое мы будем считать корректным. // Создаем объект, методами которого будем затем пользоваться для получения расстояния. // В качестве параметров передаем номера пинов, к которым подключены выходы ECHO и TRIG датчика NewPing sonar(PIN_TRIG, PIN_ECHO, MAX_DISTANCE); void setup() { // Инициализируем взаимодействие по последовательному порту на скорости 9600 Serial.begin(9600); } void loop() { // Стартовая задержка, необходимая для корректной работы. delay(50); // Получаем значение от датчика расстояния и сохраняем его в переменную unsigned int distance = sonar.ping_cm(); // Печатаем расстояние в мониторе порта Serial.print(distance); Serial.println("см"); }

Пример подключения ультразвукового дальномера HC SR04 с одним пином

Подключение HC-SR04 к Arduino может быть выполнено посредством использования одного пина. Такой вариант пригодится, если вы работаете с большим проектом и вам не хватает свободных пинов. Для подключения вам нужно просто установить между контактами TRIGи ECHO резистор номиналом 2.2K и подключить к ардуино контакт TRIG.

#include #define PIN_PING 12 // Пин с Arduino соединен с пинами trigger и echo на датчике расстояния #define MAX_DISTANCE 200 // Максимальное расстояние, которое мы способны контролировать (400-500см). NewPing sonar(PIN_PING, PIN_PING, MAX_DISTANCE); // Регулировка пинов и максимального расстояния void setup() { Serial.begin(9600); // Открывается протокол с данными и частотой передачи 115200 бит/сек. } void loop() { delay(50); // Задержка в 50 мс между генерируемыми волнами. 29 мс – минимально допустимое значение unsigned int distanceSm = sonar.ping(); // Создание сигнала, получение параметра его продолжительности в мкс (uS). Serial.print("Ping: "); Serial.print(distanceSm / US_ROUNDTRIP_CM); // Пересчет параметра времени в величину расстояния и вывод результата (0 соответствует выходу за допустимый предел) Serial.println("cm"); }

Краткие выводы

Ультразвуковые датчики расстояния достаточно универсальны и точны, что позволяет их использовать для большинства любительских проектов. В статье рассмотрен крайне популярный датчик HC SR04, который легко подключается к плате ардуино (для этого следует сразу предусмотреть два свободных пина, но есть вариант подключения и с одним пином). Для работы с датчиком существуют несколько бесплатных библиотек (в статье рассмотрена лишь одна из них, NewPing), но можно обойтись и без них – алгоритм взаимодействия с внутренним контроллером датчика достаточно прост, мы показали его в этой статье.

Исходя из собственного опыта, можно утверждать, что датчик HC-SR04 показывает точность в пределах одного сантиметра на расстояниях от 10 см до 2 м. На более коротких и дальних дистанциях возможно появление сильных помех, что сильно зависит от окружающих предметов и способа использования. Но в большинстве случаев HC-SR04 отлично справлялся со своей работой.

HC-SR04 один из самых распространённых и самый дешевый дальномер в робототехники. Он позволяет измерять расстояния от 2см до 4м (может и больше) с приличной точностью 0,3-1см. На выходе цифровой сигнал, длительность которого пропорционально равна расстоянию до препятствий.

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

Данный датчик был мною уже давно приобретен и лежал в своей коробочке почти забытый. Но в рамках одного проекта был извлечен на белый свет и, для ознакомления, на основе него и платы вольтметра был построен достаточно компактный дальномер.

УЗ дальномер HC-SR04

Характеристики датчика:

Питание — 5В
Потребляемый ток — менее 2мА
Эффективный угол обзора — 15гр
Измеряемое расстояние — 2см - 5м
Точность — 3мм
Взяты из документации к датчику

Принцип работы HC-SR04

Принцип работы

У модуля есть 4 вывода, два из которых это питание - земля и +5В, а еще два - данные. Опрос модуля производится следующим способом: на вывод Trig посылается импульс длительностью 10мкс. Дальномер генерирует посылку из 8 ультразвуковых 40КГц импульсов. Которые, отражаясь от большинства поверхностей, возвращаются обратно, если не угаснут в пути. Сразу после отправки сигнала на Trig начинаем ожидать ответного положительного сигнала выводе Echo, длительностью от 150мкс до 25мс, который пропорционален расстоянию до объекта. Точнее времени прохождения от датчика до препятствия и обратно. Если ответа нет (датчик не услышит своего эха) - то сигнал вернется длиною в 38 мс. Расстояние до объекта (препятствия) вычисляется по следующей простой формуле:

Где: L - расстояние в сантиметрах до объекта, а F - длина импульса на выводе Echo.
Рекомендуемое время опроса датчика 50мс или 20Гц.

Первые тесты этого модуля проводил при помощи цифрового осциллографа, который ловил ответ от модуля и в ручную, быстрым замыканием Trig на + питания, пытался получить стартовый 10мкс импульс. В половине случаев получалось [:)] .

Конструкция

Датчик был подключен к плате вольтметра с общим анодом, немного модифицированному для работы с ним (убраны ненужные делитель с конденсатором и добавлен вывод от RA3). Был применен микроконтроллер от 5 версии вольтметра - PIC16F688, с переработанной для УЗ дальномера прошивкой.

Ультразвуковой датчик расстояния HC-SR04 (и схожие модули) используют ультразвуковые волны, чтобы определить дистанцию до объекта.

Вообще говоря, нам нужно будет выяснить расстояние до объекта, потому что сам датчик просто учитывает время, которое уходит на то, чтобы поймать эхо от отправленных им звуковых волн. Это происходит таким образом:

  1. Модуль посылает звуковые волны, в то же время подавая напряжение на особый пин эха.
  2. Модуль ловит отраженный сигнал и снимает напряжение с пина.

Это все, что делает ультразвуковой дальномер. Дистанцию мы можем определить сами, ведь мы знаем, сколько времени заняло у звука на то, чтобы совершить путешествие от модуля и обратно (по тому, насколько долго пин эха был под напряжением), а также мы знаем скорость звука в воздухе. Но мы не будем сильно вдаваться в детали и позволим Arduino сделать все вычисления.

Кстати, несмотря на то, что принцип работы всех ультразвуковых датчиков одинаков, НЕ ВСЕ ИЗ НИХ производят одинаковый вывод напряжения на пин эха. Так что, если у вас модуль, отличный от HC-S04, то уделите внимание четвертому шагу, где описаны возможные проблемы, и проверьте, возможно, ваш модуль есть в списке. Если его там нет, то придётся разбираться своими силами.

Шаг 1: Сборка железа своими руками

Сборка очень проста (собирайте всё отключенным от напряжения):

  1. Соедините 5V от Ардуино с пином VCC на модуле
  2. Соедините GND от Ардуино с GND на модуле
  3. Соедините цифровой пин 7 на Ардуино с пином Trig на модуле
  4. Соедините цифровой модуль 8 на Ардуино с пином Эхо на модуле

Шаг 2: Программирование модуля HC-SR04

Для того чтобы видеть результаты работы программы, нужно запустить serial monitor на Ардуино. Если вы не знакомы с этой функцией, то сейчас самое время открыть её и узнать о ней побольше — это отличная вещь, помогающая отладить код. В интерфейсе Ардуино посмотрите в правый угол, там вы найдёте кнопку, запускающую серийный монитор, она похожа на увеличительное стекло, кликните на ней и монитор откроется (или выберите TOOLS/Serial Monitor, или нажмите Ctrl+Shift+M).

Вот набросок рабочей программы:

// Начала Скетча для Аруино —
// Определяем константы (константы не изменяются и если вы попробуете переопределить их то получите ошибку во время компиляции)
const int triggerPin = 7; // создаёт константу с именем «triggerPin» и назначает на неё цифровой пин 7
const int echoPin = 8; // создаёт константу с именем «echoPin» и назначает на неё цифровой пин 8
// Определяем переменные (переменные могут изменяться и обычно изменяются по ходу программы, в них могут содержаться какие-либо рассчитываемые значения)
int duration = 0; // создаёт переменную с именем «duration» для хранения значения, возвращаемого pulseIn, изначально значение задаётся равным «0»
int distance = 0; // создаёт переменную для хранения значения, рассчитанного в качестве расстояния до объекта, находящегося перед датчиком, изначально значение задаётся равным «0»
void setup() // В этой секции можно настроить вашу плату и другие параметры, необходимые для работы вашей программы.
{
Serial.begin(9600); // инициализирует последовательную коммуникацию через USB между Ардуино и компьютером, нам это понадобится
//определяем режимы пинов
pinMode(triggerPin, OUTPUT); // «triggerPin» будет использоваться для ВЫВОДА, номер пина объявлен выше в секции «Определяем переменные»
pinMode(echoPin, INPUT); // «echoPin» будет использоваться для ВВОДА, номер пина объявлен выше в секции «Определяем переменные»
} // конец настройки
// всё, что было написано выше считывается программой лишь один раз — при Запуске или Сбросе (Reset)
void loop() // код программы в зацикленной части считывается беспрестанно и повторяется до тех пор, пока не выключится питание, или пока не будет сделан сброс
{
digitalWrite(triggerPin, HIGH); //начинает подавать ультразвуковые волны с модуля HC-SR04
delay(5); // небольшая пауза, она нужна для того, чтобы модуль функционировал правильно (можно уменьшить это значение, другие мои программы работают при значении 1)
digitalWrite(triggerPin, LOW); //останавливает ультразвуковые волны, идущие от модуля HC-SR04
duration = pulseIn(echoPin, HIGH); //особая функция, позволяющая определить продолжительность времени, при котором на пин эха подавалось напряжение в последнем завершенном цикле подачи ультразвука
delay(10); // опять небольшая пауза. Она нужна для стабильности, слишком короткая пауза может не дать результата
distance = (duration/2) / 58; //преобразовываем продолжительность в расстояние (значение, сохранённое в «duration» делится на 2, затем это значение делится на 58**) ** для сантиметров
delay(500); // еще одна пауза для стабильности — можете поиграть со значением, но это может испортить работу программы, так что по умолчанию используйте 500
Serial.print(distance); //отправляет вычисленное значение расстояния на серийный монитор
Serial.println(» cm»); //добавляет слово «cm» после значения расстояния и переводит каретку на серийном мониторе на новую строку
Serial.println(); //добавляет пустую строку на серийном мониторе (для удобства чтения)
} // Конец цикла

_________________________________________________

Итак, после прочитывания моей инструкции я понял, что набросок программы не соответствует моему пониманию простоты. Поэтому я выкладываю тот же самый набросок с лёгкими комментариями.

// Программа модуля ультразвукового датчика расстояния HC-SC04
const int triggerPin = 7; //триггер на 7
const int echoPin = 8; // ECHO на 8
int duration = 0; // хранит значение из pulseIn
int distance = 0; // хранит значение рассчитанного расстояния
void setup()
{
Serial.begin(9600);
pinMode(triggerPin, OUTPUT); //определяет режимы пинов
pinMode(echoPin, INPUT);
}
void loop()
{
digitalWrite(triggerPin, HIGH); // начинает отправлять ультразвук
delay(5); //необходимая команда, настраивается (но не ниже 10микросекунд)
digitalWrite(triggerPin, LOW); // модуль прекращает отправлять ультразвук
duration = pulseIn(echoPin, HIGH); // определяет, как долго подавалось напряжение на пин ECHO
delay(10); //необходимая команда, настраивается, но аккуратно
distance = (duration/2) / 58; // высчитываем расстояние в см до объекта
delay(500); // пауза для стабильности, уменьшение может сломать ход программы, лучше оставить как есть
Serial.print(distance); // отправляет текущее значение, хранимое в distance на серийный монитор
Serial.println(» cm»); // отображает слово «cm» сразу после расстояния
Serial.println(); // создаёт одну пустую строку в серийном мониторе (для удобства чтения)
}

К инструкции я также приложу файлы.ino

Файлы

  1. HCSR04BareBones.ino — этот файл сильно закомментирован и содержит кое-какую информацию по модулю HC-SR04, а также инфу по сборке.
  2. BareBonesLight.ino — модуль с небольшим количеством комментариев

Вот мой совет. Я знаю, что код работает, но перед тем, как прикреплять файлы к инструкции, я перепроверил всё и серийный монитор стабильно показывал «0 cm». Проблема оказалась в сгоревшем модуле, а его замена исправила ситуацию.

Смотрите на то, как откликается программа, если решите поиграть со значениями команд delay. Опытным путём я обнаружил, что уменьшение значений delay или приравнивание их к 0 может привести программу к нерабочему состоянию.

После того, как вы настроили устройство, всё ограничивается лишь вашим воображением. Вы можете сверяться, что неподвижные объекты находятся на том же расстоянии и остаются неподвижными. Вы можете использовать монитор, чтобы получать уведомления о том, что какой-то объект передвинулся мимо датчика и т.д.

Схема выше использовалась мной для того, чтобы определять, что от датчика все объекты находятся на расстоянии дальше, чем 60 см. В проекте использовалось три диода и пищалка. Когда все предметы были дальше 60 см, горел зеленый диод. Когда что-то приближалось менее чем на 60см, зеленый диод гас, а красный загорался. Если объект оставался на близком расстоянии на какой-то время, то загорался второй красный диод, а пищалка начинала пищать. Когда объект удалялся на 60см, пищалка умолкала, красные диоды гасли, и снова загорался зеленый. Это не предотвращало все ложные тревоги, но работало с большинством случаев, когда мимо датчика пролетала птица или любопытная белка пробегала мимо.

Шаг 4: Известные проблемы

Если вы видите модель вашего ультразвукового модуля в этом пункте, то листайте ниже. Надеюсь, вы найдёте вашу проблему и решите её.

  1. US-105
  2. DYP-ME007TX

Модуль US-105

Ультразвуковой модуль US-105 использует вывод GPIO на пин ECHO, что подразумевает другие вычисления для определения расстояния. При выводе GPIO на пин ECHO, пин не удерживается под напряжением во время отправки волны. Вместо этого, при получении отраженного ультразвука на пин ECHO подается конкретное напряжение, которое пропорционально времени, потребовавшемуся ультразвуковой волне для того, чтобы отправиться и вернуться обратно на датчик. С этим модулем будет работать такой код:

// Код для ультразвукового модуля US-105 unsigned int EchoPin = 2; unsigned int TrigPin = 3; unsigned long Time_Echo_us = 0; //Len_mm_X100 = length*100 unsigned long Len_mm_X100 = 0; unsigned long Len_Integer = 0; // unsigned int Len_Fraction = 0; void setup() { Serial.begin(9600); pinMode(EchoPin, INPUT); pinMode(TrigPin, OUTPUT); } void loop() { digitalWrite(TrigPin, HIGH); delayMicroseconds(50); digitalWrite(TrigPin, LOW); Time_Echo_us = pulseIn(EchoPin, HIGH); if((Time_Echo_us 1)) { Len_mm_X100 = (Time_Echo_us*34)/2; Len_Integer = Len_mm_X100/100; Len_Fraction = Len_mm_X100%100; Serial.print("Растояние: "); Serial.print(Len_Integer, DEC); Serial.print("."); if(Len_Fraction < 10) Serial.print("0"); Serial.print(Len_Fraction, DEC); Serial.println("mm"); delay(1000); } // Конец программы

Модуль DYP-ME007TX

// Код для ультразвукового модуля DYP-ME007TX /* Инструкции по подключению * 5V от Ардуино к VCC на модуле * GNG от Ардуино к GND на модуле * OUT от модуля к цифровому пину 7 на Ардуино */ #include #define RXpin 7 #define TXpin 7 SoftwareSerial mySerial(RXpin, TXpin); long mili = 0; byte mybuffer = {0}; byte bitpos = 0; void setup() { Serial.begin(9600); mySerial.begin(9600); } void loop() { bitpos = 0; while (mySerial.available()) { if (bitpos < 4) { mybuffer = mySerial.read(); } else break; } mySerial.flush(); mili = mybuffer << 8 | mybuffer; Serial.print("Distance: "); Serial.print(mili / 25.4); Serial.print (" inches"); Serial.println(); delay(500); }

Понравилась статья? Поделитесь ей