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

Dependencies:   MPU6050 MS5607 mbed SDFileSystem

Committer:
mikawataru
Date:
Sun Feb 12 06:58:29 2017 +0000
Revision:
0:10a9c9c5ce83
Child:
1:ec75f428c6b3
?????LPC1768???; MPU??????; ??????

Who changed what in which revision?

UserRevisionLine numberNew contents of line
mikawataru 0:10a9c9c5ce83 1 #include "mbed.h"
mikawataru 0:10a9c9c5ce83 2 #include "MS5607I2C.h"
mikawataru 0:10a9c9c5ce83 3 #include "MPU6050.h"
mikawataru 0:10a9c9c5ce83 4
mikawataru 0:10a9c9c5ce83 5 #define RATE 10
mikawataru 0:10a9c9c5ce83 6
mikawataru 0:10a9c9c5ce83 7 MS5607I2C ms5607(p9, p10, false);
mikawataru 0:10a9c9c5ce83 8 MPU6050 mpu(p9,p10);
mikawataru 0:10a9c9c5ce83 9 DigitalIn sw(p21);
mikawataru 0:10a9c9c5ce83 10 DigitalOut myled(LED1);
mikawataru 0:10a9c9c5ce83 11 Serial pc(USBTX, USBRX);
mikawataru 0:10a9c9c5ce83 12
mikawataru 0:10a9c9c5ce83 13 Ticker loop_measure;
mikawataru 0:10a9c9c5ce83 14
mikawataru 0:10a9c9c5ce83 15 int8_t cnt = 0;
mikawataru 0:10a9c9c5ce83 16 float altitude[RATE],pressure[RATE],temperature[RATE];
mikawataru 0:10a9c9c5ce83 17 float acc[RATE][3],gyro[RATE][3];
mikawataru 0:10a9c9c5ce83 18 void _Launch(){
mikawataru 0:10a9c9c5ce83 19 myled = 1;
mikawataru 0:10a9c9c5ce83 20 }
mikawataru 0:10a9c9c5ce83 21 void _measure(){
mikawataru 0:10a9c9c5ce83 22 altitude[cnt] = ms5607.getAltitude();
mikawataru 0:10a9c9c5ce83 23 pressure[cnt] = ms5607.getPressure();
mikawataru 0:10a9c9c5ce83 24 temperature[cnt] = ms5607.getTemperature();
mikawataru 0:10a9c9c5ce83 25 mpu.getAccelero(&acc[cnt][0]);
mikawataru 0:10a9c9c5ce83 26 mpu.getGyro(&gyro[cnt][0]);
mikawataru 0:10a9c9c5ce83 27 // pc.printf("%f,%f,%f\t",pressure[cnt],temperature[cnt], altitude[cnt]);
mikawataru 0:10a9c9c5ce83 28 // 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]);
mikawataru 0:10a9c9c5ce83 29 cnt++;
mikawataru 0:10a9c9c5ce83 30 if(cnt==10)cnt = 0;
mikawataru 0:10a9c9c5ce83 31 }
mikawataru 0:10a9c9c5ce83 32
mikawataru 0:10a9c9c5ce83 33 int main() {
mikawataru 0:10a9c9c5ce83 34 myled = 0;
mikawataru 0:10a9c9c5ce83 35 loop_measure.attach(&_measure,0.1);
mikawataru 0:10a9c9c5ce83 36 while(1){
mikawataru 0:10a9c9c5ce83 37 if(sw==0)_Launch();
mikawataru 0:10a9c9c5ce83 38 }
mikawataru 0:10a9c9c5ce83 39 }