2017年3月,伊豆大島共同打上実験 CORE_缶ロケチーム電装
Dependencies: MPU6050 MS5607 mbed SDFileSystem
Diff: main.cpp
- Revision:
- 0:10a9c9c5ce83
- Child:
- 1:ec75f428c6b3
diff -r 000000000000 -r 10a9c9c5ce83 main.cpp --- /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(); + } +}