#include <Wire.h>
#include <MPU6050_light.h>

MPU6050 mpu(Wire);

void setup() {
  Serial.begin(9600);
  Wire.begin();

  byte status = mpu.begin();
  Serial.print("Status da inicialização: ");
  Serial.println(status);
  // 0 = OK, outros = erro

  if (status != 0) {
    Serial.println("Falha ao iniciar MPU6050. Verifique conexões!");
    while (1);
  }

  Serial.println("Calibrando, mantenha o sensor parado...");
  delay(1000);
  mpu.calcOffsets(); // Calibra giroscópio e acelerômetro
  Serial.println("Calibração concluída!");
}

void loop() {
  mpu.update();

  Serial.print("Acc X: ");
  Serial.print(mpu.getAccX());
  Serial.print(" | Acc Y: ");
  Serial.print(mpu.getAccY());
  Serial.print(" | Acc Z: ");
  Serial.print(mpu.getAccZ());

  Serial.print(" || Gyro X: ");
  Serial.print(mpu.getGyroX());
  Serial.print(" | Gyro Y: ");
  Serial.print(mpu.getGyroY());
  Serial.print(" | Gyro Z: ");
  Serial.println(mpu.getGyroZ());

  delay(500);
}