Xbeeを実装、speakをfunctionに、rotate消した、calibrationで回るように、ゴール判定を消した

Dependencies:   ATP3012 mbed a HMC US015_2 getGPS

Revision:
25:9659d86209cc
Parent:
24:b9b252fbee8e
Child:
26:7a92eef404ac
--- a/main.cpp	Fri Dec 17 08:04:00 2021 +0000
+++ b/main.cpp	Fri Dec 17 08:06:29 2021 +0000
@@ -43,7 +43,6 @@
         xbee.printf("next_i=%d\r\n", i);
             
         while (1) {
-                speak();
                 while(FrontGet()) {
                     xbee.printf("frontget\n\r");
                     Move('2', 0.1);
@@ -87,7 +86,7 @@
                         direction = AngleGet(next_CP_x,next_CP_y);
                         }
                 }
-                
+                speak();
                 catchGPS();
                 xbee.printf("now point(lati, long)=%lf , %lf\r\n", gps.latitude, gps.longitude);