Diff: main.cpp

Revision:

4:aa8a5a606384

Parent:

3:2685cbff6832

Child:

5:0e6b049208d8

--- a/main.cpp	Fri Dec 10 16:40:23 2021 +0000
+++ b/main.cpp	Mon Dec 13 11:00:09 2021 +0000
@@ -5,7 +5,7 @@
 
 Serial pc(USBTX, USBRX); // tx, rx
 Ticker tickerMideDistancia;
-unsigned distancia=1000;;
+unsigned distancia=20;
 
 HCSR04  usensor(D7,D8); //(PinName TrigPin,PinName EchoPin):
 DigitalIn finalDer(D2);
@@ -34,15 +34,15 @@
 
 void estadoCerrada()
 {
-    if((finalIzq == 1)) {
-        wait(1.0);
+    if( (finalIzq == 1) && finalDer ==1) {
+        wait(2.0);
         enable=1;
         estado=abriendose;
-        
+       // pc.printf("Distance =%d\n",distancia);
         pc.printf("Final2 pulsado\r\n");
         
-        
-        
+       
+        //distancia < 5
         
         
     }
@@ -50,6 +50,7 @@
 
 void estadoAbriendose()
 {
+    pc.printf("Distance =%d\n",distancia);
     if((finalDer==1)) {
         
         estado=abierta;
@@ -64,6 +65,7 @@
 }
 
 void estadoCerrandose(){
+     //pc.printf("Distance =%d\n",distancia);
      if((finalIzq==1)) {
         
         estado=cerrada;
@@ -78,6 +80,7 @@
 
 void estadoAbierta()
 {
+    //pc.printf("Distance =%d\n",distancia);
     if (finalDer==1) {
         
         
@@ -93,7 +96,8 @@
     pc.baud(115200);
     tickerMideDistancia.attach(&mideDistancia, 0.5);
     estado=cerrada;
-    pc.printf("Estado cerrada\n");
+    //pc.printf("Estado cerrada\n");
+    
     while(1) {
         distancia=usensor.get_dist_cm();
         switch ( estado ) {