speak割り込み 障害物の後、走ってから、目的地の方を向く
Dependencies: ATP3012 mbed a HMC US015_2 getGPS
Diff: main.cpp
- 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; // 落下終了