Dependencies:   BNO055_fusion_tom FastPWM mbed

Fork of NucleoCube1 by Will Church

Revision:
21:4f60d60b2e5a
Parent:
20:79c99bbf6dd7
Child:
22:9f3022fe9084
--- a/main.cpp	Tue Apr 11 05:28:54 2017 +0000
+++ b/main.cpp	Tue Apr 11 05:48:15 2017 +0000
@@ -108,7 +108,8 @@
     }
 
     imu.read_id_inf(&bno055_id_inf);
-    P1 = .5;
+    P1 = .5;        //Stops ESCON studio from throwing out-of-range error
+    
     //pc.printf("CHIP:0x%02x, ACC:0x%02x, MAG:0x%02x, GYR:0x%02x, , SW:0x%04x, , BL:0x%02x\r\n",
     //           bno055_id_inf.chip_id, bno055_id_inf.acc_id, bno055_id_inf.mag_id,
     //           bno055_id_inf.gyr_id, bno055_id_inf.sw_rev_id, bno055_id_inf.bootldr_rev_id);
@@ -126,8 +127,8 @@
         // pc.printf("H:%+6.4f [rad], P:%+6.4f, R:%+6.4f, R1%+6.4f [PWM], Theta_dot:%+6.4f [rad/s] , WV:%+6.4f [rad/s] \r\n",
         //             euler_angles.h, euler_angles.p, euler_angles.r, r1, velocity.z, wv);
 
-        pc.printf("Theta:%+6.4f [rad], P:%+6.4f [rad], R1%+6.4f [PWM], Theta_dot:%+6.4f [rad/s], WV:%+6.4f [rad/s] \r\n",
-                  bt, euler_angles.p, r1, velocity.z, wv);
+        //pc.printf("Theta:%+6.4f [rad], P:%+6.4f [rad], R1%+6.4f [PWM], Theta_dot:%+6.4f [rad/s], WV:%+6.4f [rad/s] \r\n",
+         //         bt, euler_angles.p, r1, velocity.z, wv);
 
         imu.get_Euler_Angles(&euler_angles);
         imu.get_velocities(&velocity);