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

Adafruit_MPU6050 mpu;

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

  while (!mpu.begin()) {
    Serial.println("MPU6050 not connected!");
    delay(1000);
  }
  Serial.println("MPU6050 ready!");
  pinMode(13, OUTPUT);
  pinMode(12, OUTPUT);
  pinMode(11, OUTPUT);
}

sensors_event_t event;

void loop() {
  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);
  
  if(event.acceleration.x > event.acceleration.y && event.acceleration.x>event.acceleration.z) digitalWrite(13, HIGH);
  else {
    digitalWrite(13, LOW);
  }
  if(event.acceleration.y > event.acceleration.x && event.acceleration.y>event.acceleration.z) digitalWrite(12, HIGH);
  else{
    digitalWrite(12, LOW);
  }
  if(event.acceleration.z > event.acceleration.x && event.acceleration.z>event.acceleration.y) digitalWrite(11, HIGH);
  else{
    digitalWrite(11, LOW);
  }
  
}