Add project to check allignment of LEDs
parent
c425f132bd
commit
423d9f66b3
|
@ -0,0 +1,46 @@
|
|||
add_library('net')
|
||||
from network import send_TCP
|
||||
from prepare import prepare
|
||||
|
||||
# Config, will be checked upstream
|
||||
height = 25
|
||||
width = 15
|
||||
framerate = 10
|
||||
brightness = 0.4
|
||||
#####################################
|
||||
#receiver_IP = "10.2.113.151"
|
||||
receiver_IP = "10.24.146.53"
|
||||
#receiver_IP = "127.0.0.1"
|
||||
receiver_port = 9999
|
||||
|
||||
# Do we have one single long line?
|
||||
long_line = True
|
||||
# Type of installation (see details in data_generator)
|
||||
type = 2
|
||||
|
||||
# TODO: test with real serial
|
||||
# https://www.pjrc.com/teensy/td_uart.html
|
||||
|
||||
ledTCP = None
|
||||
data = None
|
||||
current_px = 0
|
||||
|
||||
def setup():
|
||||
global ledTCP
|
||||
global data
|
||||
ledTCP, data = prepare(Client, receiver_IP, receiver_port, height, width, framerate, brightness)
|
||||
background(0)
|
||||
send_TCP(ledTCP, data, long_line, type)
|
||||
noLoop()
|
||||
|
||||
def draw():
|
||||
px = 0
|
||||
for i in range(height):
|
||||
for j in range(width):
|
||||
if i % 2 == 0:
|
||||
pixels[px] = color(255, 0, 0)
|
||||
else:
|
||||
pixels[px] = color(0, 255, 0)
|
||||
px += 1
|
||||
updatePixels()
|
||||
send_TCP(ledTCP, data, long_line, type)
|
|
@ -0,0 +1,135 @@
|
|||
import jarray
|
||||
import math
|
||||
import itertools
|
||||
|
||||
_byte_lookup = {}
|
||||
brightness_max = 0.5
|
||||
|
||||
# Bit values which represent the zero and one bit pulses.
|
||||
_ZERO = bytearray([0b00000000])
|
||||
_ONE = bytearray([0b11111111])
|
||||
|
||||
def _build_byte_lookup():
|
||||
"""Return lookup table to map from every byte value 0-255 and the associated raw SPI data."""
|
||||
lookup = {}
|
||||
for i in range(256):
|
||||
value = bytearray()
|
||||
for j in range(7, -1, -1):
|
||||
if ((i >> j) & 1) == 0:
|
||||
value += _ZERO
|
||||
else:
|
||||
value += _ONE
|
||||
lookup[i] = value
|
||||
return lookup
|
||||
|
||||
def color_to_rgb(c):
|
||||
"""Convert a 24 bit color to RGB triplets."""
|
||||
return ((c >> 16) & 0xFF, (c >> 8) & 0xFF, c & 0xFF)
|
||||
|
||||
def _encode_color_grb(c):
|
||||
"""Encode an RGB tuple into NeoPixel GRB 24 byte SPI bit stream."""
|
||||
return _byte_lookup[int(c[1] * brightness)] + _byte_lookup[int(c[0] * brightness)] + _byte_lookup[int(c[2] * brightness)]
|
||||
|
||||
def _encode_pixel(c):
|
||||
"""Encode an RGB tuple into NeoPixel GRB 24 byte SPI bit stream."""
|
||||
rgb = color_to_rgb(c)
|
||||
encoded = _encode_color_grb(rgb)
|
||||
return encoded
|
||||
|
||||
def prepare_data(dimension, b):
|
||||
global brightness
|
||||
global _byte_lookup
|
||||
if b > brightness_max:
|
||||
brightness = brightness_max
|
||||
else:
|
||||
brightness = b
|
||||
_byte_lookup = _build_byte_lookup()
|
||||
data = jarray.zeros(dimension * 24 + 1, "b")
|
||||
return data
|
||||
|
||||
'''
|
||||
Possibilities:
|
||||
Start: Top left / Top Right / Bottom Left / Bottom Right
|
||||
Direction: Up / Down / Right / Left
|
||||
'''
|
||||
|
||||
|
||||
def make_line(type, nb, long_line):
|
||||
'''
|
||||
If moving up or down: 0 <= nb < height
|
||||
If moving right or left: 0 <= nb < width
|
||||
'''
|
||||
indexes = []
|
||||
if type == 0:
|
||||
# top left -> down / OK
|
||||
pxstart = nb
|
||||
for h in range(height):
|
||||
indexes.append(pxstart + width * h)
|
||||
elif type == 1:
|
||||
# top left -> right / OK
|
||||
pxstart = nb * width
|
||||
for w in range(width):
|
||||
indexes.append(pxstart + w)
|
||||
elif type == 2:
|
||||
# bottom left -> up / OK
|
||||
pxstart = width * (height - 1) + nb
|
||||
for h in range(height):
|
||||
indexes.append(pxstart - width * h)
|
||||
elif type == 3:
|
||||
# bottom left -> right / OK
|
||||
pxstart = width * (height - 1) - nb * width
|
||||
for w in range(width):
|
||||
indexes.append(pxstart + w)
|
||||
elif type == 4:
|
||||
# top right -> down / OK
|
||||
pxstart = width - 1 - nb
|
||||
for h in range(height):
|
||||
indexes.append(pxstart + width * h)
|
||||
elif type == 5:
|
||||
# top right -> left / OK
|
||||
pxstart = width - 1 + nb * width
|
||||
for w in range(width):
|
||||
indexes.append(pxstart - w)
|
||||
elif type == 6:
|
||||
# bottom right -> up / OK
|
||||
pxstart = width * height - 1 - nb * height
|
||||
for h in range(height):
|
||||
indexes.append(pxstart - width * h)
|
||||
elif type == 7:
|
||||
# bottom right -> left / OK
|
||||
pxstart = width * height - 1 - nb * width
|
||||
for w in range(width):
|
||||
indexes.append(pxstart - w)
|
||||
else:
|
||||
raise Exception("Invalid Type")
|
||||
|
||||
if long_line and nb % 2 == 1:
|
||||
return reversed([pixels[px] for px in indexes])
|
||||
return [pixels[px] for px in indexes]
|
||||
|
||||
|
||||
def image2data(data, type, long_line):
|
||||
offset = 0
|
||||
loadPixels()
|
||||
inline_image = []
|
||||
if type in [0, 2, 4, 6]:
|
||||
# Organized up or down
|
||||
for x in range(0, width):
|
||||
inline_image += make_line(type, x, long_line)
|
||||
elif type in [1, 3, 5, 7]:
|
||||
# Organized left or right
|
||||
for x in range(0, height):
|
||||
inline_image += make_line(type, x, long_line)
|
||||
for img_px in inline_image:
|
||||
py_bytes = _encode_pixel(img_px)
|
||||
for b in py_bytes:
|
||||
if b > 127:
|
||||
# Convert to signed bytes (expected by jarray)
|
||||
b -= 256
|
||||
data[offset] = b
|
||||
else:
|
||||
data[offset] = b
|
||||
offset += 1
|
||||
# New line
|
||||
data[-1] = 10
|
||||
return data
|
|
@ -0,0 +1,36 @@
|
|||
import jarray
|
||||
import time
|
||||
import struct
|
||||
from data_generator import image2data
|
||||
|
||||
def TCPConfigure(cl_class, server, port):
|
||||
return cl_class(this, server, port)
|
||||
|
||||
def receive_config(socket):
|
||||
max_height = jarray.zeros(4, "b")
|
||||
max_width = jarray.zeros(4, "b")
|
||||
max_framerate = jarray.zeros(4, "b")
|
||||
while True:
|
||||
available_bytes = socket.available()
|
||||
if available_bytes > 0:
|
||||
break
|
||||
time.sleep(1)
|
||||
socket.readBytes(max_height)
|
||||
socket.readBytes(max_width)
|
||||
socket.readBytes(max_framerate)
|
||||
max_height = struct.unpack("<i", max_height)[0]
|
||||
max_width = struct.unpack("<i", max_width)[0]
|
||||
max_framerate = struct.unpack("<i", max_framerate)[0]
|
||||
return max_height, max_width, max_framerate
|
||||
|
||||
def send_config(socket, height, width, framerate):
|
||||
socket.write(struct.pack('<i', height))
|
||||
socket.write(struct.pack('<i', width))
|
||||
socket.write(struct.pack('<i', framerate))
|
||||
|
||||
def send_TCP(socket, data, long_line, type):
|
||||
if socket is None:
|
||||
# Dummy mode
|
||||
return
|
||||
image2data(data, type, long_line)
|
||||
socket.write(data)
|
|
@ -0,0 +1,29 @@
|
|||
from network import receive_config, send_config, TCPConfigure
|
||||
from data_generator import prepare_data
|
||||
|
||||
def check_config(max_height, max_width, max_framerate, height, width, framerate):
|
||||
if height <= 0 or height > max_height:
|
||||
return False, "height cannot be higher than {}. Current: {}.".format(max_height, height)
|
||||
if width <= 0 or width > max_width:
|
||||
return False, "width cannot be higher than {}. Current: {}.".format(max_width, width)
|
||||
if framerate <= 0 or framerate > max_framerate:
|
||||
return False, "framerate cannot be higher than {}. Current: {}.".format(max_framerate, framerate)
|
||||
return True, None
|
||||
|
||||
def prepare(cl_class, server_ip, server_port, height, width, framerate, brightness):
|
||||
# Just to make sure pixels[] is initialized.
|
||||
if server_ip == 'dummy':
|
||||
size(width, height)
|
||||
loadPixels()
|
||||
return None, None
|
||||
ledTCP = TCPConfigure(cl_class, server_ip, server_port)
|
||||
max_height, max_width, max_framerate = receive_config(ledTCP)
|
||||
good, reason = check_config(max_height, max_width, max_framerate, height, width, framerate)
|
||||
if not good:
|
||||
raise Exception(reason)
|
||||
send_config(ledTCP, height, width, framerate)
|
||||
size(width, height)
|
||||
loadPixels()
|
||||
dimension = width * height
|
||||
data = prepare_data(dimension, brightness)
|
||||
return ledTCP, data
|
Loading…
Reference in New Issue