Ian Hua / Quadcopter-mbedRTOS
Revision:
37:29feef05d848
Parent:
36:d95e3d6f2fc4
Child:
38:ef65533cca32
--- a/RTOS-Threads/src/Task1.cpp	Tue May 13 04:05:34 2014 +0000
+++ b/RTOS-Threads/src/Task1.cpp	Tue May 13 05:28:05 2014 +0000
@@ -22,21 +22,11 @@
 // =================
 void Task1(void const *argument)
 {
-    switch (box_demo) {
-        case true:
-            BT.printf("\nY%3.2f\nP%3.2f\nR%3.2f\n", ypr[0] - ypr_offset[0], ypr[1] - ypr_offset[1], ypr[2] - ypr_offset[2]);
-            BT.printf("\nA%3.2f\nT%2.2f\n", altimeter.Altitude_m(), altimeter.Temp_C());
-
-            BT.printf("\nV%2.2f\n", voltageSense*VOLTAGE_SCALE);
-            break;
-        case false:
-            AHRSSample();
-            break;
-        default:
-            break;
+    if (box_demo) {
+        BT.printf("\nY%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 (gyro_out)
+    else if (gyro_out)
         BT.printf("%3d %3d %3d\n", (int) gyro[0], (int) gyro[1], (int) gyro[2]);
 
     else if (rc_out)