Revision 2:82ed19b63fd9, committed 2018-11-16

Comitter:

frunzl

Date:

Fri Nov 16 11:29:54 2018 +0000

Parent:

1:dce931d77528

Commit message:

boh;

Changed in this revision

diff -r dce931d77528 -r 82ed19b63fd9 main.cpp
--- a/main.cpp	Fri Nov 09 15:39:17 2018 +0000
+++ b/main.cpp	Fri Nov 16 11:29:54 2018 +0000
@@ -1,67 +1,47 @@
 #include "mbed.h"
 
 // Sensors drivers present in the BSP library
-#include "stm32l475e_iot01_tsensor.h"
-#include "stm32l475e_iot01_hsensor.h"
-#include "stm32l475e_iot01_psensor.h"
-#include "stm32l475e_iot01_magneto.h"
-#include "stm32l475e_iot01_gyro.h"
 #include "stm32l475e_iot01_accelero.h"
 
 DigitalOut led(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();
 
     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);
-
+// Z Horizontal LED1, X short LED3, Y long LED2
+        BSP_ACCELERO_AccGetXYZ(pDataXYZ);
         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]);
-
-        BSP_ACCELERO_AccGetXYZ(pDataXYZ);
+        led2 = 0;
+        led3 = 0;
+        if (abs(pDataXYZ[0]) > 900) {
+            led3 = 1;
+        } else if (abs(pDataXYZ[1]) > 900) {
+            led2 = 1;
+        } else if (abs(pDataXYZ[2]) > 900) {
+            led = 1;
+        } else {
+            led = 1;
+            led2 = 1;
+            led3 = 1;  
+        }
+        
         printf("\nACCELERO_X = %d\n", pDataXYZ[0]);
         printf("ACCELERO_Y = %d\n", pDataXYZ[1]);
         printf("ACCELERO_Z = %d\n", pDataXYZ[2]);
 
+        wait(1);
+        
         led = 0;
-
-        wait(1);
+        led2 = 0;
+        led3 = 0;
 
     }
 }