0701 distansmetr

Материал из УМКИwiki
Версия от 12:06, 12 августа 2019; 195.209.192.5 (обсуждение) (Новая страница: «<code> ////////////////////////////////////////////// // 2019.07.18 woronin, umkiedu@gmail.com // Датчик расстояния ульразвук…»)
(разн.) ← Предыдущая версия | Текущая версия (разн.) | Следующая версия → (разн.)
Перейти к навигации Перейти к поиску

//////////////////////////////////////////////
//     2019.07.18 woronin,  umkiedu@gmail.com
//     Датчик расстояния ульразвуковой - без библиотек pulseIn()
//     Robot UMKI controller  K6_3
//     Замер расстояния от датчика до препятствия, вывод в Сериал порт
//////////////////////////////////////////////
#define Trig A3
#define Echo A4
#define ledPin A0
void setup() 
{  
 pinMode(Trig, OUTPUT); //инициируем как выход 
 pinMode(Echo, INPUT); //инициируем как вход 
 pinMode(ledPin, OUTPUT); 
 Serial.begin(9600); 
 /* задаем скорость общения. В нашем случае с компьютером */
} 
unsigned int impulseTime=0; 
unsigned int distance_sm=0; 
void loop() 
{  
 digitalWrite(Trig, HIGH); 
 /* Подаем импульс на вход trig дальномера */
 delayMicroseconds(10); // равный 10 микросекундам 
 digitalWrite(Trig, LOW); // Отключаем 
 impulseTime=pulseIn(Echo, HIGH); // Замеряем длину импульса 
 distance_sm=impulseTime/58; // Пересчитываем в сантиметры 
 Serial.println(distance_sm); // Выводим на порт 
 if (distance_sm<30) // Если расстояние менее 30 сантиметром 
 {     
   digitalWrite(ledPin, HIGH); // Светодиод горит 
 }  
 else 
 {   
   digitalWrite(ledPin, LOW); // иначе не горит 
 }   
 delay(100); 
 /* ждем 0.1 секунды, Следующий импульс может быть излучён, только после исчезновения эха от предыдущего. 
  Это время называется периодом цикла (cycle period). 
  Рекомендованный период между импульсами должен быть не менее 50 мс.  */
}