#include <Wire.h>
#include <MPU6050.h>
// #include <BluetoothSerial.h>

const int switchPin = 15; // Pin yang terhubung ke switch
bool isOn = false; // Status awal ESP32 (mati)


// BluetoothSerial SerialBT;
MPU6050 mpu;

void setup() {
  Wire.begin();
  pinMode(switchPin, INPUT_PULLUP); // Menggunakan internal pull-up resistor
  pinMode(15, OUTPUT);// Mengatur pin yang mengendalikan daya sebagai output
  Serial.begin(115200);
  // SerialBT.begin("ESP32_Node"); // Nama Bluetooth Node
}

void loop() {
  int switchState = digitalRead(switchPin);
  int16_t ax, ay, az;
  int16_t temp;

if (switchState == LOW && !isOn) {
    // Jika switch dinyalakan dan ESP32 belum menyala
    // Nyalakan ESP32
    digitalWrite(15, HIGH);
    isOn = true;
  } else if (switchState == LOW && isOn) {
    // Jika switch dinyalakan dan ESP32 sudah menyala
    // Matikan ESP32
    digitalWrite(15, LOW);
    isOn = false;
  }

  mpu.getAcceleration(&ax, &ay, &az);
  temp = mpu.getTemperature();
  float temperature = (temp / 340.00) + 36.53;

  Serial.print("Gyro X: "); Serial.print(ax);
  Serial.print(" Gyro Y: "); Serial.print(ay);
  Serial.print(" Gyro Z: "); Serial.println(az);
  Serial.print("Temperature: "); Serial.println(temperature);
  delay(1000);
}