FRANCISCO LOZADA / Mbed 2 deprecated ACCELEROMETRO_2

AVANCE_ CONFIGURACION ACELEROMETRO MPU9250

Dependencies:   mbed

main.cpp@0:940bc2db4c86, 2020-02-06 (annotated)

Committer:
flozada
Date:
Thu Feb 06 03:19:51 2020 +0000
Revision:
0:940bc2db4c86
prototipo avance tarea 1_FRANCISCO LOZADA

Who changed what in which revision?

UserRevisionLine numberNew contents of line
flozada 0:940bc2db4c86 1
flozada 0:940bc2db4c86 2 #include "mbed.h"
flozada 0:940bc2db4c86 3 #include "myMPU9250.h"
flozada 0:940bc2db4c86 4
flozada 0:940bc2db4c86 5 DigitalOut g_led1(LED1), g_led2(LED2), g_led3(LED3), g_led4(LED4);
flozada 0:940bc2db4c86 6 Serial g_pc(USBTX, USBRX);
flozada 0:940bc2db4c86 7
flozada 0:940bc2db4c86 8 void blink_led(double sec=3.0, double interval = 0.2,
flozada 0:940bc2db4c86 9 bool led1=true, bool led2=true, bool led3=true, bool led4=true)
flozada 0:940bc2db4c86 10 {
flozada 0:940bc2db4c86 11
flozada 0:940bc2db4c86 12 for(double t=0.0 ; t<sec ; t+=interval*2.0) {
flozada 0:940bc2db4c86 13 g_led1 = (int)led1;
flozada 0:940bc2db4c86 14 g_led2 = (int)led2;
flozada 0:940bc2db4c86 15 g_led3 = (int)led3;
flozada 0:940bc2db4c86 16 g_led4 = (int)led4;
flozada 0:940bc2db4c86 17 wait(interval);
flozada 0:940bc2db4c86 18 g_led1 = g_led2 = g_led3 = g_led4 = 0;
flozada 0:940bc2db4c86 19 wait(interval);
flozada 0:940bc2db4c86 20 }
flozada 0:940bc2db4c86 21 }
flozada 0:940bc2db4c86 22
flozada 0:940bc2db4c86 23 int main()
flozada 0:940bc2db4c86 24 {
flozada 0:940bc2db4c86 25 g_pc.printf("START!\n");
flozada 0:940bc2db4c86 26 MyMPU9250 imu;
flozada 0:940bc2db4c86 27 if(imu.initialize()) {
flozada 0:940bc2db4c86 28 g_pc.printf("SUCCESS TO INITIALIZE!\n");
flozada 0:940bc2db4c86 29 blink_led(3.0, 0.2, true, false, false, true);
flozada 0:940bc2db4c86 30 } else {
flozada 0:940bc2db4c86 31 blink_led();
flozada 0:940bc2db4c86 32 return 0;
flozada 0:940bc2db4c86 33 }
flozada 0:940bc2db4c86 34
flozada 0:940bc2db4c86 35 imu.setup();
flozada 0:940bc2db4c86 36
flozada 0:940bc2db4c86 37 double x, y, z;
flozada 0:940bc2db4c86 38 for(int cnt=0;; cnt++) {
flozada 0:940bc2db4c86 39 if(cnt%2==0) {
flozada 0:940bc2db4c86 40 imu.updateAccelAllAxes();
flozada 0:940bc2db4c86 41 x = imu.accelX();
flozada 0:940bc2db4c86 42 y = imu.accelY();
flozada 0:940bc2db4c86 43 z = imu.accelZ();
flozada 0:940bc2db4c86 44 g_pc.printf("Accel: %f, %f, %f \n", x, y, z);
flozada 0:940bc2db4c86 45 } else {
flozada 0:940bc2db4c86 46 imu.updateGyroAllAxes();
flozada 0:940bc2db4c86 47 x = imu.gyroX();
flozada 0:940bc2db4c86 48 y = imu.gyroY();
flozada 0:940bc2db4c86 49 z = imu.gyroZ();
flozada 0:940bc2db4c86 50 g_pc.printf("Gyro: %f, %f, %f \n", x, y, z);
flozada 0:940bc2db4c86 51 }
flozada 0:940bc2db4c86 52 }
flozada 0:940bc2db4c86 53 }
flozada 0:940bc2db4c86 54