Ian Hua / Quadcopter-mbedRTOS
Revision:
10:ef5fe86f67fe
Parent:
6:1a5654c14b5b
Child:
12:953d25061417
--- a/RTOS-Threads/src/Task3.cpp	Wed Apr 30 13:49:12 2014 +0000
+++ b/RTOS-Threads/src/Task3.cpp	Thu May 01 23:50:21 2014 +0000
@@ -26,9 +26,9 @@
             box_demo = true;
             rc_out = false;
             gyro_out = false;
-            ypr_offset[0] = ypr[0];
-            ypr_offset[1] = ypr[1];
-            ypr_offset[2] = ypr[2];
+            ypr_offset[0] = ypr_use[0];
+            ypr_offset[1] = ypr_use[1];
+            ypr_offset[2] = ypr_use[2];
         } else if (data == 'R') {
             box_demo = false;
             rc_out = true;
@@ -43,6 +43,7 @@
             gyro_out = false;
         }
     }
+    
     RCCommand[2] = rxModule[0].pulsewidth(); // Roll
     RCCommand[3] = rxModule[1].pulsewidth(); // Throttle
     RCCommand[1] = rxModule[2].pulsewidth(); // Pitch
@@ -56,6 +57,7 @@
 
     if (rc_out)
         BT.printf("%5d %5d %5d %5d %5d\n", RCCommand[0], RCCommand[1], RCCommand[2], RCCommand[3], RCCommand[4]);
+        
 
     //LED[3] = !LED[3];
 }