assignment 4 exercise 4

Dependencies:   BSP_B-L475E-IOT01 mbed

Committer:
mcalzana
Date:
Thu Nov 15 13:33:46 2018 +0000
Revision:
3:271d790831c8
Parent:
2:1f47ee8f7f08
blinking

Who changed what in which revision?

UserRevisionLine numberNew contents of line
lmottola 0:0cc3bd737dcb 1 #include "mbed.h"
lmottola 0:0cc3bd737dcb 2
lmottola 0:0cc3bd737dcb 3 // Sensors drivers present in the BSP library
lmottola 0:0cc3bd737dcb 4 #include "stm32l475e_iot01_tsensor.h"
lmottola 0:0cc3bd737dcb 5 #include "stm32l475e_iot01_hsensor.h"
lmottola 0:0cc3bd737dcb 6 #include "stm32l475e_iot01_psensor.h"
lmottola 0:0cc3bd737dcb 7 #include "stm32l475e_iot01_magneto.h"
lmottola 0:0cc3bd737dcb 8 #include "stm32l475e_iot01_gyro.h"
lmottola 0:0cc3bd737dcb 9 #include "stm32l475e_iot01_accelero.h"
lmottola 0:0cc3bd737dcb 10
mcalzana 2:1f47ee8f7f08 11 DigitalOut led1(LED1);
mcalzana 2:1f47ee8f7f08 12 DigitalOut led2(LED2);
mcalzana 2:1f47ee8f7f08 13 DigitalOut led3(LED3);
lmottola 0:0cc3bd737dcb 14
lmottola 0:0cc3bd737dcb 15 int main()
lmottola 0:0cc3bd737dcb 16 {
lmottola 0:0cc3bd737dcb 17 int16_t pDataXYZ[3] = {0};
lmottola 0:0cc3bd737dcb 18 BSP_ACCELERO_Init();
mcalzana 2:1f47ee8f7f08 19 led1 = 0;
mcalzana 2:1f47ee8f7f08 20 led2 = 0;
mcalzana 2:1f47ee8f7f08 21 led3 = 0;
lmottola 0:0cc3bd737dcb 22
lmottola 0:0cc3bd737dcb 23 while(1) {
mcalzana 2:1f47ee8f7f08 24 int x = abs(pDataXYZ[0]);
mcalzana 2:1f47ee8f7f08 25 int y = abs(pDataXYZ[1]);
mcalzana 2:1f47ee8f7f08 26 int z = abs(pDataXYZ[2]);
mcalzana 2:1f47ee8f7f08 27 //100 of tollerance.
mcalzana 2:1f47ee8f7f08 28
mcalzana 2:1f47ee8f7f08 29 if(z > 950 && z < 1050){
mcalzana 3:271d790831c8 30 led1 = 0;
mcalzana 3:271d790831c8 31 led2 = 0;
mcalzana 3:271d790831c8 32 led3 = 0;
mcalzana 3:271d790831c8 33 wait(0.5);
mcalzana 2:1f47ee8f7f08 34 led1 = 1;
mcalzana 2:1f47ee8f7f08 35 led2 = 0;
mcalzana 2:1f47ee8f7f08 36 led3 = 0;
mcalzana 2:1f47ee8f7f08 37 } else if(y > 950 && y < 1050){
mcalzana 2:1f47ee8f7f08 38 led1 = 0;
mcalzana 3:271d790831c8 39 led2 = 0;
mcalzana 3:271d790831c8 40 led3 = 0;
mcalzana 3:271d790831c8 41 wait(0.5);
mcalzana 3:271d790831c8 42 led1 = 0;
mcalzana 2:1f47ee8f7f08 43 led2 = 1;
mcalzana 2:1f47ee8f7f08 44 led3 = 0;
mcalzana 2:1f47ee8f7f08 45 }else if(x > 950 && x < 1050){
mcalzana 2:1f47ee8f7f08 46 led1 = 0;
mcalzana 2:1f47ee8f7f08 47 led2 = 0;
mcalzana 3:271d790831c8 48 led3 = 0;
mcalzana 3:271d790831c8 49 wait(0.5);
mcalzana 3:271d790831c8 50 led1 = 0;
mcalzana 3:271d790831c8 51 led2 = 0;
mcalzana 2:1f47ee8f7f08 52 led3 = 1;
mcalzana 2:1f47ee8f7f08 53 }else{
mcalzana 3:271d790831c8 54 led1 = 0;
mcalzana 3:271d790831c8 55 led2 = 0;
mcalzana 3:271d790831c8 56 led3 = 0;
mcalzana 3:271d790831c8 57 wait(0.5);
mcalzana 2:1f47ee8f7f08 58 led1 = 1;
mcalzana 2:1f47ee8f7f08 59 led2 = 1;
mcalzana 2:1f47ee8f7f08 60 led3 = 1;
mcalzana 2:1f47ee8f7f08 61 }
mcalzana 2:1f47ee8f7f08 62
lmottola 0:0cc3bd737dcb 63 BSP_ACCELERO_AccGetXYZ(pDataXYZ);
mcalzana 2:1f47ee8f7f08 64 printf("\nACCELERO_X = %d\n", x);
mcalzana 2:1f47ee8f7f08 65 printf("ACCELERO_Y = %d\n", y);
mcalzana 2:1f47ee8f7f08 66 printf("ACCELERO_Z = %d\n", z);
lmottola 0:0cc3bd737dcb 67
lmottola 0:0cc3bd737dcb 68 }
lmottola 0:0cc3bd737dcb 69 }