#include <MPU6050_tockn.h>
#include <Wire.h>

MPU6050 mpu(Wire);

void setup(void) {
  Serial.begin(115200);
  Wire.begin();
  mpu.begin();
  //kalibracija giroskopa
  mpu.calcGyroOffsets(true);

}


void loop() {
  mpu.update();
  //iszpis pospeška v [g]
  Serial.println("pospešek x: "); Serial.print(mpu.getAccX());
  Serial.println("pospešek y: "); Serial.print(mpu.getAccY());
  Serial.println("pospešek z: "); Serial.print(mpu.getAccZ());

  //izpis giroskopa []

    Serial.println("pozicija x: "); Serial.print(mpu.getGyroX());
    Serial.println("pozicija y: "); Serial.print(mpu.getGyroY());
    Serial.println("pozicija z: "); Serial.print(mpu.getGyroZ());
  delay(500);
}