#include <Arduino.h>
#include <Wire.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>

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

#define SCREEN_WIDTH 128
#define SCREEN_HEIGHT 64
#define OLED_RESET    -1
Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, OLED_RESET);

#include "DHTesp.h"
const int DHT_PIN = 4;
DHTesp dhtSensor;
Adafruit_MPU6050 mpu;


void setup() {
  Serial.begin(115200);
  
  pinMode(17, OUTPUT);
  pinMode(16, INPUT);

  dhtSensor.setup(DHT_PIN, DHTesp::DHT22);

  if(!display.begin(SSD1306_SWITCHCAPVCC, 0x3C)) {
    Serial.println(F("SSD1306 allocation failed"));
    for(;;);
  }

  display.display();
  delay(1000);
  display.clearDisplay();

  while (!mpu.begin()) {
    Serial.println("MPU6050 not connected!");
    delay(1000);
  }
  Serial.println("MPU6050 ready!");
}

void hcsr04() {
  long duration;
  int distance;

  digitalWrite(17, LOW);
  delay(2);
  digitalWrite(17, HIGH);
  delay(10);
  digitalWrite(17, LOW);

  duration = pulseIn(16, HIGH);

  distance = duration * 0.034 / 2;

  Serial.print("Distance: ");
  Serial.print(distance);
  Serial.println("cm");
  
  delay(2000);
}

void dht22() {
  if (Serial.available() > 0) {
    String command = Serial.readStringUntil('\n');
    if (command == "humi") {
      TempAndHumidity data = dhtSensor.getTempAndHumidity();
      Serial.println("Tempt " + String(data.temperature, 2) + "°C");
      Serial.println("Humidity " + String(data.humidity, 1) + "%");
    }
  }
}

void mpu6050() {
  sensors_event_t event;
  mpu.getAccelerometerSensor()->getEvent(&event);

  Serial.print("[");
  Serial.print(millis());
  Serial.print("] X: ");
  Serial.print(event.acceleration.x);
  Serial.print(", Y: ");
  Serial.print(event.acceleration.y);
  Serial.print(", Z: ");
  Serial.print(event.acceleration.z);
  Serial.println(" m/s^2");
  delay(500);
}

void loop() {
  hcsr04();
  dht22();
  mpu6050();
}