Final1x
Dependencies: GYRO_DISCO_L476VG mbed BSP_DISCO_L476VG COMPASS_DISCO_L476VG
main.cpp
- Committer:
- gr91
- Date:
- 2020-06-08
- Revision:
- 5:f4a35a2a9085
- Parent:
- 0:5432bdf904f9
- Child:
- 6:6df9f66ca6bb
File content as of revision 5:f4a35a2a9085:
#include "mbed.h" #include "GYRO_DISCO_L476VG.h" GYRO_DISCO_L476VG gyro; Serial pc(SERIAL_TX, SERIAL_RX,115200); Ticker ticker; DigitalOut led1(LED1); volatile bool flag=0; float psig=0; float gyro_zero(void) { const int NN=100000; float GyroBuffer[3]; float gy_off=0; for(int i=0; i<NN; i++) { gyro.GetXYZ(GyroBuffer); gy_off=gy_off+GyroBuffer[1]/NN; } return(gy_off); } void mesure(void) { flag=1; } int main() { float GyroBuffer[3]; printf("Gyroscope started\n"); ticker.attach(&mesure,0.01); unsigned char cpt=0; float gyoff=gyro_zero(); while(1) { if(flag) { // Read Gyroscope values gyro.GetXYZ(GyroBuffer); psig=psig+(GyroBuffer[1]-gyoff)*0.01/1000; // Display values //printf("X = %8.1f \n", GyroBuffer[0]); // printf("Y = %8.1f \n", GyroBuffer[1]); //printf("Z = %8.1f \n", GyroBuffer[2]); // printf("\033[3A"); // Moves cursor up x lines (x value is between [ and A) if(cpt==9) { cpt=0; led1 = !led1; //pc.printf("$%f;\n",GyroBuffer[1]); pc.printf("$%f;\n",psig); } cpt++; flag=0; } } }