DaniRobotIno

int s2 = A0;
int s3 = A2;
int s4 = A3;

int S2 = 0;
int S4 = 0;
int CENTRO = 0;

int IN1 = 4;
int IN2 = 5;
int IN3 = 6;
int IN4 = 7;

int velocidadeA = 10;
int velocidadeB = 11;

void velocidadeMotorA(int valor){
    analogWrite(velocidadeA,valor);

}
void velocidadeMotorB(int valor){
    analogWrite(velocidadeB,valor);
}

void motor_andar(int valor1, int valor2){
    velocidadeMotorA(valor1);
    velocidadeMotorB(valor2);
    digitalWrite(IN1, HIGH);
    digitalWrite(IN2, LOW);
    digitalWrite(IN3, HIGH);
    digitalWrite(IN4, LOW);
    delay(100);

}

void motor_esquerda(int valor){
    velocidadeMotorA(valor);
    digitalWrite(IN1, HIGH);
    digitalWrite(IN2, LOW);
    digitalWrite(IN3, HIGH);
    digitalWrite(IN4, HIGH);
    delay(100);
}

void motor_direita(int valor){
    velocidadeMotorB(valor);
    digitalWrite(IN3, HIGH);
    digitalWrite(IN4, LOW);
    digitalWrite(IN1, HIGH);
    digitalWrite(IN2, HIGH);
    delay(100);
}

void stop_motor(){

    digitalWrite(IN3, HIGH);
    digitalWrite(IN4, HIGH);
    digitalWrite(IN1, HIGH);
    digitalWrite(IN2, HIGH);

}


void setup () {
 pinMode(s2, INPUT);
 pinMode(s3, INPUT);
 pinMode(s4, INPUT);
 Serial.begin(9600);
 pinMode(13,OUTPUT);

  pinMode(IN1, OUTPUT);
  pinMode(IN2, OUTPUT);
  pinMode(IN3, OUTPUT);
  pinMode(IN4, OUTPUT);
  pinMode(velocidadeA,OUTPUT);
  pinMode(velocidadeB,OUTPUT);

}
void loop () {
  digitalWrite(13,HIGH);
  S2 = digitalRead(s2);
  Serial.print("S2: "); // <==
  Serial.println(S2);

  CENTRO = digitalRead(s3);
  Serial.print("S3: ");
  Serial.println(CENTRO);

  S4 = digitalRead(s4);
  Serial.print("S4: "); // <==
  Serial.println(S4);
  Serial.println("\n###########################################\n");



  if ( S2 == 0  && CENTRO == 0 && S4 == 1 ){
    Serial.println("Motor Direita\n");
    motor_direita(100);
  }
  if ( S2 == 1  &&  CENTRO == 1  && S4 == 0){
    Serial.println("Motor Esquerda\n");
    motor_esquerda(100);

  }

  if ( S2 == 1  &&  CENTRO == 0  && S4 == 1){
    motor_andar(100,100);
    Serial.println("RUN!!\n");
  }
  if ( S2 == 1  &&  CENTRO == 1  && S4 == 1){
    stop_motor();
    Serial.println("STOP MOTOR\n");
  }


delay(1000);
}