From 423d9f66b3a6ee240d6090498c1437ab64796710 Mon Sep 17 00:00:00 2001 From: =?UTF-8?q?Rapha=C3=ABl=20Vinot?= Date: Sun, 10 May 2015 17:32:33 +0200 Subject: [PATCH] Add project to check allignment of LEDs --- .../processing/Control_LIne/Control_LIne.pyde | 46 ++++++ .../processing/Control_LIne/data_generator.py | 135 ++++++++++++++++++ v2/backend/processing/Control_LIne/network.py | 36 +++++ v2/backend/processing/Control_LIne/prepare.py | 29 ++++ 4 files changed, 246 insertions(+) create mode 100644 v2/backend/processing/Control_LIne/Control_LIne.pyde create mode 100644 v2/backend/processing/Control_LIne/data_generator.py create mode 100644 v2/backend/processing/Control_LIne/network.py create mode 100644 v2/backend/processing/Control_LIne/prepare.py diff --git a/v2/backend/processing/Control_LIne/Control_LIne.pyde b/v2/backend/processing/Control_LIne/Control_LIne.pyde new file mode 100644 index 0000000..7a68483 --- /dev/null +++ b/v2/backend/processing/Control_LIne/Control_LIne.pyde @@ -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) diff --git a/v2/backend/processing/Control_LIne/data_generator.py b/v2/backend/processing/Control_LIne/data_generator.py new file mode 100644 index 0000000..6ffb03f --- /dev/null +++ b/v2/backend/processing/Control_LIne/data_generator.py @@ -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 diff --git a/v2/backend/processing/Control_LIne/network.py b/v2/backend/processing/Control_LIne/network.py new file mode 100644 index 0000000..c271e3a --- /dev/null +++ b/v2/backend/processing/Control_LIne/network.py @@ -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(" 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