#include <Wire.h>
#include <MPU6050.h>

MPU6050 mpu;
unsigned long measureReadTime() 
{
  unsigned long startTime = micros();
  int16_t ax, ay, az;
  mpu.getAcceleration(&ax, &ay, &az);
  return micros() - startTime;
}

void setup() {
  Serial.begin(115200);
  Wire.begin(21, 22);
  mpu.initialize();
  if (!mpu.testConnection()) 
  {
    Serial.println("Kết nối với MPU6050 thất bại!");
    while (1);
  }
  Wire.setClock(100000);
  Serial.println("Tốc độ giao tiếp I2C: 100 kHz");
  unsigned long readTime = measureReadTime();
  Serial.print("Thời gian đọc dữ liệu (100 kHz): ");
  Serial.print(readTime);
  Serial.println(" µs");
  Wire.setClock(400000);
  Serial.println("Tốc độ giao tiếp I2C: 400 kHz");
  readTime = measureReadTime();
  Serial.print("Thời gian đọc dữ liệu (400 kHz): ");
  Serial.print(readTime);
  Serial.println(" µs");
}

void loop() 
{
}