Ian Hua / Quadcopter-mbedRTOS
Revision:
3:605fbcb54e75
Parent:
2:ab967d7b4346
Child:
5:4879ef0e6d41
--- a/RTOS-Threads/src/Task1.cpp	Tue Apr 29 11:43:32 2014 +0000
+++ b/RTOS-Threads/src/Task1.cpp	Tue Apr 29 14:53:32 2014 +0000
@@ -65,8 +65,9 @@
         ypr[1] *= 180/M_PI;
         ypr[2] *= 180/M_PI;
 
-        //BT.printf("YPR\t%3.2f\t%3.2f\t%3.2f\n", ypr[0]*180/M_PI, ypr[1]*180/M_PI, ypr[2]*180/M_PI);
-        BT.printf("Y%3.2f\nP%3.2f\nR%3.2f\n", ypr[0] - ypr_offset[0], ypr[1] - ypr_offset[1], ypr[2] - ypr_offset[2]);
+        if (box_demo)
+            //BT.printf("YPR\t%3.2f\t%3.2f\t%3.2f\n", ypr[0]*180/M_PI, ypr[1]*180/M_PI, ypr[2]*180/M_PI);
+            BT.printf("Y%3.2f\nP%3.2f\nR%3.2f\n", ypr[0] - ypr_offset[0], ypr[1] - ypr_offset[1], ypr[2] - ypr_offset[2]);
     }
 
     //LED[1] = !LED[1];