Kouki Takagi / Mbed 2 deprecated 201708kaiho_takagi

2017年能代開放用プログラム

Dependencies:   mbed MPU6050 MS5607

Files at this revision

API Documentation at this revision

Revision 1:68309ba0103d, committed 2017-08-11

Comitter:
kouki728
Date:
Fri Aug 11 13:57:14 2017 +0000
Parent:
0:a4734a842395
Commit message:
advanced work

Changed in this revision

MPU6050.lib Show annotated file Show diff for this revision Revisions of this file
MS5607.lib Show annotated file Show diff for this revision Revisions of this file
main.cpp Show annotated file Show diff for this revision Revisions of this file 
diff -r a4734a842395 -r 68309ba0103d MPU6050.lib
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/MPU6050.lib	Fri Aug 11 13:57:14 2017 +0000
@@ -0,0 +1,1 @@
+http://mbed.org/users/Sissors/code/MPU6050/#5c63e20c50f3

diff -r a4734a842395 -r 68309ba0103d MS5607.lib
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/MS5607.lib	Fri Aug 11 13:57:14 2017 +0000
@@ -0,0 +1,1 @@
+http://mbed.org/users/yamaguch/code/MS5607/#5760862143d1

diff -r a4734a842395 -r 68309ba0103d main.cpp
--- a/main.cpp	Sun Jul 23 03:34:48 2017 +0000
+++ b/main.cpp	Fri Aug 11 13:57:14 2017 +0000
@@ -1,12 +1,79 @@
 #include "mbed.h"
+#include "math.h"
+#include "MPU6050.h"
+#include "MS5607I2C.h"
+
+#define STANBY
+#define LAUNCH
+#define RISE
+#define DROP
+#define  ACC
+#define SERCH_TIME
+#define
+#define
+#define
+#define
 
-DigitalOut myled(LED1);
+
+MPU6050 mpu(p9, p10);
+MS5607I2C ms(p9, p10, false);
+PwmOut servo1(p26);
+PwmOut servo2(p25);
+PwmOut servo3(p24);
+DegitalOut myled1(LED1);
+DegitalOut myled2(LED2);
+DegitalOut myled3(LED3);
+Timer timer;
+Ticker ticker;
+
+
+void _judge();
+float _median(float[5]);
+
 
 int main() {
-    while(1) {
-        myled = 1;
-        wait(0.2);
-        myled = 0;
-        wait(0.2);
-    }
+    timer.start()
 }
+
+void _judge(){
+    switch(FHASE){
+        case STANBY:
+                    break;
+        case LAUNCH:
+                    myled1 = 0;
+                    float acc[3], acc_3;
+                    int count = 0;
+                    
+                    getAccelero(acc);
+                    acc_3 = pow(acc[0], 2) + pow(acc[1], 2) + pow(acc[2], 2);
+                    acc_3 = sqrt(acc_3);
+                    
+                    if(acc >= ACC){
+                        if(count == 0) SERCH_TIME = timer.read();
+                        count++;
+                    }
+                    
+                    if(timer.read() > time + SERCH_TIME){
+                        count = 0;
+                    }
+                    
+                    if(count == COUNT){
+                        myled = 1;
+                        PHASE = RISE;
+                    }
+                    
+                    break;
+        case RISE:
+                    myled2 = 0;
+                    
+                    break;
+        case DROP:
+                    
+                    break;
+        
+        }
+}
+
+float _median(){
+    
+}