Diff: Ochoa.h

Revision:

37:7bc8819f91f4

Parent:

35:60b29a00cf12

--- a/Ochoa.h	Sun Feb 14 20:57:56 2016 +0000
+++ b/Ochoa.h	Mon Feb 15 03:45:21 2016 +0000
@@ -2,21 +2,23 @@
 #define OCHOA
 #include "mbed.h"
   void Mensajes(){
+             //350<data[1] && data[1]>140 && data[0]<-120 && data[0]>-390 && data[2]>16100 && data[2]<=16300
              
-             if(400<=data[1] && data[1]>=-16000 && data[0]<-104 && data[0]>-1000 && data[2]<16070 && data[2]>1000){
-               pc.printf("Nivel a la derecha\n"); // ya quedo
-               wait(.4);
-               }
-             if(-200<=data[2] && data[2]<=16200 && data[0]<-370 && data[0]>-16500 && data[1]>150 && data[1]<16000){
-             pc.printf("Nivel a la izquierda\n"); // este ya quedo
-                    wait(.4);}
+                if(300>data[1] && data[1]>-16100 && data[0]<-100 && data[0]>-1200 && data[2]<16200 && data[2]>500){
+                pc.printf("Nivel a la derecha\n"); // ya quedo
+                wait(.4);}
+                
+                if(2000<data[2] && data[2]<16100 && data[0]<-200 && data[0]>-1000 && data[1]>1000 && data[1]<16200){
+                pc.printf("Nivel a la izquierda\n"); // este ya quedo
+                wait(.4);}
                     
-            if(-200<=data[0] && data[0]>=-16000){
+                if(-220>=data[0] && data[0]>=-16000){
                 pc.printf("Nivel hacia atras\n");
                 wait(.4);}
-        if(-350<=data[0] && data[0]<=16000){
-        pc.printf("Nivel hacia adelante \n");
-            wait(.4); }
+                
+                if(-30<=data[0] && data[0]<=16000){
+                pc.printf("Nivel hacia adelante \n");
+                wait(.4); }
 //150-432
 }
 #endif
\ No newline at end of file