assignment 4 exercise 4
Dependencies: BSP_B-L475E-IOT01 mbed
main.cpp@2:1f47ee8f7f08, 2018-11-12 (annotated)
- Committer:
- mcalzana
- Date:
- Mon Nov 12 17:44:48 2018 +0000
- Revision:
- 2:1f47ee8f7f08
- Parent:
- 1:dce931d77528
- Child:
- 3:271d790831c8
assignment 4 exercise 4
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 | 2:1f47ee8f7f08 | 30 | led1 = 1; |
mcalzana | 2:1f47ee8f7f08 | 31 | led2 = 0; |
mcalzana | 2:1f47ee8f7f08 | 32 | led3 = 0; |
mcalzana | 2:1f47ee8f7f08 | 33 | } else if(y > 950 && y < 1050){ |
mcalzana | 2:1f47ee8f7f08 | 34 | led1 = 0; |
mcalzana | 2:1f47ee8f7f08 | 35 | led2 = 1; |
mcalzana | 2:1f47ee8f7f08 | 36 | led3 = 0; |
mcalzana | 2:1f47ee8f7f08 | 37 | }else if(x > 950 && x < 1050){ |
mcalzana | 2:1f47ee8f7f08 | 38 | led1 = 0; |
mcalzana | 2:1f47ee8f7f08 | 39 | led2 = 0; |
mcalzana | 2:1f47ee8f7f08 | 40 | led3 = 1; |
mcalzana | 2:1f47ee8f7f08 | 41 | }else{ |
mcalzana | 2:1f47ee8f7f08 | 42 | led1 = 1; |
mcalzana | 2:1f47ee8f7f08 | 43 | led2 = 1; |
mcalzana | 2:1f47ee8f7f08 | 44 | led3 = 1; |
mcalzana | 2:1f47ee8f7f08 | 45 | } |
mcalzana | 2:1f47ee8f7f08 | 46 | |
lmottola | 0:0cc3bd737dcb | 47 | BSP_ACCELERO_AccGetXYZ(pDataXYZ); |
mcalzana | 2:1f47ee8f7f08 | 48 | printf("\nACCELERO_X = %d\n", x); |
mcalzana | 2:1f47ee8f7f08 | 49 | printf("ACCELERO_Y = %d\n", y); |
mcalzana | 2:1f47ee8f7f08 | 50 | printf("ACCELERO_Z = %d\n", z); |
mcalzana | 2:1f47ee8f7f08 | 51 | wait(0.3); |
lmottola | 0:0cc3bd737dcb | 52 | |
lmottola | 0:0cc3bd737dcb | 53 | } |
lmottola | 0:0cc3bd737dcb | 54 | } |