assignment 4 exercise 4
Dependencies: BSP_B-L475E-IOT01 mbed
main.cpp@3:271d790831c8, 2018-11-15 (annotated)
- Committer:
- mcalzana
- Date:
- Thu Nov 15 13:33:46 2018 +0000
- Revision:
- 3:271d790831c8
- Parent:
- 2:1f47ee8f7f08
blinking
Who changed what in which revision?
User | Revision | Line number | New 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 | } |