コウスケ スズキ
/
MPU6050_ANGLE
accel gyro
Diff: main.cpp
- Revision:
- 0:0ed2c0a9b8d4
- Child:
- 1:279026544175
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Sun Jan 23 03:59:50 2022 +0000 @@ -0,0 +1,36 @@ +#include "mbed.h" +#include "MPU6050.h" + +DigitalOut myled(LED1); + +//SDFileSystem sd(p5, p6, p7, p8, "sd"); // the pinout on the mbed Cool Components workshop board +MPU6050 mpu(p9,p10); +Serial pc(USBTX,USBRX,9600); +int accel[3]; + +int main() { + //mkdir("/sd/mydir", 0777); + //FILE *fp = fopen("/sd/mydir/sdtest.txt", "w"); + for(int i =0;i<10;i++){ + myled=1; + mpu.readAccelData(accel);//加速度の値をaccel[3]に代入 + int x = accel[0]-123;//x軸方向の加速度 + int y = accel[1]+60;//y軸方向の加速度 + int z = accel[2]+1110 ;//z軸方向の加速度 + float X = x*0.000597964111328125; + float Y = y*0.000597964111328125; + float Z = z*0.000597964111328125; + double a = X*X+Y*Y+Z*Z-95.982071137936; + printf("%.2f %.2f %.2f %.2f\r\n",X,Y,Z,a);//速度と変位を表示 + wait(1.0); + myled=0; + wait(1.0); + + //if(fp == NULL) { + //error("Could not open file for write\n"); + //} + //fprintf(fp,"%.2f %.2f %.2f %.2f\r\n",X,Y,Z,a); + //fprintf(fp,"%.2f \r\n",Y); + //} + //fclose(fp); +}} \ No newline at end of file