GPS and IMU reading works

Dependencies:   mbed Servo SDFileSystem

/media/uploads/taoqiuyang/img_2352.jpg

Revision:
46:305112d73c69
Parent:
38:528e410f2f7d
--- a/Get.cpp	Tue Nov 03 16:31:44 2015 +0000
+++ b/Get.cpp	Wed Nov 04 21:45:34 2015 +0000
@@ -49,7 +49,14 @@
     }
 }
 
-
+int get_current_task() {
+    for(int i=0;i<MAX_TASK_SIZE;i++){
+        if(IF_Path_Complete[i]==0) {
+            return i+1;
+        }
+    }
+    return 1;
+}
 
 double Deg2Rad(double degree) {
     return degree*DEG2RAD_RATIO;