![](/media/cache/group/default_image.jpg.50x50_q85.jpg)
2017年3月,伊豆大島共同打上実験 CORE_缶ロケチーム電装
Dependencies: MPU6050 MS5607 mbed SDFileSystem
main.cpp@0:10a9c9c5ce83, 2017-02-12 (annotated)
- 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?
User | Revision | Line number | New 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 | } |