1
0
Fork 0
wasp-os/wasp/boards/simulator/display.py
Daniel Thompson 7b3e0f917d boards: simulator: Add swipe detection and button support
Currently the simulator relies on the keyboard to issue touchscreen
gestures and button presses. Fix this by adding swipe detection and
introducing a skin which gives us the capability to press the button
using touchscreens or pointer devices.

Signed-off-by: Daniel Thompson <daniel@redfelineninja.org.uk>
2020-06-27 12:22:23 +01:00

210 lines
6.4 KiB
Python

# SPDX-License-Identifier: LGPL-3.0-or-later
# Copyright (C) 2020 Daniel Thompson
""" Simulated ST7789 display and CST816S touchscreen. """
import sys
import sdl2
import sdl2.ext
CASET = 0x2a
RASET = 0x2b
RAMWR = 0x2c
WIDTH = 240
HEIGHT = 240
SKIN = {
'fname' : 'res/simulator_skin.png',
'size' : (337, 427),
'button_profile' : 9,
'offset' : (53, 93)
}
class ST7789Sim(object):
def __init__(self):
self.x = 0
self.y = 0
self.colclip = [0, WIDTH-1]
self.rowclip = [0, HEIGHT-1]
self.cmd = 0
def write(self, data):
if len(data) == 1:
# Assume if we get a byte at a time then it is command.
# This is a simplification do we don't have to track
# the D/C pin from within the simulator.
self.cmd = data[0]
elif self.cmd == CASET:
self.colclip[0] = (data[0] << 8) + data[1]
self.colclip[1] = (data[2] << 8) + data[3]
self.x = self.colclip[0]
elif self.cmd == RASET:
self.rowclip[0] = (data[0] << 8) + data[1]
self.rowclip[1] = (data[2] << 8) + data[3]
self.y = self.rowclip[0]
elif self.cmd == RAMWR:
#pixelview = sdl2.ext.PixelView(windowsurface)
pixelview = sdl2.ext.pixels2d(windowsurface)
half = False
for d in data:
if not half:
rgb = d << 8
half = True
continue
rgb |= d
half = False
#pixel = ((rgb & 0xf800) >> 8,
# (rgb & 0x07e0) >> 3,
# (rgb & 0x001f) << 3)
pixel = (((rgb & 0xf800) << 8) +
((rgb & 0x07e0) << 5) +
((rgb & 0x001f) << 3))
pv_x = self.x + SKIN['adjust'][0]
pv_y = self.y + SKIN['adjust'][1]
pixelview[pv_x][pv_y] = pixel
self.x += 1
if self.x > self.colclip[1]:
self.x = self.colclip[0]
self.y += 1
if self.y > self.rowclip[1]:
self.y = self.rowclip[0]
# Forcibly release the surface to ensure it is unlocked
del pixelview
window.refresh()
class CST816SSim():
def __init__(self):
self.regs = bytearray(64)
def readfrom_mem_into(self, addr, reg, dbuf, pins):
tick(pins)
if not self.regs[1]:
raise OSError
dbuf[:] = self.regs[reg:len(dbuf)+reg]
if self.regs[3]:
self.regs[3] = 0
else:
self.regs[1] = 0
def writeto_mem(self, addr, reg, buf, pins):
tick(pins)
if reg == 0xa5:
# This will be a sleep command... which we can ignore
return
raise OSError
def handle_key(self, key, pins):
"""Use key presses to provoke different touchscreen events.
Note: The Down key provokes an upward swipe and vice versa.
Same for left and right. That is because the swipe up
gesture means show me the screen the is below me (hence
the controls are inverted compared to joystick-like
direction control).
"""
if key.keysym.sym == sdl2.SDLK_DOWN:
self.regs[1] = 2
elif key.keysym.sym == sdl2.SDLK_UP:
self.regs[1] = 1
elif key.keysym.sym == sdl2.SDLK_LEFT:
self.regs[1] = 4
elif key.keysym.sym == sdl2.SDLK_RIGHT:
self.regs[1] = 3
self.regs[3] = 0x80
self.raise_interrupt(pins)
def handle_mousebuttondown(self, button, pins):
self.down_x = button.x
self.down_y = button.y
if self.down_x < 50:
pins['BUTTON'].value(0)
def handle_mousebuttonup(self, button, pins):
if self.down_x < 50:
pins['BUTTON'].value(1)
return
down_x = max(0, min(239, self.down_x-SKIN['adjust'][0]))
down_y = max(0, min(239, self.down_y-SKIN['adjust'][1]))
up_x = max(0, min(239, button.x-SKIN['adjust'][0]))
up_y = max(0, min(239, button.y-SKIN['adjust'][1]))
mv_x = up_x - down_x
mv_y = up_y - down_y
# Swipe detection
if abs(mv_x) + abs(mv_y) < 24:
self.regs[1] = 5
elif abs(mv_x) > abs(mv_y):
self.regs[1] = 4 if mv_x > 0 else 3
else:
self.regs[1] = 2 if mv_y > 0 else 1
self.regs[4] = up_x;
self.regs[6] = up_y;
self.raise_interrupt(pins)
def raise_interrupt(self, pins):
pins['TP_INT'].raise_irq()
# Derive some extra values for padding the display
SKIN['left_pad'] = 9
SKIN['right_pad'] = SKIN['left_pad'] + SKIN['button_profile']
SKIN['top_pad'] = 3
SKIN['bottom_pad'] = 3
SKIN['window'] = (SKIN['size'][0] + SKIN['left_pad'] + SKIN['right_pad'],
SKIN['size'][1] + SKIN['top_pad'] + SKIN['bottom_pad'])
SKIN['adjust'] = (SKIN['offset'][0] + SKIN['left_pad'],
SKIN['offset'][1] + SKIN['top_pad'])
sdl2.ext.init()
window = sdl2.ext.Window("ST7789", size=SKIN['window'])
window.show()
windowsurface = window.get_surface()
sdl2.ext.fill(windowsurface, (0xff, 0xff, 0xff))
skin = sdl2.ext.load_image(SKIN['fname'])
sdl2.SDL_BlitSurface(skin, None, windowsurface, sdl2.SDL_Rect(
SKIN['left_pad'], SKIN['top_pad'], SKIN['size'][0], SKIN['size'][1]))
sdl2.SDL_FreeSurface(skin)
window.refresh()
spi_st7789_sim = ST7789Sim()
i2c_cst816s_sim = CST816SSim()
def tick(pins):
events = sdl2.ext.get_events()
for event in events:
if event.type == sdl2.SDL_QUIT:
sdl2.ext.quit()
sys.exit(0)
elif event.type == sdl2.SDL_MOUSEBUTTONDOWN:
i2c_cst816s_sim.handle_mousebuttondown(event.button, pins)
elif event.type == sdl2.SDL_MOUSEBUTTONUP:
i2c_cst816s_sim.handle_mousebuttonup(event.button, pins)
elif event.type == sdl2.SDL_KEYDOWN:
if event.key.keysym.sym == sdl2.SDLK_TAB:
pins['BUTTON'].value(0)
else:
i2c_cst816s_sim.handle_key(event.key, pins)
elif event.type == sdl2.SDL_KEYUP:
if event.key.keysym.sym == sdl2.SDLK_TAB:
pins['BUTTON'].value(1)
else:
#print(event)
pass
window.refresh()