Agra-GPS / FreePilot_V2-3

Dependencies:   FreePilot PinDetect mbed-src

Fork of FreePilot_V2-2 by Agra-GPS

Revision:
34:c2bc9f9be7ff
Parent:
33:3e71c418e90d
--- a/Config.cpp	Mon Feb 02 18:24:03 2015 +0000
+++ b/Config.cpp	Fri Feb 13 17:22:53 2015 +0000
@@ -18,8 +18,11 @@
     fp = fopen("/local/config.txt", "r");
 
     while (fgets(line, sizeof(line), fp)) //Read through config file line by line
+    {
+        
+ pc.puts(line);
         Dispatch(line, true); //Send line to dispatcher, true indicates its coming from the config file
-
+}
     fclose(fp);
 }
 
@@ -27,7 +30,6 @@
 {
     FILE * fp;
     fp = fopen("/local/config.txt", "w");
-    
     //sprintf("$ID,%d\r\n$BTMODE,%d\r\n$PA,%f\r\n$TC,%f\r\n
     fprintf(fp, "$ID,%d\r\n",_ID);//address
     fprintf(fp, "$BTMODE,%d\r\n",_btMode);//bluetooth mode
@@ -36,17 +38,9 @@
     fprintf(fp, "$FG,%f\r\n",fgain);//filter gain
     fprintf(fp, "$SC,%f\r\n",scale);//scale
     fprintf(fp, "$AP,%f\r\n",avgpos);//avgpos
-
     fprintf(fp,"$GYRO,%i\r\n",gyro_pos);
     fprintf(fp,"$GPSBAUD,%d\r\n",gps_baud);
     fprintf(fp,"$HEIGHT,%f\r\n",antennaheight);
-  //  fprintf(fp,"$a_zBias,%f\r\n",a_zBias);
-  //  fprintf(fp,"$a_yBias,%f\r\n",a_yBias);
-  // fprintf(fp,"$a_zBias,%f\r\n",a_zBias);
-  //  fprintf(fp,"$w_xBias,%f\r\n",w_xBias);
-   // fprintf(fp,"$w_yBias,%f\r\n",w_yBias);
-   // fprintf(fp,"$w_zBias,%f\r\n",w_zBias);
-   
     fclose(fp);
 }