from machine import Pin,I2C
import ssd1306
import mpu6050
import time
pb = Pin(12,Pin.IN)
i2c =I2C(scl=Pin(22),sda=Pin(21),freq=400000)

mpu = mpu6050.MPU6050(i2c)

oled_width =128
oled_height=64
oled=ssd1306.SSD1306_I2C(oled_width,oled_height,i2c)

mpu.wake()

def gyro(pin):
    gyro=""
    accel=""
    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("x:"+str(round(accel[0],2)),70,15)
        oled.show()

pb.irq(trigger=Pin.IRQ_RISING,handler=gyro)

while True:
  time.sleep(0.1)