GPS and IMU reading works

Dependencies:   mbed Servo SDFileSystem

/media/uploads/taoqiuyang/img_2352.jpg

Revision:
34:610d315c1bab
Parent:
33:37345814fad0
Child:
35:009cc4509a90
--- a/main.cpp	Thu Oct 01 15:24:11 2015 +0000
+++ b/main.cpp	Fri Oct 02 21:09:02 2015 +0000
@@ -233,14 +233,16 @@
     }
 }
 
-void printDistance() {   
-    for(int i=0;i<MAX_TASK_SIZE;++i) {       
+void printDistance() {
+    pc.printf("Current Distance: Task id, Distance\n");
+    for(int i=0;i<MAX_TASK_SIZE;++i) {    
         dis[i] = getDistance(i);
         pc.printf("Distance Task %d: %f\n", i+1, dis[i]);
     }   
 }
 
 void printAngle() {
+    pc.printf("Current Angle: Task id, Angle\n");
     for(int i=0;i<MAX_TASK_SIZE;++i) {       
         ang[i] = getAngle(i);
         pc.printf("Angle Task %d: %f\n", i+1, ang[i]);