establece la posicion de referencia del brazo robotico, manda la posicion de los encoders por bluetooth y permite el control remoto a traves de un dispositivo android.

Dependencies:   Motor QEI mbed

Revision:
10:3366c05c1827
Parent:
9:2c4bf2c1ccdc
Child:
11:7674323a52d6
--- a/main.cpp	Mon Jun 12 11:05:30 2017 +0000
+++ b/main.cpp	Mon Jun 12 11:23:11 2017 +0000
@@ -17,7 +17,6 @@
 Motor m4(PB_6, PB_12, PB_11);
 Motor m5(PC_7, PB_2, PB_1);
 Motor m6(PB_9, PB_15, PB_13);
-Motor cinta(PB_8, PC_4, PF_5);
 
 // declaramos las entradas de los micropulsadores
 DigitalIn mp1(PA_9, PullUp);      // (pin, modo)
@@ -25,7 +24,6 @@
 DigitalIn mp3(PB_10, PullUp);
 DigitalIn mp4(PB_4, PullUp);
 DigitalIn mp5(PB_5, PullUp);
-DigitalIn sensor(PB_3, PullUp);
 
 // declaramos el bluetooth
 Serial bt(PA_2, PA_3);          // (RX, TX) (puerto serial 2)
@@ -65,6 +63,7 @@
     ticker1.attach(&enviar_bt, 0.2);    // asignamos la funcion "enviar_bt" al protocolo de interrupcion del "ticker1" y le damos un intervalo de 0.2s
     ticker2.attach(&encenderLEDs, 0.1);    // asignamos la funcion "encenderLEDs" al protocolo de interrupcion del "ticker1" y le damos un intervalo de 0.2s
 
+    wait(1);
 
     sethome();              // establecemos la posicion de referencia
     
@@ -165,11 +164,11 @@
 if(mp1==0)
     led1=1;
 else if (mp1==1)
-    led1==1;
+    led1==0;
 if(mp2==0)
     led3=1;
 else if (mp2==1)
-    led3==1;
+    led3==0;
 }
 
 void sethome()
@@ -426,10 +425,3 @@
         m5.brake();
     }
 }
-void movCinta()
-{
-    while (sensor==1)   // mientras el sensor no se active:
-        cinta.speed(1); // avanza la cinta
-    cinta.brake();      // cuando se ectiva la cinta se para el sensor
-}
-