LineFollower

const int PWMELPin = 4; //D4 Enable PWM Left Motor
const int PWMERPin = 7; //D7 Enable PWM Right Motor
const int L1Pin = 2; //D2 L1 = Left Motor Lead 1
const int L2Pin = 3; //D3 L2 = Left Motor Lead 2
const int L3Pin = 5; //D5 L3 = Right Motor Lead 1
const int L4Pin = 6; //D6 L4 = Right Motor Lead 2
const int LEDPin = 13; //D13 Telltale LED
const int SW0 = 11; //D11
const int Duration = 2000;
int maju = 0;
int sw0;
int velo = 250;
void setup() {
  // put your setup code here, to run once:
  //Serial.begin(9600);
  pinMode(PWMELPin, OUTPUT);
  pinMode(PWMERPin, OUTPUT);
  pinMode(L1Pin, OUTPUT);
  pinMode(L2Pin, OUTPUT);
  pinMode(L3Pin, OUTPUT);
  pinMode(L4Pin, OUTPUT);
  pinMode(LEDPin, OUTPUT);
  pinMode(SW0, INPUT);
  delay(1000);
  //Serial.print("setup done");
}

void loop() {
  /*
  int analogKanan = analogRead(pinAnalogKanan);
  int analogKiri = analogRead(pinAnalogKiri);

  if(analogKanan > nilaiDeteksiMinimum) {
    MotorR(0,1);
    MotorL(1,1);
  } else if(analogKiri > nilaiDeteksiMinimum) {
    MotorR(1,1);
    MotorL(0,1);
  } else {
    MotorR(1,1);
    MotorL(1,1);
  }
   */
}

void MotorL(int Direction, int Speed)
{
  // Left Motor
  if (Speed == 1)
  {
     analogWrite(PWMELPin, velo);
  }
  else
  {
     analogWrite(PWMELPin, 20);
  }
  if (Direction == 1)
  {
     digitalWrite(L1Pin, HIGH);
     digitalWrite(L2Pin, LOW);
  }
  else
  {
     digitalWrite(L1Pin, LOW);
     digitalWrite(L2Pin, HIGH);
  }
}
// *************************
void MotorR(int Direction, int Speed)
{
  // Right Motor
  if (Speed == 1)
  {
     analogWrite(PWMERPin, velo);
  }
  else
  {
     analogWrite(PWMERPin, 20);
  }
  if (Direction == 1)
  {
     digitalWrite(L3Pin, HIGH);
     digitalWrite(L4Pin, LOW);
  }
  else
  {
     digitalWrite(L3Pin, LOW);
     digitalWrite(L4Pin, HIGH);
  }
}

void AllMotorStop(int t)
{
  digitalWrite(L1Pin, LOW);
  digitalWrite(L2Pin, LOW);
  digitalWrite(L3Pin, LOW);
  digitalWrite(L4Pin, LOW);
  delay(t);
}