Ultrahang szenzor

Ultrahang szenzor

UH szenzor működési elv

UH (ultrahang) szenzor bekötése

Leírás hamarosan.

ARDUINO Nano modul lábkiosztása

Kapcsolási rajz hamarosan.

Arduino program:

// beállítások
const int trigPin = 12; // 10 us jel jut erről a lábra
const int echoPin = 13; // ide érkezik vissza a válaszjel
const int LED1 = A0;
const int LED2 = A1;
const int LED3 = A2;
const int LED4 = A3;
const int LED5 = A4;
const int LED6 = A5;
const int LED7 = 2;
int duration = 0;
int distance = 0;
// ---------------------------------------------
// beállítás, bemenet, kimenetek
void setup() 
{
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
pinMode(LED1, OUTPUT);
pinMode(LED2, OUTPUT);
pinMode(LED3, OUTPUT);
pinMode(LED4, OUTPUT);
pinMode(LED5, OUTPUT);
pinMode(LED6, OUTPUT);
 pinMode(LED7, OUTPUT);
Serial.begin(9600);
}
// --------------------------------------------
// hurok végrehajtás
void loop()
{
digitalWrite(trigPin, LOW);
delayMicroseconds(2); // 2 us késleltetés
digitalWrite(trigPin, HIGH);
delayMicroseconds(10); // 10 us késleltetés
digitalWrite(trigPin, LOW);  
duration = pulseIn(echoPin, HIGH);
distance = duration/58.2;
// ---------------------------------------------
// feltételek teljesülése szerinti LED világítás
if ( distance <= 7 )
{
digitalWrite(LED1, HIGH);
}
else
{
digitalWrite(LED1, LOW);
}
if ( distance <= 14 )
{
digitalWrite(LED2, HIGH);
}
else
{
digitalWrite(LED2, LOW);
}
if ( distance <= 21 )
{
digitalWrite(LED3, HIGH);
}
else
{
digitalWrite(LED3, LOW);
}
if ( distance <= 28 )
{
digitalWrite(LED4, HIGH);
}
else
{
digitalWrite(LED4, LOW);
}
if ( distance <= 35 )
{
digitalWrite(LED5, HIGH);
}
else
{
digitalWrite(LED5, LOW);
}
if ( distance <= 42 )
{
digitalWrite(LED6, HIGH);
}
else
{
digitalWrite(LED6, LOW);
}
if ( distance <= 49 )
{
digitalWrite(LED7, HIGH);
}
else
{
digitalWrite(LED7, LOW);
}
delay(100);
}
// - END
--------------------------------------------------
Üzenet küldés: ITT