accel gyro

Dependencies:   MPU6050 mbed

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