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

Dependencies:   ATP3012 mbed a HMC US015_2 getGPS

Revision:
21:8469bb5e099f
Parent:
19:6c56feca386d
Child:
22:23d9592bca04
--- a/main.cpp	Thu Dec 16 09:08:40 2021 +0000
+++ b/main.cpp	Thu Dec 16 09:21:36 2021 +0000
@@ -8,14 +8,14 @@
 DigitalIn flight_pin(A0);
 DigitalOut nichrome(D13);
 // 
-#define cp_max 3    //CPの数を入力する
+#define cp_max 2    //CPの数を入力する
 
 int main() {
     // 変数宣言
     double GPS_x, GPS_y;  // 現在地の座標
     double direction;     // 次CPへの向き
-    double CPs_x[3]={34.545212,34.544931,34.545007};  //CPリスト(x座標)
-    double CPs_y[3]={135.508570,135.508768,135.509057};    // CPリスト(y座標)
+    double CPs_x[2]={334.54712081011074,34.54785702141566};  //CPリスト(x座標)
+    double CPs_y[2]={135.50777950352497,135.50680049992633};    // CPリスト(y座標)
     double next_CP_x, next_CP_y;
     
     // 落下検知