main.cpp

00001 #include "mbed.h"
00002 #include "SDFileSystem.h"
00003 #include "MPU6050.h"
00004  
00005 SDFileSystem sd(p5, p6, p7, p8, "sd"); // the pinout on the mbed Cool Components workshop board
00006 MPU6050 mpu(p9,p10);
00007 Serial pc(USBTX,USBRX,9600); 
00008 
00009 int accel[3];
00010 
00011 Timer t;
00012 
00013 int main() {
00014     t.start();
00015     mkdir("/sd/mydir", 0777);
00016     FILE *fp = fopen("/sd/mydir/sdtest.txt", "w");
00017     while(1){
00018         mpu.readAccelData(accel);                                                                       //加速度の値をaccel[3]に代入
00019         int x = accel[0]-123;                                                                           //x軸方向の加速度
00020         int y = accel[1]+60;                                                                            //y軸方向の加速度
00021         int z = accel[2]+1110 ;                                                                         //z軸方向の加速度
00022         float X = x*0.000597964111328125;
00023         float Y = y*0.000597964111328125;
00024         float Z = z*0.000597964111328125;
00025         double a = X*X+Y*Y+Z*Z-95.982071137936;
00026     
00027         pc.printf("%0.4f %.2f %.2f %.2f %.2f\r\n",t.read(),X,Y,Z,a);
00028         if(fp == NULL) {
00029             error("Could not open file for write\n");
00030         }
00031         fprintf(fp, "%.2f %.2f %.2f %.2f\r\n",X,Y,Z,a);
00032         if(t >= 10){  
00033             fclose(fp);
00034             t.stop();
00035             return 0;
00036             }
00037             }
00038  
00039 }