This is for our FYDP project. 2 MPU6050s are used

Dependencies:   Servo mbed

Revision:
2:7b3822eacad8
Parent:
1:815f16490da8
Child:
3:47461d37adfb
--- a/main.cpp	Sat Mar 21 21:54:52 2015 +0000
+++ b/main.cpp	Sat Mar 21 22:44:36 2015 +0000
@@ -81,10 +81,10 @@
 {
      bt.baud(BT_BAUD_RATE);   //you have to do this for some reason
     test_dmp(); 
- test_dmp2();
+ //test_dmp2();
     bt.baud(BT_BAUD_RATE);   //you have to do this for some reason
     start_dmp(mpu);
-   start_dmp2(mpu2);
+  // start_dmp2(mpu2);
     //calibrate_1();
 
     while(1) {
@@ -96,12 +96,13 @@
         
         //if(!mpuInterrupt && fifoCount < packetSize);    //interrupt not ready
         //else {  //mpu interrupt is ready
+        //     update_dmp2();
             update_dmp();
-          update_dmp2();
+         
             //mpuInterrupt = false;   //this resets the interrupt flag
             //mpuInterrupt2 = false;
         //}
-        
+        //Thread::wait(10);
          Thread::yield();
     }
 }
@@ -113,7 +114,8 @@
     
     while(true) {
         bt_shell_run();
-        Thread::yield();
+        Thread::wait(10);
+        //Thread::yield();
     }    
 }