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

MPU6050 mpu;

U8G2_SSD1306_128X64_NONAME_1_HW_I2C u8g2(U8G2_R0);  // Inisialisasi objek untuk OLED Display

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

  Wire.begin();
  mpu.initialize();

  // Inisialisasi OLED Display
  u8g2.begin();
  u8g2.setFont(u8g2_font_ncenB14_tr);  // Pilih font yang diinginkan
}

void loop() {
  // Variabel untuk menyimpan data akselerasi dan rotasi
  int16_t ax, ay, az, gx, gy, gz;

  // Baca data dari MPU6050
  mpu.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);

  // Tampilkan nilai gyro pada OLED Display
  u8g2.firstPage();
  do {
    u8g2.setCursor(0, 20);
    u8g2.print("GyroX: ");
    u8g2.print(gx);
    u8g2.setCursor(0, 40);
    u8g2.print("GyroY: ");
    u8g2.print(gy);
    u8g2.setCursor(0, 60);
    u8g2.print("GyroZ: ");
    u8g2.print(gz);
  } while (u8g2.nextPage());

  delay(500); // Beri jeda 500 milidetik
}