Diff: Ochoa.h

Revision:

38:520ed258f664

Parent:

35:60b29a00cf12

diff -r 2bc74f4ce17b -r 520ed258f664 Ochoa.h
--- a/Ochoa.h	Mon Feb 15 03:31:21 2016 +0000
+++ b/Ochoa.h	Mon Feb 15 03:49:23 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