#####################################
###### IMPORT LIBRARIES
import machine
from utime import sleep

from lcd_api import LcdApi
from i2c_lcd import I2cLcd

import mpu6050

#####################################
###### PIN CONFIGURATIONS

# Configure the pin as output
# Replace the x with SDA Pin x number here
sda=machine.Pin(21)

# Replace the y with SCL Pin y number here
scl=machine.Pin(22)

# i2c configuration
i2c = machine.SoftI2C(sda=sda, scl=scl, freq=10000)

# use i2c with devices
lcd = I2cLcd(i2c, 0x27, 2, 16)
mpu = mpu6050.MPU6050(i2c)
	
#####################################
###### MAIN ROUTINE

def main():
	
  while True:
    # subroutine here
    sensor_data = mpu_i2c()
    lcd_i2c(sensor_data)

#####################################
###### SUBROUTINE FOR RGB LED

def mpu_i2c():

  accel_data = mpu.read_accel_data()
  temp_data = mpu.read_temperature()

  print("acceleration_x: ", accel_data[0])
  print("acceleration_y: ", accel_data[1])
  print("acceleration_z: ", accel_data[2])
  print("temperature: ", temp_data)

  return accel_data, temp_data

def lcd_i2c(sensor_data):

  accel_data = sensor_data[0]
  temp_data = sensor_data[1]

  # select coordinate (column no. , row no.)
  lcd.move_to(0,0)
  display_text = "x:" + str("{:.2f}".format(accel_data[0]))
  lcd.putstr(display_text)

  # select coordinate (column no. , row no.)
  lcd.move_to(8,0)
  display_text = "y:" + str("{:.2f}".format(accel_data[1]))
  lcd.putstr(display_text)

  # select coordinate (column no. , row no.)
  lcd.move_to(0,1)
  display_text = "z:" + str("{:.2f}".format(accel_data[2]))
  lcd.putstr(display_text)

  # select coordinate (column no. , row no.)
  lcd.move_to(8,1)
  display_text = "t:" + str("{:.1f}".format(temp_data))
  lcd.putstr(display_text)

#####################################
###### EXECUTE MAIN ROUTINE

if __name__ == '__main__':
  main()