#include <Wire.h>
#include <MPU6050_tockn.h>
#include <Arduino.h>

MPU6050 mpu(Wire);

void setup() {
  Serial.begin(115200);
  Wire.begin();
  mpu.begin();
  mpu.calcGyroOffsets(true); // Tự động tính toán và hiệu chỉnh cảm biến
}

void loop() {
  mpu.update();

  // Hiển thị dữ liệu góc từ các trục X, Y, Z
  Serial.print("AngleX: ");
  Serial.print(mpu.getAngleX());
  Serial.print("\tAngleY: ");
  Serial.print(mpu.getAngleY());
  Serial.print("\tAngleZ: ");
  Serial.println(mpu.getAngleZ());

  delay(100);
}