Diff: main.cpp

Revision:

2:1f47ee8f7f08

Parent:

1:dce931d77528

Child:

3:271d790831c8

--- a/main.cpp	Fri Nov 09 15:39:17 2018 +0000
+++ b/main.cpp	Mon Nov 12 17:44:48 2018 +0000
@@ -8,60 +8,47 @@
 #include "stm32l475e_iot01_gyro.h"
 #include "stm32l475e_iot01_accelero.h"
 
-DigitalOut led(LED1);
+DigitalOut led1(LED1);
+DigitalOut led2(LED2);
+DigitalOut led3(LED3);
 
 int main()
 {
-    float sensor_value = 0;
     int16_t pDataXYZ[3] = {0};
-    float pGyroDataXYZ[3] = {0};
-
-    BSP_TSENSOR_Init();
-    BSP_HSENSOR_Init();
-    
-    BSP_PSENSOR_Init();
-
-    BSP_MAGNETO_Init();
-    BSP_GYRO_Init();
     BSP_ACCELERO_Init();
+    led1 = 0;
+    led2 = 0;
+    led3 = 0;
 
     while(1) {
-
-        led = 1;
-
-        sensor_value = BSP_TSENSOR_ReadTemp();
-        printf("\nTEMPERATURE = %.2f degC\n", sensor_value);
-
-        sensor_value = BSP_HSENSOR_ReadHumidity();
-        printf("HUMIDITY    = %.2f %%\n", sensor_value);
-
-        sensor_value = BSP_PSENSOR_ReadPressure();
-        printf("PRESSURE is = %.2f mBar\n", sensor_value);
-
-        led = 0;
-
-        wait(1);
-
-        led = 1;
-
-        BSP_MAGNETO_GetXYZ(pDataXYZ);
-        printf("\nMAGNETO_X = %d\n", pDataXYZ[0]);
-        printf("MAGNETO_Y = %d\n", pDataXYZ[1]);
-        printf("MAGNETO_Z = %d\n", pDataXYZ[2]);
-
-        BSP_GYRO_GetXYZ(pGyroDataXYZ);
-        printf("\nGYRO_X = %.2f\n", pGyroDataXYZ[0]);
-        printf("GYRO_Y = %.2f\n", pGyroDataXYZ[1]);
-        printf("GYRO_Z = %.2f\n", pGyroDataXYZ[2]);
-
+        int x = abs(pDataXYZ[0]);
+        int y = abs(pDataXYZ[1]);
+        int z = abs(pDataXYZ[2]);
+        //100 of tollerance.
+        
+        if(z > 950 && z < 1050){
+            led1 = 1;
+            led2 = 0;
+            led3 = 0;
+        } else if(y > 950 && y < 1050){
+            led1 = 0;
+            led2 = 1;
+            led3 = 0;   
+        }else if(x > 950 && x < 1050){
+            led1 = 0;
+            led2 = 0;
+            led3 = 1;   
+        }else{
+            led1 = 1;
+            led2 = 1;
+            led3 = 1;  
+        }
+        
         BSP_ACCELERO_AccGetXYZ(pDataXYZ);
-        printf("\nACCELERO_X = %d\n", pDataXYZ[0]);
-        printf("ACCELERO_Y = %d\n", pDataXYZ[1]);
-        printf("ACCELERO_Z = %d\n", pDataXYZ[2]);
-
-        led = 0;
-
-        wait(1);
+        printf("\nACCELERO_X = %d\n", x);
+        printf("ACCELERO_Y = %d\n", y);
+        printf("ACCELERO_Z = %d\n", z);
+        wait(0.3);
 
     }
 }