Scribd
Upload
24 views2 pages

New Text Document

Uploaded by

xivehoh190
Copyright
© © All Rights Reserved
We take content rights seriously. If you suspect this is your content, claim it here.
Available Formats
Download as TXT, PDF, TXT or read online on Scribd
24 views2 pages

New Text Document

Uploaded by

xivehoh190
Copyright
© © All Rights Reserved
We take content rights seriously. If you suspect this is your content, claim it here.
Available Formats
Download as TXT, PDF, TXT or read online on Scribd
You are on page 1/ 2

#include <SPI.

h>
#include <Wire.h>

int a0 = A0;
int a1 = A1;
int a2 = A2;
int a3 = A3;
int a4 = 12;
int ENA = 10;
int ENB = 11;
int INA1 = 2;
int INA2 = 3;
int INB1 = 4;
int INB2 = 5;

void setup() {
Serial.begin(9600);
pinMode(a0, INPUT);
pinMode(a1, INPUT);
pinMode(a2, INPUT);
pinMode(a3, INPUT);
pinMode(a4, INPUT);
pinMode(ENA, OUTPUT);
pinMode(ENB, OUTPUT);
pinMode(INA1, OUTPUT);
pinMode(INA2, OUTPUT);
pinMode(INB1, OUTPUT);
pinMode(INB2, OUTPUT);

digitalWrite(ENA, HIGH);
digitalWrite(ENB, HIGH);
}

void loop() {
int o4 = digitalRead(a0);
int o3 = digitalRead(a1);
int o2 = digitalRead(a2);
int o1 = digitalRead(a3);
int o0 = digitalRead(a4);

// Control logic based on input readings


if (o0 == 1) {
// Add any specific logic or debugging here if needed
}
if (o1 == 1) {
// Add any specific logic or debugging here if needed
}
if (o2 == 1) {
// Add any specific logic or debugging here if needed
}
if (o3 == 1) {
// Add any specific logic or debugging here if needed
}
if (o4 == 1) {
// Add any specific logic or debugging here if needed
}

// Control motors based on input conditions


if (o0 == 1 && o2 == 0 && o3 == 1) {
digitalWrite(INA1, HIGH);
digitalWrite(INA2, LOW);
digitalWrite(INB1, HIGH);
digitalWrite(INB2, LOW);
}
if ((o0 == 0 && o2 == 0 && o3 == 1) || (o0 == 0 && o2 == 1 && o3 == 1)) {
digitalWrite(INA1, HIGH);
digitalWrite(INA2, LOW);
digitalWrite(INB1, LOW);
digitalWrite(INB2, LOW);
}
if ((o0 == 1 && o2 == 0 && o3 == 0) || (o0 == 1 && o2 == 1 && o3 == 0)) {
digitalWrite(INA1, LOW);
digitalWrite(INA2, LOW);
digitalWrite(INB1, HIGH);
digitalWrite(INB2, LOW);
}
if (o0 == 0 && o2 == 0 && o3 == 0) {
digitalWrite(INA1, LOW);
digitalWrite(INA2, LOW);
digitalWrite(INB1, LOW);
digitalWrite(INB2, LOW);
}
}

You might also like