
.
Dependencies: BNO055 SDFileSystem mbed
main.cpp@0:b91b6f47eb98, 2018-08-31 (annotated)
- 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?
User | Revision | Line number | New 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 | } |