From Expert TTA, 2 Months ago, written in C++.

This paste is a reply to Line Follower from Expert TTA - go back

Embed

Viewing differences between Line Follower and Re: Line Follower

#define m1 5  //Right Motor MA1
#define m2 4  //Right Motor MA2
#define m3 2  //Left Motor MB1
#define m4 3  //Left Motor MB2
#define e1 11  //Right Motor Enable Pin EA
#define e2 10 //Left Motor Enable Pin EB

//**********5 Channel IR Sensor Connection**********//
#define ir1 A0
A1
#define ir2 A1
A2
#define ir3 A2
A3
#define ir4 A3
A4
#define ir5 A4
A5
//*************************************************//

int speed = 150;

void setup() {
  pinMode(m1, OUTPUT);
  pinMode(m2, OUTPUT);
  pinMode(m3, OUTPUT);
  pinMode(m4, OUTPUT);
  pinMode(e1, OUTPUT);
  pinMode(e2, OUTPUT);
  pinMode(ir1, INPUT);
  pinMode(ir2, INPUT);
  pinMode(ir3, INPUT);
  pinMode(ir4, INPUT);
  pinMode(ir5, INPUT);
}

void loop() {
  //Reading Sensor Values
  int s1 = digitalRead(ir1);  //Left Most Sensor
  int s2 = digitalRead(ir2);  //Left Sensor
  int s3 = digitalRead(ir3);  //Middle Sensor
  int s4 = digitalRead(ir4);  //Right Sensor
  int s5 = digitalRead(ir5);  //Right Most Sensor

  //if only middle sensor detects black line
  if((s1 == 1) && (s2 == 1) && (s3 == 0) && (s4 == 1) && (s5 == 1))
  {
    //going forward with full speed
    analogWrite(e1, speed); //you can adjust the speed of the motors from 0-255
    analogWrite(e2, speed); //you can adjust the speed of the motors from 0-255
    digitalWrite(m1, HIGH);
    digitalWrite(m2, LOW);
    digitalWrite(m3, HIGH);
    digitalWrite(m4, LOW);
  }

  //if only left sensor detects black line
  if((s1 == 1) && (s2 == 0) && (s3 == 1) && (s4 == 1) && (s5 == 1))
  {
    //going right with full speed
    analogWrite(e1, speed); //you can adjust the speed of the motors from 0-255
    analogWrite(e2, speed); //you can adjust the speed of the motors from 0-255
    digitalWrite(m1, HIGH);
    digitalWrite(m2, LOW);
    digitalWrite(m3, LOW);
    digitalWrite(m4, LOW);
  }

  //if only left most sensor detects black line
  if((s1 == 0) && (s2 == 1) && (s3 == 1) && (s4 == 1) && (s5 == 1))
  {
    //going right with full speed
    analogWrite(e1, speed); //you can adjust the speed of the motors from 0-255
    analogWrite(e2, speed); //you can adjust the speed of the motors from 0-255
    digitalWrite(m1, HIGH);
    digitalWrite(m2, LOW);
    digitalWrite(m3, LOW);
    digitalWrite(m4, HIGH);
  }

  //if only right sensor detects black line
  if((s1 == 1) && (s2 == 1) && (s3 == 1) && (s4 == 0) && (s5 == 1))
  {
    //going left with full speed
    analogWrite(e1, speed); //you can adjust the speed of the motors from 0-255
    analogWrite(e2, speed); //you can adjust the speed of the motors from 0-255
    digitalWrite(m1, LOW);
    digitalWrite(m2, LOW);
    digitalWrite(m3, HIGH);
    digitalWrite(m4, LOW);
  }

  //if only right most sensor detects black line
  if((s1 == 1) && (s2 == 1) && (s3 == 1) && (s4 == 1) && (s5 == 0))
  {
    //going left with full speed
    analogWrite(e1, speed); //you can adjust the speed of the motors from 0-255
    analogWrite(e2, speed); //you can adjust the speed of the motors from 0-255
    digitalWrite(m1, LOW);
    digitalWrite(m2, HIGH);
    digitalWrite(m3, HIGH);
    digitalWrite(m4, LOW);
  }

  //if middle and right sensor detects black line
  if((s1 == 1) && (s2 == 1) && (s3 == 0) && (s4 == 0) && (s5 == 1))
  {
    //going left with full speed
    analogWrite(e1, speed); //you can adjust the speed of the motors from 0-255
    analogWrite(e2, speed); //you can adjust the speed of the motors from 0-255
    digitalWrite(m1, LOW);
    digitalWrite(m2, LOW);
    digitalWrite(m3, HIGH);
    digitalWrite(m4, LOW);
  }

  //if middle and left sensor detects black line
  if((s1 == 1) && (s2 == 0) && (s3 == 0) && (s4 == 1) && (s5 == 1))
  {
    //going right with full speed
    analogWrite(e1, speed); //you can adjust the speed of the motors from 0-255
    analogWrite(e2, speed); //you can adjust the speed of the motors from 0-255
    digitalWrite(m1, HIGH);
    digitalWrite(m2, LOW);
    digitalWrite(m3, LOW);
    digitalWrite(m4, LOW);
  }

  //if middle, left and left most sensor detects black line
  if((s1 == 0) && (s2 == 0) && (s3 == 0) && (s4 == 1) && (s5 == 1))
  {
    //going right with full speed
    analogWrite(e1, speed); //you can adjust the speed of the motors from 0-255
    analogWrite(e2, speed); //you can adjust the speed of the motors from 0-255
    digitalWrite(m1, HIGH);
    digitalWrite(m2, LOW);
    digitalWrite(m3, LOW);
    digitalWrite(m4, LOW);
  }

  //if middle, right and right most sensor detects black line
  if((s1 == 1) && (s2 == 1) && (s3 == 0) && (s4 == 0) && (s5 == 0))
  {
    //going left with full speed
    analogWrite(e1, speed); //you can adjust the speed of the motors from 0-255
    analogWrite(e2, speed); //you can adjust the speed of the motors from 0-255
    digitalWrite(m1, LOW);
    digitalWrite(m2, LOW);
    digitalWrite(m3, HIGH);
    digitalWrite(m4, LOW);
  }

  //if all sensors are on a black line
  if((s1 == 0) && (s2 == 0) && (s3 == 0) && (s4 == 0) && (s5 == 0))
  {
    //stop
    digitalWrite(m1, LOW);
    digitalWrite(m2, LOW);
    digitalWrite(m3, LOW);
    digitalWrite(m4, LOW);
  }
}

