#include <Arduino.h>
#include <Wire.h>
#include <SoftwareSerial.h>

float Estado_Motor = 0;
float Sentido_Giro = 0;
float giro_derecho = 0;
float giro_izquierdo = 0;

void _delay(float seconds) {
  long endTime = millis() + seconds * 1000;
  while(millis() < endTime) _loop();
}

void setup() {
  pinMode(2,INPUT);
  pinMode(9,OUTPUT);
  pinMode(3,INPUT);
  pinMode(5,OUTPUT);
  pinMode(6,OUTPUT);
  Estado_Motor = 0;
  giro_derecho = 0;
  giro_izquierdo = 1;
  while(1) {
      if(digitalRead(2) == Estado_Motor){
        digitalWrite(9,1);

      }else{
        digitalWrite(9,0);
        _delay(0.005);

      }
      if(digitalRead(2) == Estado_Motor){
        if(digitalRead(3) == giro_derecho){
          digitalWrite(5,1);
          digitalWrite(6,0);

        }
        _delay(0.005);
        if(digitalRead(3) == giro_izquierdo){
          digitalWrite(5,0);
          digitalWrite(6,1);

        }
        _delay(0.005);

      }else{
        digitalWrite(5,0);
        digitalWrite(6,0);

      }

      _loop();
  }

}

void _loop() {
}

void loop() {
  _loop();
}