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


void setup() {
  Serial.begin(115200);
  //pinMode(5,OUTPUT);
  while (!mpu.begin()) {
    Serial.println("MPU6050 not connected!");
    delay(1000);
  }
}

void loop() {
  if (Serial.available() > 0) {
    String command = Serial.readStringUntil('\n');
    if (command == "beweg2") {
      sensor_MPU6050();
    }
  }
  delay(1000);
}

void sensor_MPU6050() {
sensors_event_t acc, gcc, temp;
mpu.getEvent(&acc, &gcc, &temp);
Serial.println("Beschleunigung auf x Achse");
Serial.println(acc.acceleration.x);

Serial.println("Beschleunigung auf y Achse");
Serial.println(acc.acceleration.y);

Serial.println("Beschleunigung auf z Achse");
Serial.println(acc.acceleration.z);

Serial.println("Rotation der x Achse: ");
Serial.println((gcc.gyro.x)*180/3.14);

Serial.println("Rotation der y Achse: ");
Serial.println((gcc.gyro.y)*180/3.14);

Serial.println("Rotation der z Achse: ");
Serial.println((gcc.gyro.z)*180/3.14);

}