This is for our FYDP project. 2 MPU6050s are used

Dependencies:   Servo mbed

Revision:
4:05484073a641
Parent:
3:47461d37adfb
--- a/main.cpp	Sun Mar 22 00:43:42 2015 +0000
+++ b/main.cpp	Sun Mar 22 06:34:30 2015 +0000
@@ -83,7 +83,7 @@
         Thread::wait(3);
     }    
 }
-/*
+
 void IMU2_thread(void const *args)
 {
     //This thread does not work
@@ -94,7 +94,7 @@
         update_dmp2();
          Thread::yield();
     }
-}*/
+}
 void IMU_thread(void const *args)
 {
     //For some reason, using 2 IMUs causes one of them to be laggy and 
@@ -145,7 +145,7 @@
     
     Thread IMU_th(IMU_thread,NULL,osPriorityNormal, 2048,NULL);
     
-   // Thread IMU2_th(IMU_thread,NULL,osPriorityNormal, 2048,NULL); //Putting IMU2 in a separate thread does not work
+    Thread IMU2_th(IMU2_thread,NULL,osPriorityNormal, 2048,NULL); //Putting IMU2 in a separate thread does not work
     
 //    Thread current_sense(CURRENT_thread,NULL,osPriorityNormal,300,NULL);  //this thread for monitoring current is unnecessary. Thread use lotsa rams. Kill it.