main.cpp

00001 #include "mbed.h"
00002 
00003 // Sensors drivers present in the BSP library
00004 #include "stm32l475e_iot01_tsensor.h"
00005 #include "stm32l475e_iot01_hsensor.h"
00006 #include "stm32l475e_iot01_psensor.h"
00007 #include "stm32l475e_iot01_magneto.h"
00008 #include "stm32l475e_iot01_gyro.h"
00009 #include "stm32l475e_iot01_accelero.h"
00010 
00011 DigitalOut led1(LED1);
00012 DigitalOut led2(LED2);
00013 DigitalOut led3(LED3);
00014 
00015 int main()
00016 {
00017     int16_t pDataXYZ[3] = {0};
00018     BSP_ACCELERO_Init();
00019     led1 = 0;
00020     led2 = 0;
00021     led3 = 0;
00022 
00023     while(1) {
00024         int x = abs(pDataXYZ[0]);
00025         int y = abs(pDataXYZ[1]);
00026         int z = abs(pDataXYZ[2]);
00027         //100 of tollerance.
00028         
00029         if(z > 950 && z < 1050){
00030             led1 = 0;
00031             led2 = 0;
00032             led3 = 0;
00033             wait(0.5);
00034             led1 = 1;
00035             led2 = 0;
00036             led3 = 0;
00037         } else if(y > 950 && y < 1050){
00038             led1 = 0;
00039             led2 = 0;
00040             led3 = 0;
00041             wait(0.5);
00042             led1 = 0;
00043             led2 = 1;
00044             led3 = 0;   
00045         }else if(x > 950 && x < 1050){
00046             led1 = 0;
00047             led2 = 0;
00048             led3 = 0;
00049             wait(0.5);
00050             led1 = 0;
00051             led2 = 0;
00052             led3 = 1;   
00053         }else{
00054             led1 = 0;
00055             led2 = 0;
00056             led3 = 0;
00057             wait(0.5);
00058             led1 = 1;
00059             led2 = 1;
00060             led3 = 1;  
00061         }
00062         
00063         BSP_ACCELERO_AccGetXYZ(pDataXYZ);
00064         printf("\nACCELERO_X = %d\n", x);
00065         printf("ACCELERO_Y = %d\n", y);
00066         printf("ACCELERO_Z = %d\n", z);
00067 
00068     }
00069 }