from machine import Pin, I2C
import ssd1306
import mpu6050
import time

#I2C
i2c=I2C(0,scl=Pin(22),sda=Pin(21))

#MPU6050
mpu=mpu6050.MPU6050(i2c)

#SSD1306 with I2C
oled_width = 128
oled_height = 64
oled = ssd1306.SSD1306_I2C(oled_width,oled_height,i2c)

#wake up the mpu6050 from sleep
mpu.wake()
gyro = ""
accel = ""

while True:
    new_gyro = mpu.read_gyro_data()
    new_accel = mpu.read_accel_data()

    if(new_gyro!= gyro or new_accel!=accel):
        gyro=new_gyro
        accel=new_accel
        print("Gyro: " + str(gyro) +",Accel: " + str (accel))
        oled.fill(0)
        oled.text("Gyro",0,2)
        oled.text("-----------------------",0,10)
        oled.text("x: "+str(round(gyro[0],2)),0,15)
        oled.text("Accel",70,2)
        oled.text("y: " + str(round(accel[0],2)),70,15)
        oled.show()
    time.sleep(0.1)