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

 



No comments