auto

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

Files at this revision

API Documentation at this revision

Comitter:
s1200058
Date:
Mon Apr 13 11:33:36 2015 +0000
Parent:
2:e9a8664b52ff
Commit message:
ver2

Changed in this revision

AigamozuControlPackets.lib Show annotated file Show diff for this revision Revisions of this file
main.cpp Show annotated file Show diff for this revision Revisions of this file
--- a/AigamozuControlPackets.lib	Mon Apr 13 10:09:42 2015 +0000
+++ b/AigamozuControlPackets.lib	Mon Apr 13 11:33:36 2015 +0000
@@ -1,1 +1,1 @@
-http://mbed.org/teams/aigamozu/code/AigamozuControlPackets/#4d71c9cc3b4a
+http://mbed.org/teams/aigamozu/code/AigamozuControlPackets/#eaab0ccb9255
--- 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