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

MPU6050 mpu6050(Wire);
MPU6050 accelerometer(I2C_MODE, 0x25)

void setup() {
    Serial.begin(115200);
    Wire.begin();
    mpu6050.begin();
    mpu6050.calcGyroOffsets(true);  // Calibrer le gyroscope au démarrage
}

void loop() {
    mpu6050.update();
    
    // Afficher les valeurs de l'accéléromètre
    Serial.print(" | Acc X: "); Serial.print(mpu6050.getAccX());
    Serial.print(" | Acc Y: "); Serial.print(mpu6050.getAccY());
    Serial.print(" | Acc Z: "); Serial.println(mpu6050.getAccZ());

    // Afficher les valeurs du gyroscope
    Serial.print(" | Gyro X: "); Serial.print(mpu6050.getGyroX());
    Serial.print(" | Gyro Y: "); Serial.print(mpu6050.getGyroY());
    Serial.print(" | Gyro Z: "); Serial.println(mpu6050.getGyroZ());

    Serial.println(" Temp  = "); Serial.println(mpu6050.getTemp());
    Serial.println("------------------------------------------------");
    
}