Arduino_Code_LFR_Drug_Transport
Arduino_Code_LFR_Drug_Transport
Sensor Pins:
- Left: D2
- Center: D3
- Right: D4
void setup() {
pinMode(leftSensor, INPUT);
pinMode(centerSensor, INPUT);
pinMode(rightSensor, INPUT);
pinMode(leftMotorForward, OUTPUT);
pinMode(leftMotorBackward, OUTPUT);
pinMode(rightMotorForward, OUTPUT);
pinMode(rightMotorBackward, OUTPUT);
}
void loop() {
int L = digitalRead(leftSensor);
int C = digitalRead(centerSensor);
int R = digitalRead(rightSensor);
if (L == 0 && C == 1 && R == 0) {
moveForward();
}
else if ((L == 1 && C == 0 && R == 0) || (L == 1 && C == 1 && R
== 0)) {
turnLeft();
}
else if ((L == 0 && C == 0 && R == 1) || (L == 0 && C == 1 && R
== 1)) {
turnRight();
}
else if (L == 1 && C == 1 && R == 1) {
stopMotors();
}
else {
moveForward();
}
}
void moveForward() {
digitalWrite(leftMotorForward, HIGH);
digitalWrite(leftMotorBackward, LOW);
digitalWrite(rightMotorForward, HIGH);
digitalWrite(rightMotorBackward, LOW);
}
void turnLeft() {
digitalWrite(leftMotorForward, LOW);
digitalWrite(leftMotorBackward, LOW);
digitalWrite(rightMotorForward, HIGH);
digitalWrite(rightMotorBackward, LOW);
}
void turnRight() {
digitalWrite(leftMotorForward, HIGH);
digitalWrite(leftMotorBackward, LOW);
digitalWrite(rightMotorForward, LOW);
digitalWrite(rightMotorBackward, LOW);
}
void stopMotors() {
digitalWrite(leftMotorForward, LOW);
digitalWrite(leftMotorBackward, LOW);
digitalWrite(rightMotorForward, LOW);
digitalWrite(rightMotorBackward, LOW);
}