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

// inicializacija MPU6050 senzorja
MPU6050 mpu(Wire);


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

void loop() {
  mpu.update();
  // izpis pospeška v [g]
  Serial.println("pospešek x: "); Serial.println(mpu.getAccX());
  Serial.println("pospešek y: "); Serial.println(mpu.getAccY());
  Serial.println("pospešek z: "); Serial.println(mpu.getAccZ());
  
  // izpis giroskopa [°]
    Serial.println("Pozicija x: "); Serial.println(mpu.getGyroX());
    Serial.println("Pozicija y: "); Serial.println(mpu.getGyroY());
    Serial.println("Pozicija z: "); Serial.println(mpu.getGyroZ());

  delay(500);
}