auto
Dependencies: ADXL345 AigamozuControlPackets HMC5843 ITG3200 MBed_Adafruit-GPS-Library XBee agzIDLIST mbed agz_common
Diff: main.cpp
- 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