.

Dependencies:   BNO055 SDFileSystem mbed

Committer:
alejo5214416
Date:
Fri Aug 31 20:08:23 2018 +0000
Revision:
0:b91b6f47eb98
Child:
1:74fb432755d0
interrupcion uc ok, sin interrupcion de imu

Who changed what in which revision?

UserRevisionLine numberNew contents of line
alejo5214416 0:b91b6f47eb98 1 #include "mbed.h"
alejo5214416 0:b91b6f47eb98 2 #include "BNO055.h"
alejo5214416 0:b91b6f47eb98 3 using namespace std;
alejo5214416 0:b91b6f47eb98 4
alejo5214416 0:b91b6f47eb98 5 DigitalOut led1(LED1);
alejo5214416 0:b91b6f47eb98 6 Serial pc(USBTX, USBRX);
alejo5214416 0:b91b6f47eb98 7 // BNO055
alejo5214416 0:b91b6f47eb98 8 BNO055 bno055(p9, p10);
alejo5214416 0:b91b6f47eb98 9 InterruptIn interrupt(p15,PullUp);
alejo5214416 0:b91b6f47eb98 10
alejo5214416 0:b91b6f47eb98 11
alejo5214416 0:b91b6f47eb98 12
alejo5214416 0:b91b6f47eb98 13 void event();
alejo5214416 0:b91b6f47eb98 14 int main() {
alejo5214416 0:b91b6f47eb98 15
alejo5214416 0:b91b6f47eb98 16 bno055.reset();
alejo5214416 0:b91b6f47eb98 17 bno055.setmode(OPERATION_MODE_NDOF);
alejo5214416 0:b91b6f47eb98 18 bno055.write_calibration_data();
alejo5214416 0:b91b6f47eb98 19 bno055.get_calib();
alejo5214416 0:b91b6f47eb98 20 interrupt.rise(&event);
alejo5214416 0:b91b6f47eb98 21 //bno055.initIntr();//inicializar la interrupcion;
alejo5214416 0:b91b6f47eb98 22 while (bno055.calib == 0) {
alejo5214416 0:b91b6f47eb98 23 bno055.get_calib();
alejo5214416 0:b91b6f47eb98 24 }
alejo5214416 0:b91b6f47eb98 25 bno055.resetIntr();
alejo5214416 0:b91b6f47eb98 26 while(1) {
alejo5214416 0:b91b6f47eb98 27 bno055.get_angles(); //query the i2c device
alejo5214416 0:b91b6f47eb98 28 //pc.printf("yaw:%6.2f pitch:%6.2f roll:%6.2f\r\n",bno055.euler.yaw, bno055.euler.pitch, bno055.euler.roll);
alejo5214416 0:b91b6f47eb98 29 bno055.get_lia(); //query the i2c device
alejo5214416 0:b91b6f47eb98 30 pc.printf("X: %3.2f, Y: %3.2f, Z: %3.2f\r\n",bno055.lia.x,bno055.lia.y,bno055.lia.z);
alejo5214416 0:b91b6f47eb98 31 wait_ms(50);
alejo5214416 0:b91b6f47eb98 32
alejo5214416 0:b91b6f47eb98 33 }
alejo5214416 0:b91b6f47eb98 34 }
alejo5214416 0:b91b6f47eb98 35
alejo5214416 0:b91b6f47eb98 36
alejo5214416 0:b91b6f47eb98 37
alejo5214416 0:b91b6f47eb98 38 void event(){
alejo5214416 0:b91b6f47eb98 39 led1=1;
alejo5214416 0:b91b6f47eb98 40 wait(1);
alejo5214416 0:b91b6f47eb98 41 led1=0;
alejo5214416 0:b91b6f47eb98 42 bno055.resetIntr();
alejo5214416 0:b91b6f47eb98 43 }