Adolfo Reyna
442 lines
17 KiB
Python
442 lines
17 KiB
Python
import time
|
|
from machine import Pin, SPI
|
|
import framebuf
|
|
import micropython
|
|
import struct
|
|
|
|
class ILI9341:
|
|
def __init__(self, spi, cs, dc, rst=None, bl=None, width=320, height=240, invert_color=True):
|
|
self.spi = spi
|
|
self.cs = cs
|
|
self.dc = dc
|
|
self.rst = rst
|
|
self.bl = bl
|
|
self.width = width
|
|
self.height = height
|
|
self.invert_color = invert_color
|
|
|
|
# 1. 1-bit Canvas Buffer (Standard MONO_HLSB for drawing)
|
|
self.hw_len = (self.width * self.height) // 8
|
|
self.canvas_buffer = bytearray(self.hw_len)
|
|
self.canvas = framebuf.FrameBuffer(self.canvas_buffer, self.width, self.height, framebuf.MONO_HLSB)
|
|
|
|
# Pre-allocate chunk buffer for conversion (16 rows: 320 * 16 * 2 = 10240 bytes)
|
|
self.chunk_rows = 16
|
|
self.row_buffer = bytearray(self.width * self.chunk_rows * 2)
|
|
|
|
# Initialize pins
|
|
self.cs.init(self.cs.OUT, value=1)
|
|
self.dc.init(self.dc.OUT, value=0)
|
|
|
|
if self.rst is not None:
|
|
self.rst.init(self.rst.OUT, value=1)
|
|
|
|
if self.bl is not None:
|
|
self.bl.init(self.bl.OUT, value=1)
|
|
|
|
self.reset()
|
|
self.init_display()
|
|
self.clear(0)
|
|
self.show()
|
|
|
|
# --- DRAWING WRAPPERS ---
|
|
def pixel(self, x, y, c): self.canvas.pixel(x, y, c)
|
|
def line(self, x1, y1, x2, y2, c): self.canvas.line(x1, y1, x2, y2, c)
|
|
def rect(self, x, y, w, h, c): self.canvas.rect(x, y, w, h, c)
|
|
def fill_rect(self, x, y, w, h, c): self.canvas.fill_rect(x, y, w, h, c)
|
|
def text(self, msg, x, y, c=1): self.canvas.text(msg, x, y, c)
|
|
def clear(self, c=0): self.canvas.fill(c)
|
|
|
|
# --- SCALABLE TEXT ---
|
|
def text_large(self, msg, x, y, scale=2, c=1):
|
|
char_w = 8; char_h = 8
|
|
tmp_buf = bytearray(char_w * char_h // 8)
|
|
tmp_fb = framebuf.FrameBuffer(tmp_buf, char_w, char_h, framebuf.MONO_HLSB)
|
|
for char in msg:
|
|
tmp_fb.fill(0); tmp_fb.text(char, 0, 0, 1)
|
|
for py in range(8):
|
|
for px in range(8):
|
|
if tmp_fb.pixel(px, py):
|
|
self.canvas.fill_rect(x + (px * scale), y + (py * scale), scale, scale, c)
|
|
x += (8 * scale)
|
|
|
|
# --- RAW BITMAPS (1:1 scale) ---
|
|
def bitmap(self, x, y, w, h, pixel_data):
|
|
img = framebuf.FrameBuffer(pixel_data, w, h, framebuf.MONO_HLSB)
|
|
self.canvas.blit(img, x, y)
|
|
|
|
# --- PBM FILE LOADER WITH SCALING ---
|
|
def draw_pbm(self, filename, x, y, scale=1):
|
|
try:
|
|
with open(filename, 'rb') as f:
|
|
line1 = f.readline()
|
|
if not line1.startswith(b'P4'): print("Err: Not P4 PBM"); return
|
|
while True:
|
|
line = f.readline()
|
|
if not line.startswith(b'#'): break
|
|
dims = line.split(); w = int(dims[0]); h = int(dims[1])
|
|
data = bytearray(f.read())
|
|
|
|
src_fb = framebuf.FrameBuffer(data, w, h, framebuf.MONO_HLSB)
|
|
|
|
if scale == 1:
|
|
self.canvas.blit(src_fb, x, y)
|
|
else:
|
|
for sy in range(h):
|
|
for sx in range(w):
|
|
if src_fb.pixel(sx, sy):
|
|
self.canvas.fill_rect(x + (sx * scale), y + (sy * scale), scale, scale, 1)
|
|
print(f"Loaded {filename} (scale {scale})")
|
|
except OSError:
|
|
print(f"Error: Could not open {filename}")
|
|
|
|
@micropython.native
|
|
def _convert_bgr24_to_rgb565(self, bgr_buf, rgb565_buf, width, src_offset, num_pixels):
|
|
idx = 0
|
|
for i in range(src_offset, src_offset + num_pixels):
|
|
b = bgr_buf[i * 3]
|
|
g = bgr_buf[i * 3 + 1]
|
|
r = bgr_buf[i * 3 + 2]
|
|
r_5 = r >> 3
|
|
g_6 = g >> 2
|
|
b_5 = b >> 3
|
|
rgb565_buf[idx] = (r_5 << 3) | (g_6 >> 3)
|
|
rgb565_buf[idx + 1] = ((g_6 & 0x07) << 5) | b_5
|
|
idx += 2
|
|
|
|
@micropython.native
|
|
def _convert_bgra32_to_rgb565(self, bgra_buf, rgb565_buf, width, src_offset, num_pixels):
|
|
idx = 0
|
|
for i in range(src_offset, src_offset + num_pixels):
|
|
b = bgra_buf[i * 4]
|
|
g = bgra_buf[i * 4 + 1]
|
|
r = bgra_buf[i * 4 + 2]
|
|
r_5 = r >> 3
|
|
g_6 = g >> 2
|
|
b_5 = b >> 3
|
|
rgb565_buf[idx] = (r_5 << 3) | (g_6 >> 3)
|
|
rgb565_buf[idx + 1] = ((g_6 & 0x07) << 5) | b_5
|
|
idx += 2
|
|
|
|
def draw_bmp(self, filename, x=0, y=0):
|
|
"""Draw a 24-bit or 32-bit uncompressed color BMP image at (x, y) coordinates."""
|
|
try:
|
|
with open(filename, 'rb') as f:
|
|
header = f.read(54)
|
|
if len(header) < 54 or header[0:2] != b'BM':
|
|
print("Err: Not a valid BMP file")
|
|
return False
|
|
|
|
pixel_offset = struct.unpack('<I', header[10:14])[0]
|
|
width, height = struct.unpack('<ii', header[18:26])
|
|
planes, bpp = struct.unpack('<HH', header[26:30])
|
|
compression = struct.unpack('<I', header[30:34])[0]
|
|
|
|
if bpp not in (24, 32):
|
|
print("Err: Only 24-bit and 32-bit BMP formats supported")
|
|
return False
|
|
|
|
if compression != 0:
|
|
print("Err: Only uncompressed BMP supported")
|
|
return False
|
|
|
|
f.seek(pixel_offset)
|
|
bottom_up = True
|
|
if height < 0:
|
|
height = -height
|
|
bottom_up = False
|
|
|
|
row_bytes = (width * bpp) // 8
|
|
row_padded = ((width * bpp + 31) // 32) * 4
|
|
|
|
read_buf = bytearray(row_padded)
|
|
rgb565_buf = bytearray(width * 2)
|
|
|
|
for row_idx in range(height):
|
|
n = f.readinto(read_buf)
|
|
if n < row_padded:
|
|
break
|
|
|
|
screen_y = y + (height - 1 - row_idx) if bottom_up else y + row_idx
|
|
if screen_y < 0 or screen_y >= self.height:
|
|
continue
|
|
|
|
x_start = x
|
|
x_end = x + width - 1
|
|
|
|
if x_start >= self.width or x_end < 0:
|
|
continue
|
|
|
|
win_x0 = max(0, x_start)
|
|
win_x1 = min(self.width - 1, x_end)
|
|
|
|
if win_x1 < win_x0:
|
|
continue
|
|
|
|
src_offset_pixels = win_x0 - x_start
|
|
win_w = win_x1 - win_x0 + 1
|
|
|
|
# Convert pixel data to RGB565 row buffer
|
|
if bpp == 24:
|
|
self._convert_bgr24_to_rgb565(read_buf, rgb565_buf, width, src_offset_pixels, win_w)
|
|
elif bpp == 32:
|
|
self._convert_bgra32_to_rgb565(read_buf, rgb565_buf, width, src_offset_pixels, win_w)
|
|
|
|
# Draw directly to the screen via SPI window
|
|
self.set_window(win_x0, screen_y, win_x1, screen_y)
|
|
self.dc(1)
|
|
self.cs(0)
|
|
self.spi.write(memoryview(rgb565_buf)[:win_w * 2])
|
|
self.cs(1)
|
|
|
|
# Also update internal 1-bit canvas buffer for screenshots/refresh consistency
|
|
for px in range(win_w):
|
|
screen_x = win_x0 + px
|
|
src_px = src_offset_pixels + px
|
|
if bpp == 24:
|
|
b = read_buf[src_px * 3]
|
|
g = read_buf[src_px * 3 + 1]
|
|
r = read_buf[src_px * 3 + 2]
|
|
else:
|
|
b = read_buf[src_px * 4]
|
|
g = read_buf[src_px * 4 + 1]
|
|
r = read_buf[src_px * 4 + 2]
|
|
# 0 = Black, 1 = White in conversion for MONO_HLSB canvas
|
|
lum = (r * 299 + g * 587 + b * 114) // 1000
|
|
mono_c = 1 if lum >= 128 else 0
|
|
self.canvas.pixel(screen_x, screen_y, mono_c)
|
|
|
|
return True
|
|
except Exception as e:
|
|
print("Error drawing BMP:", e)
|
|
return False
|
|
|
|
@micropython.native
|
|
def _update_mono_canvas_rgb565(self, x, y, w, h, data):
|
|
for cy in range(h):
|
|
screen_y = y + cy
|
|
if screen_y < 0 or screen_y >= self.height:
|
|
continue
|
|
for cx in range(w):
|
|
screen_x = x + cx
|
|
if screen_x < 0 or screen_x >= self.width:
|
|
continue
|
|
idx = (cy * w + cx) * 2
|
|
h_byte = data[idx]
|
|
l_byte = data[idx + 1]
|
|
# Extract RGB from RGB565
|
|
r = (h_byte & 0xF8)
|
|
g = ((h_byte & 0x07) << 5) | ((l_byte & 0xE0) >> 3)
|
|
b = (l_byte & 0x1F) << 3
|
|
# Convert to luminance
|
|
lum = (r * 299 + g * 587 + b * 114) // 1000
|
|
mono = 1 if lum >= 128 else 0
|
|
self.canvas.pixel(screen_x, screen_y, mono)
|
|
|
|
def draw_rgb565(self, x, y, w, h, data, sync_canvas=True):
|
|
"""Draw raw RGB565 pixel data on the screen at specified (x,y) with width and height."""
|
|
# Clip coordinates
|
|
x_start = max(0, x)
|
|
x_end = min(self.width - 1, x + w - 1)
|
|
y_start = max(0, y)
|
|
y_end = min(self.height - 1, y + h - 1)
|
|
|
|
if x_start > x_end or y_start > y_end:
|
|
return True
|
|
|
|
# Fast path: if completely visible on screen, draw in one go
|
|
if x_start == x and x_end == x + w - 1 and y_start == y and y_end == y + h - 1:
|
|
self.set_window(x_start, y_start, x_end, y_end)
|
|
self.dc(1)
|
|
self.cs(0)
|
|
self.spi.write(data)
|
|
self.cs(1)
|
|
else:
|
|
# Slow path: row-by-row clipping
|
|
for cy in range(y_start, y_end + 1):
|
|
src_y = cy - y
|
|
src_row_offset = (src_y * w + (x_start - x)) * 2
|
|
row_len_bytes = (x_end - x_start + 1) * 2
|
|
|
|
self.set_window(x_start, cy, x_end, cy)
|
|
self.dc(1)
|
|
self.cs(0)
|
|
self.spi.write(memoryview(data)[src_row_offset : src_row_offset + row_len_bytes])
|
|
self.cs(1)
|
|
|
|
# Sync the internal 1-bit canvas buffer
|
|
if sync_canvas:
|
|
self._update_mono_canvas_rgb565(x, y, w, h, data)
|
|
return True
|
|
|
|
# --- SCREENSHOT ---
|
|
def save_screenshot(self, filename):
|
|
print(f"Saving screenshot to {filename}...")
|
|
try:
|
|
with open(filename, 'wb') as f:
|
|
f.write(b'P4\n')
|
|
f.write(f"{self.width} {self.height}\n".encode())
|
|
f.write(self.canvas_buffer)
|
|
print("Saved!")
|
|
except Exception as e:
|
|
print(f"Error saving screenshot: {e}")
|
|
|
|
# --- HARDWARE LOGIC ---
|
|
def reset(self):
|
|
if self.rst is not None:
|
|
self.rst(1); time.sleep_ms(5); self.rst(0); time.sleep_ms(15); self.rst(1); time.sleep_ms(15)
|
|
|
|
def write_cmd(self, cmd):
|
|
self.dc(0); self.cs(0); self.spi.write(bytearray([cmd])); self.cs(1)
|
|
|
|
def write_data(self, data):
|
|
self.dc(1); self.cs(0)
|
|
if isinstance(data, int): self.spi.write(bytearray([data]))
|
|
elif isinstance(data, list): self.spi.write(bytearray(data))
|
|
else: self.spi.write(data)
|
|
self.cs(1)
|
|
|
|
def init_display(self):
|
|
# ILI9341 Initialization Sequence
|
|
self.write_cmd(0x01) # SWRESET
|
|
time.sleep_ms(150)
|
|
|
|
self.write_cmd(0xCF); self.write_data(b"\x00\xC1\x30")
|
|
self.write_cmd(0xED); self.write_data(b"\x64\x03\x12\x81")
|
|
self.write_cmd(0xE8); self.write_data(b"\x85\x00\x78")
|
|
self.write_cmd(0xCB); self.write_data(b"\x39\x2C\x00\x34\x02")
|
|
self.write_cmd(0xF7); self.write_data(b"\x20")
|
|
self.write_cmd(0xEA); self.write_data(b"\x00\x00")
|
|
|
|
self.write_cmd(0xC0); self.write_data(b"\x13") # Power Control 1
|
|
self.write_cmd(0xC1); self.write_data(b"\x13") # Power Control 2
|
|
self.write_cmd(0xC5); self.write_data(b"\x22\x35") # VCOM Control 1
|
|
self.write_cmd(0xC7); self.write_data(b"\xBD") # VCOM Control 2
|
|
|
|
# Memory Access Control (MADCTL) = 0x68 (Landscape: MV=1, MX=1, MY=0, BGR color filter)
|
|
self.write_cmd(0x36); self.write_data(b"\x68")
|
|
|
|
self.write_cmd(0xB6); self.write_data(b"\x0A\xA2") # Display Function Control
|
|
self.write_cmd(0x3A); self.write_data(b"\x55") # Pixel Format (COLMOD) = 16-bit RGB565
|
|
self.write_cmd(0xF6); self.write_data(b"\x01\x30")
|
|
self.write_cmd(0xB1); self.write_data(b"\x00\x1B") # Frame Rate Control
|
|
self.write_cmd(0xF2); self.write_data(b"\x00")
|
|
self.write_cmd(0x26); self.write_data(b"\x01") # Gamma Curve
|
|
|
|
self.write_cmd(0xE0); self.write_data(b"\x0F\x35\x31\x0B\x0E\x06\x49\xA7\x33\x07\x0F\x03\x0C\x0A\x00") # Positive Gamma Correction
|
|
self.write_cmd(0xE1); self.write_data(b"\x00\x0A\x0F\x04\x11\x08\x36\x58\x4D\x07\x10\x0C\x32\x34\x0F") # Negative Gamma Correction
|
|
|
|
if self.invert_color:
|
|
self.write_cmd(0x21) # INVON
|
|
else:
|
|
self.write_cmd(0x20) # INVOFF
|
|
|
|
self.write_cmd(0x11) # SLPOUT (Exit sleep mode)
|
|
time.sleep_ms(120)
|
|
self.write_cmd(0x29) # DISPON (Display on)
|
|
time.sleep_ms(10)
|
|
|
|
def invert(self, enable):
|
|
if enable:
|
|
self.write_cmd(0x21) # INVON
|
|
else:
|
|
self.write_cmd(0x20) # INVOFF
|
|
|
|
def set_window(self, x0, y0, x1, y1):
|
|
# Column Address Set (CASET)
|
|
self.write_cmd(0x2A)
|
|
self.write_data(bytearray([x0 >> 8, x0 & 0xFF, x1 >> 8, x1 & 0xFF]))
|
|
|
|
# Row Address Set (RASET)
|
|
self.write_cmd(0x2B)
|
|
self.write_data(bytearray([y0 >> 8, y0 & 0xFF, y1 >> 8, y1 & 0xFF]))
|
|
|
|
# Memory Write (RAMWR)
|
|
self.write_cmd(0x2C)
|
|
|
|
@micropython.native
|
|
def _convert_rows(self, start_row, num_rows, row_buf):
|
|
"""Converts 1-bit monochrome row segment to 16-bit RGB565 format.
|
|
Compiles block-wise bitwise operations at native speed.
|
|
"""
|
|
width = self.width
|
|
canvas_buf = self.canvas_buffer
|
|
idx = 0
|
|
|
|
for y in range(start_row, start_row + num_rows):
|
|
byte_offset = y * (width // 8)
|
|
for x_byte_idx in range(width // 8):
|
|
val = canvas_buf[byte_offset + x_byte_idx]
|
|
|
|
# Unroll 8 bits for speed
|
|
# Bit 7
|
|
if val & 0x80:
|
|
row_buf[idx] = 0xFF; row_buf[idx+1] = 0xFF
|
|
else:
|
|
row_buf[idx] = 0x00; row_buf[idx+1] = 0x00
|
|
idx += 2
|
|
|
|
# Bit 6
|
|
if val & 0x40:
|
|
row_buf[idx] = 0xFF; row_buf[idx+1] = 0xFF
|
|
else:
|
|
row_buf[idx] = 0x00; row_buf[idx+1] = 0x00
|
|
idx += 2
|
|
|
|
# Bit 5
|
|
if val & 0x20:
|
|
row_buf[idx] = 0xFF; row_buf[idx+1] = 0xFF
|
|
else:
|
|
row_buf[idx] = 0x00; row_buf[idx+1] = 0x00
|
|
idx += 2
|
|
|
|
# Bit 4
|
|
if val & 0x10:
|
|
row_buf[idx] = 0xFF; row_buf[idx+1] = 0xFF
|
|
else:
|
|
row_buf[idx] = 0x00; row_buf[idx+1] = 0x00
|
|
idx += 2
|
|
|
|
# Bit 3
|
|
if val & 0x08:
|
|
row_buf[idx] = 0xFF; row_buf[idx+1] = 0xFF
|
|
else:
|
|
row_buf[idx] = 0x00; row_buf[idx+1] = 0x00
|
|
idx += 2
|
|
|
|
# Bit 2
|
|
if val & 0x04:
|
|
row_buf[idx] = 0xFF; row_buf[idx+1] = 0xFF
|
|
else:
|
|
row_buf[idx] = 0x00; row_buf[idx+1] = 0x00
|
|
idx += 2
|
|
|
|
# Bit 1
|
|
if val & 0x02:
|
|
row_buf[idx] = 0xFF; row_buf[idx+1] = 0xFF
|
|
else:
|
|
row_buf[idx] = 0x00; row_buf[idx+1] = 0x00
|
|
idx += 2
|
|
|
|
# Bit 0
|
|
if val & 0x01:
|
|
row_buf[idx] = 0xFF; row_buf[idx+1] = 0xFF
|
|
else:
|
|
row_buf[idx] = 0x00; row_buf[idx+1] = 0x00
|
|
idx += 2
|
|
|
|
def show(self):
|
|
"""Refreshes the screen by writing the frame buffer segment-by-segment."""
|
|
self.set_window(0, 0, self.width - 1, self.height - 1)
|
|
|
|
self.dc(1)
|
|
self.cs(0)
|
|
|
|
num_chunks = self.height // self.chunk_rows
|
|
for chunk in range(num_chunks):
|
|
start_row = chunk * self.chunk_rows
|
|
self._convert_rows(start_row, self.chunk_rows, self.row_buffer)
|
|
self.spi.write(self.row_buffer)
|
|
|
|
self.cs(1)
|