2017年3月,伊豆大島共同打上実験 CORE_缶ロケチーム電装

Dependencies:   MPU6050 MS5607 mbed SDFileSystem

main.cpp

Committer:
mikawataru
Date:
2017-02-12
Revision:
0:10a9c9c5ce83
Child:
1:ec75f428c6b3

File content as of revision 0:10a9c9c5ce83:

#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(); 
   }
}