How To Make Human Following Robot Using Arduino ? Robot pet // या रोबोट खुद मेरे पीछे पीछे आएगा
CIRCUIT DIAGRAM :-
ARDUINO CODE :-
JUST COPY AND PAST ON ARDUINO SOFTWARE :-
const int trig1 = 3;
const int echo1 = 2;
const int trig2 = 5;
const int echo2 = 4;
const int trig3 = 7;
const int echo3 = 6;
const int in1 = 8;
const int in2 = 9;
const int in3 = 10;
const int in4 =11;
void setup()
{
pinMode(trig1, OUTPUT);
pinMode(echo1, INPUT);
pinMode(trig2, OUTPUT);
pinMode(echo2, INPUT);
pinMode(trig3, OUTPUT);
pinMode(echo3, INPUT);
pinMode (in1, OUTPUT);
pinMode (in2, OUTPUT);
pinMode (in3, OUTPUT);
pinMode (in4, OUTPUT);
}
long dura1, dis1 , dura2, dis2 , dura3, dis3 ;
void loop()
{
digitalWrite(trig1, LOW);
delayMicroseconds(2);
digitalWrite(trig1, HIGH);
delayMicroseconds(10);
digitalWrite(trig1, LOW);
dura1 = pulseIn(echo1, HIGH);
dis1 = dura1/58.2;
if(dis1<120)
{
digitalWrite(in1, HIGH);
digitalWrite(in2, LOW);
digitalWrite(in3, LOW);
digitalWrite(in4, HIGH);
delay(30);
}
else
{
digitalWrite(trig2, LOW);
delayMicroseconds(2);
digitalWrite(trig2, HIGH);
delayMicroseconds(10);
digitalWrite(trig2, LOW);
dura2 = pulseIn(echo2, HIGH);
dis2 = dura2/58.2;
if(dis2<150)
{
digitalWrite(in1, HIGH);
digitalWrite(in2, LOW);
digitalWrite(in3, HIGH);
digitalWrite(in4, LOW);
delay(50);
}
else
{
digitalWrite(trig3, LOW);
delayMicroseconds(2);
digitalWrite(trig3, HIGH);
delayMicroseconds(10);
digitalWrite(trig3, LOW);
dura3 = pulseIn(echo3, HIGH);
dis3 = dura3/58.2;
if(dis3<120)
{
digitalWrite(in1, LOW);
digitalWrite(in2, HIGH);
digitalWrite(in3, HIGH);
digitalWrite(in4, LOW);
delay(30);
}
else
{ digitalWrite(in1, HIGH);
digitalWrite(in2, HIGH);
digitalWrite(in3, HIGH);
digitalWrite(in4, HIGH);
delay(20);
}}}}
THANKS FOR WATCHING
Post a Comment