Diff: main.cpp

Revision:

0:e527984bccd1

Child:

1:570e3c6fd4bb

diff -r 000000000000 -r e527984bccd1 main.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Mon Jul 31 14:12:47 2017 +0000
@@ -0,0 +1,64 @@
+/*
+alt  →altitude
+pres →pressure
+acc  →acceleration
+*/
+ 
+//todo 単位系どうなってるの？
+
+#include "mbed.h"
+#include "math.h"
+#include "MPU6050.h"
+#include "MS5607I2C.h"
+
+//todo defineの整理
+#define ALT_TOP 100
+#define ALT_LEAFING 300
+#define ACC 4*9.8
+#define COUNT 5
+
+
+MPU6050 mpu(p9,p10); //tx,rx
+MS5607I2C ms(p9,p10,false); //tx, rx, csピンがGND
+DigitalOut myled1(LED1);
+DigitalOut myled2(LED2);
+DigitalOut myled3(LED3);
+DigitalOut myled4(LED4);
+float alt=ms.getAltitude();
+float acc[3];
+float acc_total;
+float time_alt;
+float time_acc;
+int   cnt_alt=0;
+int   cnt_acc;
+
+//todo 変数の追加
+
+Timer timer;
+
+
+    
+void judge_top(){
+   
+    while(1){
+        if(ALT_TOP>=alt){
+            cnt_alt++;
+        }
+        if(timer.read()>0.5){
+            cnt_alt=0;
+        }
+        if(cnt_alt>=COUNT){
+            myled1=1;
+            //open the servos
+        }else{
+            myled1=0;
+            }
+    }
+}
+     
+
+int main(){
+    while(1){
+        judge_top();
+    }
+}
\ No newline at end of file