Ian Hua / Quadcopter-mbedRTOS
Revision:
48:9dbdc4144f00
Parent:
45:3847d7bf8b2c
Child:
50:8a0accb23007
--- a/RTOS-Threads/src/Task3.cpp	Sat May 17 11:57:09 2014 +0000
+++ b/RTOS-Threads/src/Task3.cpp	Mon May 19 13:21:17 2014 +0000
@@ -9,7 +9,6 @@
 #include "PwmIn.h"
 
 PwmIn rxModule[] = {p14, p15, p16, p17, p18};
-AnalogIn voltageSense(p20);
 
 /* [YAW PITCH ROLL THROTTLE AUX] */
 volatile int RCCommand[5] = {0, 0, 0, 0, 0};
@@ -17,12 +16,8 @@
 volatile int inputYPR[3];
 volatile float ypr_offset[3];
 
-float vIn = 0.0;
-
 FLIGHT_MODE mode = ATTITUDE;
 
-int voltageUpdate = 0;
-
 
 
 
@@ -94,17 +89,6 @@
 
     for (int i = 1; i < 3; i++)
         inputYPR[i] = constrainInputPR(inputYPR[i]);
-
-
-    /* Telemetry: */
-    if (voltageUpdate > 3) {
-        if (box_demo) {
-            BT.printf("\nV%2.2f\n", voltageSense*VOLTAGE_SCALE);
-        }
-        voltageUpdate = 0;
-    } else {
-        voltageUpdate++;
-    }
 //Timer
 }