#include <Servo.h>

int motorBanda = 7;
int sensorBanda = 8;
boolean caja = false;
int senval =0;

Servo servo1;
Servo servo2;

char lecturaCAMARA;

void setup() {
  Serial.begin(9600);
  servo1.attach(5);
  servo2.attach(6);
  pinMode(motorBanda, OUTPUT);
  pinMode(sensorBanda, INPUT);
}

void loop() {
  if(digitalRead(sensorBanda) == 0){
    delay(1500);
    digitalWrite(motorBanda, LOW);
    caja = true;
    while(caja){
      Serial.println("Caja detectada");
      lecturaCAMARA = Serial.read();
      if (lecturaCAMARA == '1'){
      servo2.write(90);
      servo1.write(135);
      delay(1500);
      digitalWrite(motorBanda, HIGH);
      caja = false;
      }
      if (lecturaCAMARA == '2'){
      servo2.write(145);
      servo1.write(90);
      delay(1500);
      digitalWrite(motorBanda, HIGH);
      caja= false;
      }
      if (lecturaCAMARA == '3'){
      servo1.write(90);
      servo2.write(90);
       delay(1500);
      digitalWrite(motorBanda, HIGH);
      caja = false;       
      }
    }
  }
  else{
    digitalWrite(motorBanda, HIGH);
  }
}