GPS and IMU reading works

Dependencies:   mbed Servo SDFileSystem

/media/uploads/taoqiuyang/img_2352.jpg

Revision:
47:4b490931e75f
Parent:
46:305112d73c69
Child:
48:575ec42c5f58
--- a/main.cpp	Wed Nov 04 21:45:34 2015 +0000
+++ b/main.cpp	Wed Nov 25 20:13:57 2015 +0000
@@ -210,24 +210,24 @@
 void decodePC(string PC_data) {
     string PC_data_string(PC_data);
     if (PC_data_string.substr(0,4) == "@GET") {
-        pc.printf("%s", PC_data_string.c_str());
+        //pc.printf("%s", PC_data_string.c_str());
         PC_data_string = PC_data_string.substr(5, PC_data_string.size()-6);
         pc.printf("%s\n", decodeCommandGET(PC_data_string).c_str());
     } else if (PC_data_string.substr(0,4) == "@SET") {
-        pc.printf("%s", PC_data_string.c_str());
+        //pc.printf("%s", PC_data_string.c_str());
         PC_data_string = PC_data_string.substr(5, PC_data_string.size()-6);
         string claim = decodeCommandSET(PC_data_string);
         if (claim == "DONE") {
-            pc.printf("Current Path: Longitude, Latitude\n");
+            //pc.printf("Current Path: Longitude, Latitude\n");
             for (int i=0;i<MAX_TASK_SIZE;++i) {
-                pc.printf("              %f, %f\n", Longitude_Path[i], Latitude_Path[i]);
+                //pc.printf("              %f, %f\n", Longitude_Path[i], Latitude_Path[i]);
             }
         }
-        pc.printf("%s\n", claim.c_str());
+        //pc.printf("%s\n", claim.c_str());
     } else if(PC_data_string.substr(0,6) == "@Hello") {
-        pc.printf("Successfully connected to mbed\n");
+        //pc.printf("Successfully connected to mbed\n");
     } else {
-        pc.printf("Not supported command\n");
+        //pc.printf("Not supported command\n");
     }
 }
 
@@ -470,7 +470,7 @@
     //Drive servos
     if (autonomous_mode){set_servo_position(rudderServo,rudder_variables[4],-45,0,45,1);}
     
-    pc.printf("%f\n",rudder_variables[4]);
+    //pc.printf("%f\n",rudder_variables[4]);
 }