Replies to Re: Line Follower

Title	Name	Language	UNIX	When
Re: Re: Line Follower	Expert TTA	cpp	1709660583	2 Months ago.

Author

Title

Language

Your paste - Paste your paste here

#define m1 5  //Right Motor MA1
#define m2 4  //Right Motor MA2
#define m3 2  //Left Motor MB1
#define m4 3  //Left Motor MB2
#define e1 11  //Right Motor Enable Pin EA
#define e2 10 //Left Motor Enable Pin EB

//**********5 Channel IR Sensor Connection**********//
#define ir1 A1
#define ir2 A2
#define ir3 A3
#define ir4 A4
#define ir5 A5
//*************************************************//

int speed = 150;

void setup() {
  pinMode(m1, OUTPUT);
  pinMode(m2, OUTPUT);
  pinMode(m3, OUTPUT);
  pinMode(m4, OUTPUT);
  pinMode(e1, OUTPUT);
  pinMode(e2, OUTPUT);
  pinMode(ir1, INPUT);
  pinMode(ir2, INPUT);
  pinMode(ir3, INPUT);
  pinMode(ir4, INPUT);
  pinMode(ir5, INPUT);
}

void loop() {
  //Reading Sensor Values
  int s1 = digitalRead(ir1);  //Left Most Sensor
  int s2 = digitalRead(ir2);  //Left Sensor
  int s3 = digitalRead(ir3);  //Middle Sensor
  int s4 = digitalRead(ir4);  //Right Sensor
  int s5 = digitalRead(ir5);  //Right Most Sensor

//if only middle sensor detects black line
  if((s1 == 1) &amp;&amp; (s2 == 1) &amp;&amp; (s3 == 0) &amp;&amp; (s4 == 1) &amp;&amp; (s5 == 1))
  {
    //going forward with full speed 
    analogWrite(e1, speed); //you can adjust the speed of the motors from 0-255
    analogWrite(e2, speed); //you can adjust the speed of the motors from 0-255
    digitalWrite(m1, HIGH);
    digitalWrite(m2, LOW);
    digitalWrite(m3, HIGH);
    digitalWrite(m4, LOW);
  }
  
  //if only left sensor detects black line
  if((s1 == 1) &amp;&amp; (s2 == 0) &amp;&amp; (s3 == 1) &amp;&amp; (s4 == 1) &amp;&amp; (s5 == 1))
  {
    //going right with full speed 
    analogWrite(e1, speed); //you can adjust the speed of the motors from 0-255
    analogWrite(e2, speed); //you can adjust the speed of the motors from 0-255
    digitalWrite(m1, HIGH);
    digitalWrite(m2, LOW);
    digitalWrite(m3, LOW);
    digitalWrite(m4, LOW);
  }
  
  //if only left most sensor detects black line
  if((s1 == 0) &amp;&amp; (s2 == 1) &amp;&amp; (s3 == 1) &amp;&amp; (s4 == 1) &amp;&amp; (s5 == 1))
  {
    //going right with full speed 
    analogWrite(e1, speed); //you can adjust the speed of the motors from 0-255
    analogWrite(e2, speed); //you can adjust the speed of the motors from 0-255
    digitalWrite(m1, HIGH);
    digitalWrite(m2, LOW);
    digitalWrite(m3, LOW);
    digitalWrite(m4, HIGH);
  }

//if only right sensor detects black line
  if((s1 == 1) &amp;&amp; (s2 == 1) &amp;&amp; (s3 == 1) &amp;&amp; (s4 == 0) &amp;&amp; (s5 == 1))
  {
    //going left with full speed 
    analogWrite(e1, speed); //you can adjust the speed of the motors from 0-255
    analogWrite(e2, speed); //you can adjust the speed of the motors from 0-255
    digitalWrite(m1, LOW);
    digitalWrite(m2, LOW);
    digitalWrite(m3, HIGH);
    digitalWrite(m4, LOW);
  }

//if only right most sensor detects black line
  if((s1 == 1) &amp;&amp; (s2 == 1) &amp;&amp; (s3 == 1) &amp;&amp; (s4 == 1) &amp;&amp; (s5 == 0))
  {
    //going left with full speed 
    analogWrite(e1, speed); //you can adjust the speed of the motors from 0-255
    analogWrite(e2, speed); //you can adjust the speed of the motors from 0-255
    digitalWrite(m1, LOW);
    digitalWrite(m2, HIGH);
    digitalWrite(m3, HIGH);
    digitalWrite(m4, LOW);
  }

//if middle and right sensor detects black line
  if((s1 == 1) &amp;&amp; (s2 == 1) &amp;&amp; (s3 == 0) &amp;&amp; (s4 == 0) &amp;&amp; (s5 == 1))
  {
    //going left with full speed 
    analogWrite(e1, speed); //you can adjust the speed of the motors from 0-255
    analogWrite(e2, speed); //you can adjust the speed of the motors from 0-255
    digitalWrite(m1, LOW);
    digitalWrite(m2, LOW);
    digitalWrite(m3, HIGH);
    digitalWrite(m4, LOW);
  }

//if middle and left sensor detects black line
  if((s1 == 1) &amp;&amp; (s2 == 0) &amp;&amp; (s3 == 0) &amp;&amp; (s4 == 1) &amp;&amp; (s5 == 1))
  {
    //going right with full speed 
    analogWrite(e1, speed); //you can adjust the speed of the motors from 0-255
    analogWrite(e2, speed); //you can adjust the speed of the motors from 0-255
    digitalWrite(m1, HIGH);
    digitalWrite(m2, LOW);
    digitalWrite(m3, LOW);
    digitalWrite(m4, LOW);
  }

//if middle, left and left most sensor detects black line
  if((s1 == 0) &amp;&amp; (s2 == 0) &amp;&amp; (s3 == 0) &amp;&amp; (s4 == 1) &amp;&amp; (s5 == 1))
  {
    //going right with full speed 
    analogWrite(e1, speed); //you can adjust the speed of the motors from 0-255
    analogWrite(e2, speed); //you can adjust the speed of the motors from 0-255
    digitalWrite(m1, HIGH);
    digitalWrite(m2, LOW);
    digitalWrite(m3, LOW);
    digitalWrite(m4, LOW);
  }

//if middle, right and right most sensor detects black line
  if((s1 == 1) &amp;&amp; (s2 == 1) &amp;&amp; (s3 == 0) &amp;&amp; (s4 == 0) &amp;&amp; (s5 == 0))
  {
    //going left with full speed 
    analogWrite(e1, speed); //you can adjust the speed of the motors from 0-255
    analogWrite(e2, speed); //you can adjust the speed of the motors from 0-255
    digitalWrite(m1, LOW);
    digitalWrite(m2, LOW);
    digitalWrite(m3, HIGH);
    digitalWrite(m4, LOW);
  }

//if all sensors are on a black line
  if((s1 == 0) &amp;&amp; (s2 == 0) &amp;&amp; (s3 == 0) &amp;&amp; (s4 == 0) &amp;&amp; (s5 == 0))
  {
    //stop
    digitalWrite(m1, LOW);
    digitalWrite(m2, LOW);
    digitalWrite(m3, LOW);
    digitalWrite(m4, LOW);
  }
}

Private - Private paste aren't shown in recent listings.

Delete After - When should we delete your paste?

Spam protection -

Re: Line Follower

Replies to Re: Line Follower

Reply to "Re: Line Follower"