Diff: main.cpp

Revision:

0:10a9c9c5ce83

Child:

1:ec75f428c6b3

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Sun Feb 12 06:58:29 2017 +0000
@@ -0,0 +1,39 @@
+#include "mbed.h"
+#include "MS5607I2C.h"
+#include "MPU6050.h"
+
+#define RATE 10
+
+MS5607I2C ms5607(p9, p10, false);
+MPU6050 mpu(p9,p10);
+DigitalIn sw(p21);
+DigitalOut myled(LED1);
+Serial pc(USBTX, USBRX);
+
+Ticker loop_measure;
+
+int8_t cnt = 0;
+float altitude[RATE],pressure[RATE],temperature[RATE];
+float acc[RATE][3],gyro[RATE][3];
+void _Launch(){
+   myled = 1;
+}
+void _measure(){
+   altitude[cnt] = ms5607.getAltitude();
+   pressure[cnt] = ms5607.getPressure();
+   temperature[cnt] = ms5607.getTemperature();
+   mpu.getAccelero(&acc[cnt][0]);
+   mpu.getGyro(&gyro[cnt][0]);
+//   pc.printf("%f,%f,%f\t",pressure[cnt],temperature[cnt], altitude[cnt]);
+//   pc.printf("%f,%f,%f,%f,%f,%f\r\n",acc[cnt][0],acc[cnt][1],acc[cnt][2],gyro[cnt][0],gyro[cnt][1],gyro[cnt][2]);
+   cnt++;
+   if(cnt==10)cnt = 0;
+}
+
+int main() {
+   myled = 0;
+   loop_measure.attach(&_measure,0.1);
+   while(1){
+        if(sw==0)_Launch(); 
+   }
+}