GPS and IMU reading works
Dependencies: mbed Servo SDFileSystem
Diff: Get.cpp
- Revision:
- 46:305112d73c69
- Parent:
- 38:528e410f2f7d
diff -r dfa689f159ce -r 305112d73c69 Get.cpp --- 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;