speak割り込み 障害物の後、走ってから、目的地の方を向く

Dependencies:   ATP3012 mbed a HMC US015_2 getGPS

Revision:
1:7e0593a7b534
Parent:
0:dbc31c76716d
Child:
2:72e09781a13d
--- a/main.cpp	Mon Dec 06 09:53:05 2021 +0000
+++ b/main.cpp	Thu Dec 09 10:30:51 2021 +0000
@@ -8,7 +8,7 @@
 DigitalIn flight_pin(A0);
 DigitalOut nichrome(D13);
 
-#define cp_max 3    //CPの数を入力する
+#define cp_max 2    //CPの数を入力する
 
 //音声割り込み
 Ticker onsei_tick;
@@ -20,21 +20,21 @@
     // 変数宣言
     double GPS_x, GPS_y;  // 現在地の座標
     double direction;     // 次CPへの向き
-    double CPs_x[3]={34.54608391847546, 34.545845666047306, 34.545666059919796};  //CPリスト(x座標)
-    double CPs_y[3]={135.50338843400897, 135.50368659080985, 135.50347298593758};    // CPリスト(y座標)
+    double CPs_x[2]={34.545588426585454, 34.5454484832847};  //CPリスト(x座標)
+    double CPs_y[2]={135.50282053551706, 135.50262437335775};    // CPリスト(y座標)
     double next_CP_x, next_CP_y;
     
     // 落下検知
     // パラシュート分離
     
-    /*wait(3);//電源ついてから3v3が安定するまで、秒数は適当、必要かもわからん
+    wait(3);//電源ついてから3v3が安定するまで、秒数は適当、必要かもわからん
     while(flight_pin){}
         xbee.printf("flight_pin nuketa");
         wait(35);//ピン抜けてから地面につくまで70m/2.8(m/s)=25(s)余裕を見て+10s
-        nichrome=1;
+        //nichrome=1;
         xbee.printf("nichrome in");
-        wait(30);
-        nichrome=0;*/
+        wait(10);
+        nichrome=0;
     // 落下終了