auto

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

Revision:
3:7affc8af6db6
Parent:
2:e9a8664b52ff
--- a/main.cpp	Mon Apr 13 10:09:42 2015 +0000
+++ b/main.cpp	Mon Apr 13 11:33:36 2015 +0000
@@ -131,7 +131,7 @@
                         
                     case RECEIVE_STATUS:{
                             
-                        printf("Receive Status\n");      
+                        //printf("Receive Status\n");      
                            
                         id = buf1[5] - 'A';
                         robot[id].set_state(buf1[9]);
@@ -141,9 +141,10 @@
                         robot[id].set_LongitudeL(&buf1[25]); 
                         
                         agz.reNewBasePoint(id,robot[id].get_LatitudeH(),robot[id].get_LatitudeL(),robot[id].get_LongitudeH(),robot[id].get_LongitudeL());
-                            
-                        printf("%d\n", id);                    
-                        printf("%ld, %ld, %ld, %ld\n", robot[id].get_LatitudeH(), robot[id].get_LatitudeL(), robot[id].get_LongitudeH(), robot[id].get_LongitudeL());
+                    /*   
+                        printf("%d,", buf1[5]);                    
+                        printf(" %ld, %ld, %ld, %ld\n", robot[id].get_LatitudeH(), robot[id].get_LatitudeL(), robot[id].get_LongitudeH(), robot[id].get_LongitudeL());
+                    */
                         break;
                     }
                     
@@ -170,8 +171,8 @@
             if (myGPS.fix) {
                 agz.nowStatus = GPS_AVAIL;
                 agz.reNewRobotPoint(myGPS.longitudeH,myGPS.longitudeL,myGPS.latitudeH,myGPS.latitudeL);
-                printf("state = %d\n",agz.nowMode);
-                printf("my %ld, %ld, %ld, %ld\n", myGPS.longitudeH,myGPS.longitudeL,myGPS.latitudeH,myGPS.latitudeL);
+                //printf("state = %d\n",agz.nowMode);
+                //printf("my %ld, %ld, %ld, %ld\n", myGPS.longitudeH,myGPS.longitudeL,myGPS.latitudeH,myGPS.latitudeL);
             }
             else agz.nowStatus = GPS_UNAVAIL;
             
@@ -181,7 +182,7 @@
         if( collect_Timer.read_ms() >= collect_Time){
             collect_Timer.reset();
             
-            printf("Send Request:%d,%d\n",collect_flag,collect_state);
+            //printf("Send Request:%d,%d\n",collect_flag,collect_state);
                       
             agz.createRequestCommand('A', collect_state);
             //Select Destination