#include "Wire.h"
#include "I2Cdev.h"
#include "MPU6050.h"
MPU6050 accelgyro;
int16_t ax, ay, az;
int16_t gx, gy, gz;
unsigned long count=0;
bool blinkState = false;
void setup() {
Wire.begin();
Serial2.begin(115200);
accelgyro.initialize();
}
void loop() {
Serial2.println("ok_begin");
accelgyro.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);
count++;
Serial2.println(count);
Serial2.println("ok_end");
// Serial2.print("a/g:\t");
// Serial2.print(ax / 8192); Serial2.print("\t");
// Serial2.print(ay / 8192); Serial2.print("\t");
// Serial2.print(az / 8192); Serial2.print("\t");
// Serial2.print(gx / 65.5); Serial2.print("\t");
// Serial2.print(gy / 65.5); Serial2.print("\t");
// Serial2.println(gz / 65.5);
// Serial2.println(gz / 65.5);
// blinkState = !blinkState;
delay(10);
}
|