#include <Wire.h>
#include <Adafruit_Sensor.h>
#include <Adafruit_MPU6050.h>

// Inisialisasi sensor MPU6050
Adafruit_MPU6050 mpu;

void setup() {
  Serial.begin(115200); // Mulai komunikasi serial dengan baud rate 115200

  // Inisialisasi sensor MPU6050
  if (!mpu.begin()) {
    Serial.println("Failed to find MPU6050 chip");
    while (1) {
      delay(10); // Hentikan program jika sensor tidak terdeteksi
    }
  }
  Serial.println("MPU6050 Found!");

  // Set default ranges (these are the default values anyway)
  mpu.setAccelerometerRange(MPU6050_RANGE_2_G);
  mpu.setGyroRange(MPU6050_RANGE_250_DEG);
}

void loop() {
  // Mendapatkan data sensor
  sensors_event_t a, g, temp;
  mpu.getEvent(&a, &g, &temp);

  // Cetak data akselerasi ke Serial Monitor
  Serial.print("Acceleration X: ");
  Serial.print(a.acceleration.x);
  Serial.print(" m/s^2, ");
  Serial.print("Y: ");
  Serial.print(a.acceleration.y);
  Serial.print(" m/s^2, ");
  Serial.print("Z: ");
  Serial.print(a.acceleration.z);
  Serial.println(" m/s^2");

  // Cetak data rotasi ke Serial Monitor
  Serial.print("Rotation X: ");
  Serial.print(g.gyro.x);
  Serial.print(" rad/s, ");
  Serial.print("Y: ");
  Serial.print(g.gyro.y);
  Serial.print(" rad/s, ");
  Serial.print("Z: ");
  Serial.print(g.gyro.z);
  Serial.println(" rad/s");

  // Cetak suhu ke Serial Monitor
  Serial.print("Temperature: ");
  Serial.print(temp.temperature);
  Serial.println(" °C");

  Serial.println("");
  delay(500); // Tunggu sebentar sebelum pembacaan berikutnya
}