Download as pdf or txt
Download as pdf or txt
You are on page 1of 2

// Please give me the credits in your project.

// Created by: José Rubén Martínez González


// May 2021, S.L.P. México.
// Program for the robot without veolocity control

int rs = 2; // right sensor pin


int ls = 3; // left sensor pin

// Signal pins from L298N module


int in1 = 10;
int in2 = 9;
int in3 = 6;
int in4 = 5;

int leftValue;
int rightValue;

void setup() {
pinMode(rs, INPUT);
pinMode(ls, INPUT);
pinMode(in1, OUTPUT);
pinMode(in2, OUTPUT);
pinMode(in3, OUTPUT);
pinMode(in4, OUTPUT);

Serial.begin(9600); // // Serial Communication is starting with 9600 of baudrate


speed

void sensorReading(){
leftValue = digitalRead(ls); // read from left Sensor
rightValue = digitalRead(rs);

void forward(){
digitalWrite(in1, LOW);
digitalWrite(in2, HIGH);
digitalWrite(in3, LOW);
digitalWrite(in4, HIGH);
}

void turnRight(){
//left Motor
digitalWrite(in1, LOW);
digitalWrite(in2, HIGH);
// Right Motor
digitalWrite(in3, LOW);
digitalWrite(in4, LOW);
}
void turnLeft(){
//left Motor
digitalWrite(in1, LOW);
digitalWrite(in2, LOW);
// Right Motor
digitalWrite(in3, LOW);
digitalWrite(in4, HIGH);
}

void stopMotors(){
//left Motor
digitalWrite(in1, LOW);
digitalWrite(in2, LOW);
// Right Motor
digitalWrite(in3, LOW);
digitalWrite(in4, LOW);
}
void loop() {

sensorReading();

if(leftValue == 1 && rightValue == 0){


turnLeft();
}else if(leftValue == 0 && rightValue == 1 ){
turnRight();
}else if(leftValue == 0 && rightValue == 0){
forward();
}else if(leftValue == 1 && rightValue == 1){
stopMotors();
}

}//END

/*

*/

You might also like