############################
##### 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 number here
sda = machine.Pin(21)

# Replace the y with SCL Pin 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)

############################
##### SUBROUTINES ##########
############################

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(4, 1)
    display_text = "t: " + str("{:.1f}".format(temp_data))
    lcd.putstr(display_text)

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

if __name__ == "__main__":
    main()