2015/05/12

Dependencies:   ADXL345 AigamozuControlPackets HMC5843 ITG3200 MBed_Adafruit-GPS-Library XBee agzIDLIST agz_common mbed

Fork of Aigamozu_Robot_ver1_1 by aigamozu

Revision:
6:4abf031b5ccc
Parent:
1:d10d72b1d29b
--- a/main.cpp	Tue May 12 10:56:56 2015 +0000
+++ b/main.cpp	Tue May 12 12:02:15 2015 +0000
@@ -263,6 +263,7 @@
     
     Timer auto_Timer;
     const int auto_Time = 2000;
+    agz.nowMode = AUTO_MODE;
     
     //GPS Send Command
     myGPS.sendCommand(PMTK_SET_NMEA_OUTPUT_RMCONLY); 
@@ -274,8 +275,6 @@
     //interrupt start
     refresh_Timer.start();
     auto_Timer.start();
-
-    printf("start\n");
     
     while (true) {
         
@@ -323,12 +322,6 @@
             refresh_Timer.reset();
             Get_GPS(&myGPS);
             
-            printf("latitude:%f,longitude:%f\nlatitudeK:%f,longitudeK:%f\nCovlat:%f,Covlongi:%f\n",
-                    agz.get_agzPoint_lati(),agz.get_agzPoint_longi(),
-                    agz.get_agzPointKalman_lati(),agz.get_agzPointKalman_longi(),
-                    agz.get_agzCov_lati(),agz.get_agzCov_longi()
-                    );
-            
         }
         
         if(agz.nowMode == AUTO_MODE && auto_Timer.read_ms() >= auto_Time){