Ian Hua / Quadcopter-mbedRTOS
Revision:
49:c882f9135033
Parent:
48:9dbdc4144f00
--- a/RTOS-Setup/src/setup.cpp	Mon May 19 13:21:17 2014 +0000
+++ b/RTOS-Setup/src/setup.cpp	Mon May 19 13:33:34 2014 +0000
@@ -7,6 +7,7 @@
 #include "tasks.h"
 
 Serial BT(p28, p27);
+Serial PC(USBTX, USBRX);
 DigitalOut BT_CMD(p29);
 //MPU6050 imu(p9, p10);           
 MPU6050_NB imu_nb(p9, p10); 
@@ -51,32 +52,32 @@
     mode = ATTITUDE;
 
     if (!setup_ESC()) {
-        //imu.debugSerial.printf("ESC FAILED!!!\n");
+        PC.printf("ESC FAILED!!!\n");
         error = true;
     }
 
-    if (setup_bt()) {}
-        //imu.debugSerial.printf("BT established!\n");
+    if (setup_bt())
+        PC.printf("BT established!\n");
     else error = true;
 
-    if (setup_PID()) {}
-        //imu.debugSerial.printf("PID established!\n");
+    if (setup_PID()) 
+        PC.printf("PID established!\n");
     else error = true;
 
-    if (setup_mpu6050()) {}
-        //imu.debugSerial.printf("MPU6050 established!\n");
+    if (setup_mpu6050()) 
+        PC.printf("MPU6050 established!\n");
     else error = true;
 
-    if (setup_altimeter()) {}
-        //imu.debugSerial.printf("Altimeter established!\n");
+    if (setup_altimeter()) 
+        PC.printf("Altimeter established!\n");
      else {
          error = true;
-        //imu.debugSerial.printf("ALTIMETER FAILED\n");
+        PC.printf("ALTIMETER FAILED\n");
      }
 
 #ifdef ENABLE_COMPASS
     if (setup_compass())
-        //imu.debugSerial.printf("Compass established!\n");
+        PC.printf("Compass established!\n");
     else error = true;
 #endif