ESE350 project, Spring 2016, University of Pennsylvania

Dependencies:   Adafruit9-DOf Receiver mbed-rtos mbed

Revision:
17:96d0c72e413e
Parent:
16:2be2aab63198
Child:
18:a00d6b065c6b
diff -r 2be2aab63198 -r 96d0c72e413e main.cpp
--- a/main.cpp	Thu Apr 07 22:04:03 2016 +0000
+++ b/main.cpp	Thu Apr 07 22:13:17 2016 +0000
@@ -76,11 +76,11 @@
 
     while (1) {
         myQuadcopter.readSensorValues();
+        pc.printf("%lld: %f,%f,%f,%f\r\n", myQuadcopter.id, myQuadcopter.thrust, myQuadcopter.yaw, myQuadcopter.pitch, myQuadcopter.roll);
 
         // myQuadcopter.controller();
 
-
-        wait(0.01);
+        // wait(0.01);
 
         // Set duty cycle
         motors motorsPwm=myQuadcopter.getPwm();