Diff: main.cpp

Revision:

14:b902e73a5404

Parent:

13:c3c7524d2440

Child:

15:792eb5103e9e

--- a/main.cpp	Thu Jun 22 10:47:01 2017 +0000
+++ b/main.cpp	Sun Jul 09 09:20:22 2017 +0000
@@ -22,21 +22,27 @@
 #define servo_deg_close 90//サーボの水密構造を閉じる時の角度
 
 //-----------------------------------------センサの測定レンジなどの設定
-#define Acc_range 2.
-#define conv2Gravity 1./(32768./Acc_range)
+#define Acc_range 2.//加速度センサの測定レンジ
+#define para_switch p10//パラシュート展開用のデジタル出力ピン番号
+#define time_between_para_opening_ms 4000//パラシュート展開用の電熱線の加熱時間(msec) 
+#define conv2Gravity 1./(32768./Acc_range)//加速度センサの値の単位をGに変換
 #define AT24C1024_address 0x50
 
 DigitalOut myled1(LED1);
 DigitalOut myled2(LED2);
 DigitalOut myled3(LED3);
 DigitalOut myled4(LED4);
+
+DigitalOut Para(para_switch);//パラシュート展開用のクラス
+
 Timer t;
 
 AnalogIn analog_rand(p20);//電圧読み取り用のピン
 
 double pres_dif[size_dif]= {0}; //気圧の変化をsize_difの数だけ保存
-uint32_t launch_detect_time=0;//発射検知の時間
-uint32_t fall_detect_time=0;//頂点検知の時間
+uint32_t launch_detect_time=0;//発射検知の時間(ms)
+uint32_t fall_detect_time=0;//頂点検知の時間(ms)
+uint32_t para_open_time=0;//パラシュート展開の時間(ms)
 
 SDFileSystem sd(p5, p6, p7, p8, "sd");//SDカードのオブジェクト作成
 BMP085 BMP(p9,p10);//気圧、温度センサのクラス
@@ -175,9 +181,9 @@
         Im920.printf(send_data);
     }
 
-    void servo_move(){//サーボの動作に関する関数
+    void servo_move() { //サーボの動作に関する関数
         myservo.position(servo_deg_close);
-        }
+    }
 
 };
 
@@ -216,7 +222,7 @@
 
 }
 
-void SD_check() //SDカードの確認
+void Setup() //SDカードの確認
 {
     /*
     起動時に４つのLEDを一旦全部点灯
@@ -224,7 +230,7 @@
     確認終了後break
     */
 
-
+    Para=0;//パラシュート展開用のトランジスタをoff
     myled1=myled2=myled3=myled4=1;
     wait_ms(1000);
     myled1=myled2=myled3=myled4=0;
@@ -337,7 +343,10 @@
     展開高度の制限が必要になったら、waitを挟む
     展開命令後LED3点灯
     */
-    wait_ms(1000);
+    Para=1;
+    wait_ms(time_between_para_opening_ms);
+    Para=0;
+    para_open_time=t.read_ms();
     myled3=1;
 }
 
@@ -355,7 +364,7 @@
 int main()
 {
     t.start();
-    SD_check();
+    Setup();
     status=1;
     uint32_t msg=Launch_detect();
     status=2;