1st

Dependencies:   BSP_B-L475E-IOT01

main.cpp

Committer:
voltxd
Date:
2020-12-04
Revision:
0:621a9f7b5ce0

File content as of revision 0:621a9f7b5ce0:

#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"

#include <math.h>

DigitalOut led1(LED1);
DigitalOut led2(LED2);
DigitalOut led3(LED3);
DigitalOut led4(LED4);

DigitalIn userButton(USER_BUTTON, PullUp);

int main()
{
    float sensor_value = 0;
    int16_t pDataXYZ[3] = {0};
    float pGyroDataXYZ[3] = {0};

    printf("Start sensor init\r\n");

    BSP_TSENSOR_Init();
    BSP_HSENSOR_Init();
    BSP_PSENSOR_Init();

    BSP_MAGNETO_Init();
    BSP_GYRO_Init();
    BSP_ACCELERO_Init();
    
    led2 = 1;
    led3 = 0;
    led4 = 0;

    while(1) {
        printf("\r\nNew loop, LED1 should blink during sensor read\r\n");
        
        if (!userButton.read())
        {
            if (!led2.read() && !led3.read() && !led4.read())
            {
                led2 = 1;
            }
            else if (led2.read() && !led3.read() && !led4.read())
            {
                led2 = 0;
                led3 = 1;
            }
            else if (!led2.read() && led3.read() && !led4.read())
            {
                led3 = 0;
                led4 = 1;
            }
            else 
            {
                led4 = 0;
                led2 = 1;
            }
        }
        else
        {
            led2 = 0;
            led3 = 0;
            led4 = 0;
        }

        ThisThread::sleep_for(1);

    }
}