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.
Diff: main.cpp
- 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 -} -