Oulis Nikos
5 years ago
1 changed files with 55 additions and 0 deletions
@ -0,0 +1,55 @@ |
|||||
|
/*
|
||||
|
* Ultrasonic Sensor HC-SR04 and Arduino Tutorial |
||||
|
* |
||||
|
* by Dejan Nedelkovski, |
||||
|
* www.HowToMechatronics.com |
||||
|
* |
||||
|
*/ |
||||
|
|
||||
|
// defines pins numbers
|
||||
|
const int trigPin = 9; |
||||
|
const int echoPin = 10; |
||||
|
const int response = 6; |
||||
|
|
||||
|
// defines variables
|
||||
|
long duration; |
||||
|
int distance; |
||||
|
|
||||
|
void setup() { |
||||
|
pinMode(trigPin, OUTPUT); // Sets the trigPin as an Output
|
||||
|
pinMode(response, OUTPUT); |
||||
|
pinMode(echoPin, INPUT); // Sets the echoPin as an Input
|
||||
|
Serial.begin(9600); // Starts the serial communication
|
||||
|
|
||||
|
// Clears the trigPin
|
||||
|
digitalWrite(trigPin, LOW); |
||||
|
delayMicroseconds(2); |
||||
|
} |
||||
|
|
||||
|
void loop() { |
||||
|
// Sets the trigPin on HIGH state for 10 micro seconds
|
||||
|
digitalWrite(trigPin, HIGH); |
||||
|
delayMicroseconds(10); |
||||
|
digitalWrite(trigPin, LOW); |
||||
|
|
||||
|
// Reads the echoPin, returns the sound wave travel time in microseconds
|
||||
|
duration = pulseIn(echoPin, HIGH); |
||||
|
|
||||
|
// Calculating the distance
|
||||
|
distance= duration*0.034/2; |
||||
|
|
||||
|
// Prints the distance on the Serial Monitor
|
||||
|
//Serial.print("Distance: ");
|
||||
|
//Serial.println(distance);
|
||||
|
|
||||
|
if (distance < 5){ |
||||
|
Serial.println("0"); |
||||
|
digitalWrite(response, LOW); |
||||
|
} |
||||
|
else{ |
||||
|
Serial.println("1"); |
||||
|
digitalWrite(response, HIGH); |
||||
|
} |
||||
|
|
||||
|
delay(500); |
||||
|
} |
Loading…
Reference in new issue