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

print("Funcionando..")

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

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

#oled.fill(0)
#oled.text("IoT", 0, 2) #Linha 0 coluna 2, pois é uma matriz de pixels para mostrar no LED
#oled.show()

mpu = mpu6050.MPU6050(i2c)

# wake up the MPU6050 from sleep
mpu.wake()
gyro = ""
accel = ""
temperature = ""
# continuously print the data
while True:
    new_gyro = mpu.read_gyro_data()
    new_accel = mpu.read_accel_data()
    new_temp = mpu.read_temperature()
    if(new_gyro != gyro or new_accel != accel or new_temp != temperature):
      gyro = new_gyro
      accel = new_accel
      temperature = new_temp
      print("Gyro: " + str(gyro) + ", Accel: " + str(accel) + ", Temp: " + str(temperature))
      oled.fill(0)
      oled.text("Gyro", 0, 2)
      oled.text("-----------------", 0, 10)
      oled.text("x:"+ str(round(gyro[0],2)), 0, 15)
      oled.text("y:"+ str(round(gyro[1],2)), 0, 25)
      oled.text("z:"+ str(round(gyro[2],2)), 0, 35)
      oled.text("Accel", 70, 2)
      oled.text("x:"+ str(round(accel[0],2)), 70, 15)
      oled.text("y:"+ str(round(accel[1],2)), 70, 25)
      oled.text("z:"+ str(round(accel[2],2)), 70, 35)
      oled.text("-----------------", 0, 45)
      oled.text("Temp: " + str(round(temperature, 2)), 0, 55)
      oled.show()
    time.sleep(0.1)