#include <Adafruit_MPU6050.h>
#include <Adafruit_Sensor.h>
#include <Wire.h>
#include <Arduino_GFX_Library.h>
unsigned long prevous_t=0, current_t, velocity;
#define TFT_SCK    18

#define TFT_MOSI   23

#define TFT_MISO   19

#define TFT_CS     22

#define TFT_DC     21

#define TFT_RESET  17

Adafruit_MPU6050 mpu;

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

  Arduino_ESP32SPI bus = Arduino_ESP32SPI(TFT_DC, TFT_CS, TFT_SCK, TFT_MOSI, TFT_MISO);

  Arduino_ILI9341 display = Arduino_ILI9341(&bus, TFT_RESET);

  display.begin();

  display.fillScreen(WHITE);

  display.setCursor(20, 20);

  display.setTextSize(2);

  display.setTextColor(BLUE);

  display.print("MPU Project");
  
  display.fillScreen(WHITE);
  while (!mpu.begin()) {
    Serial.println("MPU6050 not connected!");
    delay(1000);
  }
  Serial.println("MPU6050 ready!");
}

sensors_event_t event;

void loop() { 
  current_t=millis();
  mpu.getAccelerometerSensor()->getEvent(&event);
  Serial.print("[");
  Serial.print("] Z: ");
  Serial.print(event.acceleration.z);
  velocity=(event.acceleration.z)*(current_t - prevous_t)/1000;
   Serial.print(velocity);
  Serial.println(" m/s^2");
  delay(500);
  current_t = prevous_t;
}