LABERINTO ESP32

 

CODIGO ARDUINO

#include "ESP32Servo.h"

#include "BluetoothSerial.h"

BluetoothSerial SerialBT;

char r;

int pos1 = 96;

int pos2 = 84;

int estado1;

int tiempo = 50;

Servo servo1;

Servo servo2;

#define Ejex 4

#define Ejey 2

#define boton 15

void setup() {

  SerialBT.begin("LABERINTO_ESP");

  Serial.begin(115200);

  servo1.attach(5);//5//26

  servo2.attach(18);//18//27

  servo1.write(pos1);

  servo2.write(pos2);

  Serial.print("pos1 = ");

  Serial.println(pos1);

  }

void loop() {

  r = SerialBT.read();

 

 

  if(r == 'A'){ //ARRIBA

  estado1 = 1;}

  if(estado1 == 1){

    pos1 = pos1+2;

    delay(tiempo);

    servo1.write(pos1);

    Serial.print("pos1 = ");

    Serial.println(pos1);

  }

  //*********************************************************

 

  if(pos1 >= 120)

  pos1 = pos1 - (pos1-120);

  if(pos1 <= 70)

  pos1 = pos1 + (70-pos1);

  //****************************************************

  if(r == 'E'){ //RELEASE

  estado1 = 0;}

 

  if(r == 'F'){ //RELEASE

  estado1 = 0;}

   

  //*********************************************************

  if(r == 'B') //ABAJO

    estado1 = 2;

   

    if(estado1 == 2){

    pos1 = pos1-2;

    delay(tiempo);

    servo1.write(pos1);

    Serial.print("pos1 = ");

    Serial.println(pos1);

  }

  //************************************************************

  if(r == 'C') //DERECHA

  estado1 = 3;

  if(estado1 == 3){

  pos2 = pos2+2;

      servo2.write(pos2);

      Serial.print("pos2 = ");

      Serial.println(pos2);

      delay(tiempo);

    }

  //*****************************************************************

  if(r == 'D') //IZQUIERDA

  estado1 = 4;

  if(estado1 == 4){

      pos2 = pos2-2;

      servo2.write(pos2);

      Serial.print("pos2 = ");

      Serial.println(pos2);

      delay(tiempo);

    }

  //*********************************************************

 

  if(pos2 >= 120)

  pos2 = pos2 - (pos2-120);

  if(pos2 <= 70)

  pos2 = pos2 + (70-pos2);

  //****************************************************

}