Introduction: Arduino and Ultrasonic Sensor Control Servo and Distance Meter
Arduino and ultrasonic sensor control servo and distance meter
In this project you can see how to control servo motor and tu calculate distance using arduino and ultrasonic sensor. You need: 1.Arduino (uno,nano,pro mini)
Hardware
Put the trigpin of ultrasonic sensor in pin 7 on arduino. Put the echopin of ultrasonic sensor in pin 6 on arduino. Put vcc pin of ultrasinic sensor to 5v on arduino. Put servo to pin 8 on arduino. Put gnd of ultrasonic to gnd on arduino. and connect arduino with Pc.
code:
#include <Servo.h>
#define trigPin 7
#define echoPin 6
Servo servo;
void setup()
{
Serial.begin (9600);
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
servo.attach(8);
}
void loop()
{
long duration, distance;
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
duration = pulseIn(echoPin, HIGH);
distance = (duration/2) / 29.1;
if (distance < 5)
{
Serial.println("the distance is less than 5");
servo.write(120);
}
else
{
servo.write(0);
}
if (distance > 60 || distance <= 0)
{
Serial.println("The distance is more than 60");
}
else
{
Serial.print(distance);
Serial.println(" cm");
}
delay(500);
}
