
Sensors Test
Dependencies: BSP_B-L475E-IOT01
main.cpp@0:f52242a12bda, 2021-02-23 (annotated)
- Committer:
- hubertjeon
- Date:
- Tue Feb 23 01:37:24 2021 +0000
- Revision:
- 0:f52242a12bda
ok
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
hubertjeon | 0:f52242a12bda | 1 | #include "mbed.h" |
hubertjeon | 0:f52242a12bda | 2 | |
hubertjeon | 0:f52242a12bda | 3 | // Sensors drivers present in the BSP library |
hubertjeon | 0:f52242a12bda | 4 | #include "stm32l475e_iot01_tsensor.h" |
hubertjeon | 0:f52242a12bda | 5 | #include "stm32l475e_iot01_hsensor.h" |
hubertjeon | 0:f52242a12bda | 6 | #include "stm32l475e_iot01_psensor.h" |
hubertjeon | 0:f52242a12bda | 7 | #include "stm32l475e_iot01_magneto.h" |
hubertjeon | 0:f52242a12bda | 8 | #include "stm32l475e_iot01_gyro.h" |
hubertjeon | 0:f52242a12bda | 9 | #include "stm32l475e_iot01_accelero.h" |
hubertjeon | 0:f52242a12bda | 10 | |
hubertjeon | 0:f52242a12bda | 11 | DigitalOut led(LED1); |
hubertjeon | 0:f52242a12bda | 12 | |
hubertjeon | 0:f52242a12bda | 13 | int main() |
hubertjeon | 0:f52242a12bda | 14 | { |
hubertjeon | 0:f52242a12bda | 15 | float sensor_value = 0; |
hubertjeon | 0:f52242a12bda | 16 | int16_t pDataXYZ[3] = {0}; |
hubertjeon | 0:f52242a12bda | 17 | float pGyroDataXYZ[3] = {0}; |
hubertjeon | 0:f52242a12bda | 18 | |
hubertjeon | 0:f52242a12bda | 19 | printf("Start sensor init\n"); |
hubertjeon | 0:f52242a12bda | 20 | |
hubertjeon | 0:f52242a12bda | 21 | BSP_TSENSOR_Init(); |
hubertjeon | 0:f52242a12bda | 22 | BSP_HSENSOR_Init(); |
hubertjeon | 0:f52242a12bda | 23 | BSP_PSENSOR_Init(); |
hubertjeon | 0:f52242a12bda | 24 | |
hubertjeon | 0:f52242a12bda | 25 | BSP_MAGNETO_Init(); |
hubertjeon | 0:f52242a12bda | 26 | BSP_GYRO_Init(); |
hubertjeon | 0:f52242a12bda | 27 | BSP_ACCELERO_Init(); |
hubertjeon | 0:f52242a12bda | 28 | |
hubertjeon | 0:f52242a12bda | 29 | while(1) { |
hubertjeon | 0:f52242a12bda | 30 | printf("\nNew loop, LED1 should blink during sensor read\n"); |
hubertjeon | 0:f52242a12bda | 31 | |
hubertjeon | 0:f52242a12bda | 32 | led = 1; |
hubertjeon | 0:f52242a12bda | 33 | |
hubertjeon | 0:f52242a12bda | 34 | sensor_value = BSP_TSENSOR_ReadTemp(); |
hubertjeon | 0:f52242a12bda | 35 | printf("\nTEMPERATURE = %.2f degC\n", sensor_value); |
hubertjeon | 0:f52242a12bda | 36 | |
hubertjeon | 0:f52242a12bda | 37 | sensor_value = BSP_HSENSOR_ReadHumidity(); |
hubertjeon | 0:f52242a12bda | 38 | printf("HUMIDITY = %.2f %%\n", sensor_value); |
hubertjeon | 0:f52242a12bda | 39 | |
hubertjeon | 0:f52242a12bda | 40 | sensor_value = BSP_PSENSOR_ReadPressure(); |
hubertjeon | 0:f52242a12bda | 41 | printf("PRESSURE is = %.2f mBar\n", sensor_value); |
hubertjeon | 0:f52242a12bda | 42 | |
hubertjeon | 0:f52242a12bda | 43 | led = 0; |
hubertjeon | 0:f52242a12bda | 44 | |
hubertjeon | 0:f52242a12bda | 45 | ThisThread::sleep_for(1000); |
hubertjeon | 0:f52242a12bda | 46 | |
hubertjeon | 0:f52242a12bda | 47 | led = 1; |
hubertjeon | 0:f52242a12bda | 48 | |
hubertjeon | 0:f52242a12bda | 49 | BSP_MAGNETO_GetXYZ(pDataXYZ); |
hubertjeon | 0:f52242a12bda | 50 | printf("\nMAGNETO_X = %d\n", pDataXYZ[0]); |
hubertjeon | 0:f52242a12bda | 51 | printf("MAGNETO_Y = %d\n", pDataXYZ[1]); |
hubertjeon | 0:f52242a12bda | 52 | printf("MAGNETO_Z = %d\n", pDataXYZ[2]); |
hubertjeon | 0:f52242a12bda | 53 | |
hubertjeon | 0:f52242a12bda | 54 | BSP_GYRO_GetXYZ(pGyroDataXYZ); |
hubertjeon | 0:f52242a12bda | 55 | printf("\nGYRO_X = %.2f\n", pGyroDataXYZ[0]); |
hubertjeon | 0:f52242a12bda | 56 | printf("GYRO_Y = %.2f\n", pGyroDataXYZ[1]); |
hubertjeon | 0:f52242a12bda | 57 | printf("GYRO_Z = %.2f\n", pGyroDataXYZ[2]); |
hubertjeon | 0:f52242a12bda | 58 | |
hubertjeon | 0:f52242a12bda | 59 | BSP_ACCELERO_AccGetXYZ(pDataXYZ); |
hubertjeon | 0:f52242a12bda | 60 | printf("\nACCELERO_X = %d\n", pDataXYZ[0]); |
hubertjeon | 0:f52242a12bda | 61 | printf("ACCELERO_Y = %d\n", pDataXYZ[1]); |
hubertjeon | 0:f52242a12bda | 62 | printf("ACCELERO_Z = %d\n", pDataXYZ[2]); |
hubertjeon | 0:f52242a12bda | 63 | |
hubertjeon | 0:f52242a12bda | 64 | led = 0; |
hubertjeon | 0:f52242a12bda | 65 | |
hubertjeon | 0:f52242a12bda | 66 | ThisThread::sleep_for(1000); |
hubertjeon | 0:f52242a12bda | 67 | |
hubertjeon | 0:f52242a12bda | 68 | } |
hubertjeon | 0:f52242a12bda | 69 | } |