# Display Image & text on I2C driven ssd1306 OLED display 
from machine import Pin, I2C
from ssd1306 import SSD1306_I2C
import framebuf

import utime
utime.sleep(0.25)

WIDTH  = 128                                            # oled display width
HEIGHT = 32                                             # oled display height

i2c = I2C(0)                                            # Init I2C using I2C0 defaults, SCL=Pin(GP9), SDA=Pin(GP8), freq=400000
#i2c = I2C(0, scl=Pin(5), sda=Pin(4), freq=50000)

#print("I2C Address      : "+hex(i2c.scan()[0]).upper()) # Display device address
print("I2C Configuration: "+str(i2c))                   # Display I2C config

gpio23 = Pin(23,Pin.OUT)
gpio23.high()

oled = SSD1306_I2C(WIDTH, HEIGHT, i2c)                  # Init oled display

# Raspberry Pi logo as 32x32 bytearray
buffer = bytearray(b"\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00|?\x00\x01\x86@\x80\x01\x01\x80\x80\x01\x11\x88\x80\x01\x05\xa0\x80\x00\x83\xc1\x00\x00C\xe3\x00\x00~\xfc\x00\x00L'\x00\x00\x9c\x11\x00\x00\xbf\xfd\x00\x00\xe1\x87\x00\x01\xc1\x83\x80\x02A\x82@\x02A\x82@\x02\xc1\xc2@\x02\xf6>\xc0\x01\xfc=\x80\x01\x18\x18\x80\x01\x88\x10\x80\x00\x8c!\x00\x00\x87\xf1\x00\x00\x7f\xf6\x00\x008\x1c\x00\x00\x0c \x00\x00\x03\xc0\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00")

# Load the raspberry pi logo into the framebuffer (the image is 32x32)
fb = framebuf.FrameBuffer(buffer, 32, 32, framebuf.MONO_HLSB)

while True:

    # Clear the oled display in case it has junk on it.
    oled.fill(0)

    # Blit the image from the framebuffer to the oled display
    oled.blit(fb, 96, 0)

    # Add some text
    oled.text("Intercooler",0,0)
    #oled.text("Pico",5,15)
    #oled.text(hex(i2c.scan()[0]).upper(),0,10)

    sensor_temp = machine.ADC(0) #26
    conversion_factor = 3.3 / (65535)

    reading = sensor_temp.read_u16() * conversion_factor
    
    # The temperature sensor measures the Vbe voltage of a biased bipolar diode, connected to the fifth ADC channel
    # Typically, Vbe = 0.706V at 27 degrees C, with a slope of -1.721mV (0.001721) per degree. 
    temperature = reading #27 - (reading - 0.706)/0.001721
    oled.text(str(temperature)+" V",0,12)
 


    sensor_pressure = machine.ADC(1)
    conversion_factor = 3.3 / (65535)

    reading = sensor_pressure.read_u16() * conversion_factor
    
    # The pressure sensor. black/yellow = blue = adc1
    pressure = reading / 4.65 * 2.5 # 3.069 = 4.65/5 * 3.3
    if((pressure<1.0) | (pressure>1.6)):
        oled.text(str(pressure)+" BAR",0,22)
    else:
        oled.fill_rect(0,22,int((pressure-1.0)*128.0/0.6),8,1)
    oled.show()
    utime.sleep(0.25)


# Finally update the oled display so the image & text is displayed
oled.show()