FTE-06 - 東北大学学友会準加盟団体 From The Earth の高高度ロケットFTE-06（通称：海豚）…

FTE-denshi » Code » FTE-06

東北大学学友会準加盟団体 From The Earth の高高度ロケットFTE-06（通称：海豚）にて使用したソフトウェアです．ご自由にお使いください．このプログラムによって生じた損害について当団体は一切責任を負いません．また，各モジュールのライブラリは当団体が作成したものではないので再配布は禁止します．

Dependencies: mbed FATFileSystem

Fork of FTE-06 by Tetsushi Amano

Diff: main.cpp

Revision:: 49:8f21d1ed7063
Parent:: 48:58213015bb90
Child:: 51:af23f1fc4a63

--- a/main.cpp	Tue Aug 22 11:33:42 2017 +0000
+++ b/main.cpp	Tue Aug 22 12:33:38 2017 +0000
@@ -23,9 +23,10 @@
 #define fall_detect_lock 5000//加速度で発射検知したときに頂点検知にロックをかける時間(msec)
 #define servo_deg_initial 20//サーボの初期角度
 #define servo_deg_close 90//サーボの水密構造を閉じる時の角度
-#define gps_update_rate 10
+
 
 //-----------------------------------------センサの測定レンジなどの設定
+#define gps_update_rate 10
 #define para_switch p22//パラシュート展開用のデジタル出力ピン番号
 #define time_between_para_opening_ms 4000//パラシュート展開用の電熱線の加熱時間(msec) 
 #define conv2Gravity 12*10/(32768./2)/9.80665//10./(32768./Acc_range)/9.80665//加速度センサの値の単位をGに変換2g:0.0001 4g:0.002 16g:0.0039
@@ -104,7 +105,7 @@
         longitude=0;
 
         //---------------------------
-        myservo.position(servo_deg_initial);//サーボ位置の初期化
+        
         /*randomなfile名作成*/
         /*
         result_num = rand()%1000;//0~999のランダムな数字
@@ -267,6 +268,8 @@
     wait_ms(1000);
     myled1=myled2=myled3=myled4=0;
     rocket_data.send_data("setup_ok");
+    wait_ms(1000);
+    
 }
 
 uint32_t Launch_detect() //発射検知
@@ -402,6 +405,7 @@
     Setup();
     status=1;
     uint32_t msg=Launch_detect();
+    myservo.position(servo_deg_initial);//サーボ位置の初期化(省電力のため)
     if(msg==true) {
         rocket_data.send_data("detected launch by acc");
     } else if(msg==false) {