Tom Rasmussen / Mbed 2 deprecated NucleoCubeFork1

This is the one where I went back and un-did the cube.cpp file

Dependencies:   BNO055_fusion_tom FastPWM mbed

Fork of NucleoCube1 by Tom Rasmussen

main.cpp@1:d81f93d3f819, 2017-04-03 (annotated)

Committer:
wchurch
Date:
Mon Apr 03 03:37:20 2017 +0000
Revision:
1:d81f93d3f819
Parent:
0:604ceafb7bb3
Child:
2:93c7a7fb3203
pwm synced

Who changed what in which revision?

UserRevisionLine numberNew contents of line
wchurch 0:604ceafb7bb3 1 #include "mbed.h"
wchurch 0:604ceafb7bb3 2 #include "BNO055.h"
wchurch 0:604ceafb7bb3 3
wchurch 0:604ceafb7bb3 4
wchurch 0:604ceafb7bb3 5 //------------------------------------
wchurch 0:604ceafb7bb3 6 // Hyperterminal configuration
wchurch 0:604ceafb7bb3 7 // 9600 bauds, 8-bit data, no parity
wchurch 0:604ceafb7bb3 8 //------------------------------------
wchurch 0:604ceafb7bb3 9
wchurch 0:604ceafb7bb3 10 Serial pc(SERIAL_TX, SERIAL_RX);
wchurch 0:604ceafb7bb3 11
wchurch 0:604ceafb7bb3 12 DigitalOut myled(LED1);
wchurch 1:d81f93d3f819 13 PwmOut P1(PE_9);
wchurch 1:d81f93d3f819 14 PwmOut P2(PE_11);
wchurch 1:d81f93d3f819 15 PwmOut P3(PE_13);
wchurch 0:604ceafb7bb3 16
wchurch 0:604ceafb7bb3 17 int main()
wchurch 0:604ceafb7bb3 18 {
wchurch 0:604ceafb7bb3 19 //int i = 1;
wchurch 0:604ceafb7bb3 20 pc.printf("Hello World !\n");
wchurch 0:604ceafb7bb3 21 I2C i2c(PB_9, PB_8); // SDA, SCL
wchurch 0:604ceafb7bb3 22 BNO055 imu(i2c, PA_8); // Reset
wchurch 0:604ceafb7bb3 23
wchurch 0:604ceafb7bb3 24 BNO055_ID_INF_TypeDef bno055_id_inf;
wchurch 0:604ceafb7bb3 25 BNO055_EULER_TypeDef euler_angles;
wchurch 0:604ceafb7bb3 26
wchurch 0:604ceafb7bb3 27 pc.printf("Bosch Sensortec BNO055 test program on " __DATE__ "/" __TIME__ "\r\n");
wchurch 0:604ceafb7bb3 28 if (imu.chip_ready() == 0){
wchurch 0:604ceafb7bb3 29 pc.printf("Bosch BNO055 is NOT avirable!!\r\n");
wchurch 0:604ceafb7bb3 30 }
wchurch 0:604ceafb7bb3 31 imu.read_id_inf(&bno055_id_inf);
wchurch 0:604ceafb7bb3 32 pc.printf("CHIP:0x%02x, ACC:0x%02x, MAG:0x%02x, GYR:0x%02x, , SW:0x%04x, , BL:0x%02x\r\n",
wchurch 0:604ceafb7bb3 33 bno055_id_inf.chip_id, bno055_id_inf.acc_id, bno055_id_inf.mag_id,
wchurch 0:604ceafb7bb3 34 bno055_id_inf.gyr_id, bno055_id_inf.sw_rev_id, bno055_id_inf.bootldr_rev_id);
wchurch 0:604ceafb7bb3 35
wchurch 0:604ceafb7bb3 36 while(1) {
wchurch 0:604ceafb7bb3 37 // acc.getAccAllAxis(data);
wchurch 0:604ceafb7bb3 38 // pc.printf("Data %d %d %d \n",data[0], data[1], data[2]);
wchurch 0:604ceafb7bb3 39 imu.get_Euler_Angles(&euler_angles);
wchurch 0:604ceafb7bb3 40 pc.printf("Heading:%+6.4f [deg], Roll:%+6.4f [deg], Pitch:%+6.4f [deg]\r\n",
wchurch 0:604ceafb7bb3 41 euler_angles.h, euler_angles.r, euler_angles.p);
wchurch 0:604ceafb7bb3 42 wait(0.2);
wchurch 0:604ceafb7bb3 43
wchurch 0:604ceafb7bb3 44 //pc.printf("This program runs since %d seconds.\n", i++);
wchurch 0:604ceafb7bb3 45 //pc.putc(pc.getc());
wchurch 0:604ceafb7bb3 46 myled = !myled;
wchurch 1:d81f93d3f819 47 P1 = .25;//(euler_angles.h/360.0);
wchurch 1:d81f93d3f819 48 P2 = .5; //(euler_angles.r/360.0);
wchurch 1:d81f93d3f819 49 P3 = .75; //(euler_angles.p/360.0);
wchurch 0:604ceafb7bb3 50 }
wchurch 0:604ceafb7bb3 51 }