int pecho 2 define el pin 2 como pecho para el Ultrasonico int trig 3 define el

Int pecho 2 define el pin 2 como pecho para el

This preview shows page 5 - 8 out of 10 pages.

int pecho = 2; // define el pin 2 como (pecho) para el Ultrasonico int trig = 3; // define el pin 3 como (trig) para el Ultrasonico int duracion, distancia; // para Calcular distancia void setup() { //Todo código se ejecuta solo una vez Serial.begin(9600); // inicia el puerto serial para comunicación con el Bluetooth pinMode(led1, OUTPUT); pinMode(led2, OUTPUT); pinMode(derecha1, OUTPUT); pinMode(derecha2, OUTPUT); pinMode(izquierda1, OUTPUT); pinMode(izquierda2, OUTPUT); pinMode(pecho, INPUT); // define el pin 2 como entrada (pecho) pinMode(ptrig,OUTPUT); // define el pin 3 como salida (ptrig) pinMode(13,OUTPUT); } void loop() { if(Serial.available()>0){ // lee el bluetooth y almacena en estado estado = Serial.read(); }
Image of page 5

Subscribe to view the full document.

if(estado=='1'){ // Boton desplazar al Frente analogWrite(derecha2, vel); analogWrite(izquierda2, vel); analogWrite(derecha1, 0); analogWrite(izquierda1, 0); } if(estado=='2'){ // Boton DER analogWrite(derecha2, 0); analogWrite(izquierda2, 0); analogWrite(izquierda1, 0); analogWrite(derecha1, vel); } if(estado=='3'){ // Boton Reversa analogWrite(derecha1, vel); analogWrite(izquierda1, vel); analogWrite(derecha2, 0); analogWrite(izquierda2, 0); } if(estado=='4'){ // Boton IZQ analogWrite(derecha2, 0); analogWrite(izquierda2, 0); analogWrite(derecha1, 0); analogWrite(izquierda1, vel); } if(estado=='5'){ // Boton Parar analogWrite(derecha2, 0); analogWrite(izquierda2, 0); analogWrite(derecha1, 0); analogWrite(izquierda1, 0); }
Image of page 6