#include <Wire.h>
#include <MPU6050.h>
MPU6050 mpu;
void setup() {
Serial.begin(115200);
Wire.begin(); // Memulai I2C
mpu.initialize(); // Inisialisasi MPU6050
// Memeriksa apakah sensor berhasil terhubung
if (mpu.testConnection()) {
Serial.println("MPU6050 tersambung!");
} else {
Serial.println("Koneksi gagal!");
while (1);
}
}
void loop() {
// Membaca data accelerometer dan gyroscope
int16_t ax, ay, az;
int16_t gx, gy, gz;
mpu.getAcceleration(&ax, &ay, &az); // Membaca accelerometer

mpu.getRotation(&gx, &gy, &gz); // Membaca gyroscope
// Menampilkan data accelerometer
Serial.print("Accelerometer: ");
Serial.print("X = "); Serial.print(ax);
Serial.print(" | Y = "); Serial.print(ay);
Serial.print(" | Z = "); Serial.println(az);
// Menampilkan data gyroscope
Serial.print("Gyroscope: ");
Serial.print("X = "); Serial.print(gx);
Serial.print(" | Y = "); Serial.print(gy);
Serial.print(" | Z = "); Serial.println(gz);
delay(500); // Menunggu setengah detik sebelum pembacaan
}