from machine import Pin, I2C, sleep, PWM
import mpu6050
import time

i2c = I2C(scl = Pin(22), sda = Pin(21))
mpu = mpu6050.accel(i2c)

## Get values for first time
values = (mpu.get_values())

## Initial value for filtered Accelerometer signals
acx = values["AcX"] / 16384
acy = values["AcY"] / 16384
acz = values["AcZ"] / 16384

while True:
  values = (mpu.get_values())
  
  # Filter Acc Signals
  # Apply formula: Yn = ( Xn + Xn-1 ) / 2
  acx = (acx + (values["AcX"] / 16384)) / 2
  acy = (acy + (values["AcY"] / 16384)) / 2
  acz = (acz + (values["AcZ"] / 16384)) / 2

  print("{},{},{}".format(acx, acy, acz))
  time.sleep(0.5)