Diff: main.cpp

Revision:

18:42cbba4fb371

Parent:

17:1b6a84ab4433

Child:

19:046524ac0985

--- a/main.cpp	Thu Oct 28 09:36:33 2021 +0000
+++ b/main.cpp	Thu Oct 28 13:15:05 2021 +0000
@@ -9,7 +9,7 @@
 DigitalIn flight_pin(A0);
 DigitalOut nichrome(D13);
 // 
-#define cp_max 3//cpの数を自分で入れてね
+#define cp_max 3    //CPの数を入力する
 
 int main() {
     // 変数宣言
@@ -17,13 +17,13 @@
     int last_num;         // CPリストの最後の要素のインデックス*/
     double GPS_x, GPS_y;  // 現在地の座標
     double direction;     // 次CPへの向き
-    double CPs_x[3]={34.545658, 34.545837, 34.546052};  // = [];  //CPリスト(x座標)
-    double CPs_y[3]={135.503469, 135.503676, 135.503503};  // = [];  // CPリスト(y座標)
+    double CPs_x[3]={34.545658, 34.545837, 34.546052};  //CPリスト(x座標)
+    double CPs_y[3]={135.503469, 135.503676, 135.503503};    // CPリスト(y座標)
     double next_CP_x, next_CP_y;
     
     // 落下検知
     // パラシュート分離
-    /*
+    
     wait(3);//電源ついてから3v3が安定するまで、秒数は適当、必要かもわからん
     while(flight_pin){
         pc.printf("flight_pin nuketa");
@@ -34,7 +34,6 @@
         nichrome=0;
     }
     // 落下終了
-    */
     
     
     // 行動フロー開始
@@ -51,7 +50,7 @@
             
             while (1) {
                 speak();
-                /*
+                
                 direction = AngleGet();
                 pc.printf("direction=%f\n", direction);
                 while(1) {
@@ -64,7 +63,6 @@
                         Move('4', 0.5);
                     }
                 }
-                */
                 
                 if (FrontGet()) {
                     Move('1', 0);      //停止
@@ -87,6 +85,7 @@
         }
     // 行動フロー終了
     pc.printf("End\r\n");
+    Move('1', 0);      //停止
     return 0;
     }
 }