From 924fdf9542fd9a2b99ff48b10d5235963c3bc9a8 Mon Sep 17 00:00:00 2001 From: Tanner Date: Tue, 14 Oct 2025 22:15:13 +0100 Subject: [PATCH] Move protoflap code to its own repo --- crc.py | 69 ++++++++++++++++ packet.py | 89 ++++++++++++++++++++ protoflap.py | 75 +++++++++++++++++ vestactrl.py | 228 +++++++++++++++++++++++++++++++++++++++++++++++++++ 4 files changed, 461 insertions(+) create mode 100644 crc.py create mode 100644 packet.py create mode 100644 protoflap.py create mode 100644 vestactrl.py diff --git a/crc.py b/crc.py new file mode 100644 index 0000000..94b4ee1 --- /dev/null +++ b/crc.py @@ -0,0 +1,69 @@ +#!/usr/bin/env python + +CRCTable = [ + 0x00000000, 0x77073096, 0xee0e612c, 0x990951ba, 0x076dc419, 0x706af48f, + 0xe963a535, 0x9e6495a3, 0x0edb8832, 0x79dcb8a4, 0xe0d5e91e, 0x97d2d988, + 0x09b64c2b, 0x7eb17cbd, 0xe7b82d07, 0x90bf1d91, 0x1db71064, 0x6ab020f2, + 0xf3b97148, 0x84be41de, 0x1adad47d, 0x6ddde4eb, 0xf4d4b551, 0x83d385c7, + 0x136c9856, 0x646ba8c0, 0xfd62f97a, 0x8a65c9ec, 0x14015c4f, 0x63066cd9, + 0xfa0f3d63, 0x8d080df5, 0x3b6e20c8, 0x4c69105e, 0xd56041e4, 0xa2677172, + 0x3c03e4d1, 0x4b04d447, 0xd20d85fd, 0xa50ab56b, 0x35b5a8fa, 0x42b2986c, + 0xdbbbc9d6, 0xacbcf940, 0x32d86ce3, 0x45df5c75, 0xdcd60dcf, 0xabd13d59, + 0x26d930ac, 0x51de003a, 0xc8d75180, 0xbfd06116, 0x21b4f4b5, 0x56b3c423, + 0xcfba9599, 0xb8bda50f, 0x2802b89e, 0x5f058808, 0xc60cd9b2, 0xb10be924, + 0x2f6f7c87, 0x58684c11, 0xc1611dab, 0xb6662d3d, 0x76dc4190, 0x01db7106, + 0x98d220bc, 0xefd5102a, 0x71b18589, 0x06b6b51f, 0x9fbfe4a5, 0xe8b8d433, + 0x7807c9a2, 0x0f00f934, 0x9609a88e, 0xe10e9818, 0x7f6a0dbb, 0x086d3d2d, + 0x91646c97, 0xe6635c01, 0x6b6b51f4, 0x1c6c6162, 0x856530d8, 0xf262004e, + 0x6c0695ed, 0x1b01a57b, 0x8208f4c1, 0xf50fc457, 0x65b0d9c6, 0x12b7e950, + 0x8bbeb8ea, 0xfcb9887c, 0x62dd1ddf, 0x15da2d49, 0x8cd37cf3, 0xfbd44c65, + 0x4db26158, 0x3ab551ce, 0xa3bc0074, 0xd4bb30e2, 0x4adfa541, 0x3dd895d7, + 0xa4d1c46d, 0xd3d6f4fb, 0x4369e96a, 0x346ed9fc, 0xad678846, 0xda60b8d0, + 0x44042d73, 0x33031de5, 0xaa0a4c5f, 0xdd0d7cc9, 0x5005713c, 0x270241aa, + 0xbe0b1010, 0xc90c2086, 0x5768b525, 0x206f85b3, 0xb966d409, 0xce61e49f, + 0x5edef90e, 0x29d9c998, 0xb0d09822, 0xc7d7a8b4, 0x59b33d17, 0x2eb40d81, + 0xb7bd5c3b, 0xc0ba6cad, 0xedb88320, 0x9abfb3b6, 0x03b6e20c, 0x74b1d29a, + 0xead54739, 0x9dd277af, 0x04db2615, 0x73dc1683, 0xe3630b12, 0x94643b84, + 0x0d6d6a3e, 0x7a6a5aa8, 0xe40ecf0b, 0x9309ff9d, 0x0a00ae27, 0x7d079eb1, + 0xf00f9344, 0x8708a3d2, 0x1e01f268, 0x6906c2fe, 0xf762575d, 0x806567cb, + 0x196c3671, 0x6e6b06e7, 0xfed41b76, 0x89d32be0, 0x10da7a5a, 0x67dd4acc, + 0xf9b9df6f, 0x8ebeeff9, 0x17b7be43, 0x60b08ed5, 0xd6d6a3e8, 0xa1d1937e, + 0x38d8c2c4, 0x4fdff252, 0xd1bb67f1, 0xa6bc5767, 0x3fb506dd, 0x48b2364b, + 0xd80d2bda, 0xaf0a1b4c, 0x36034af6, 0x41047a60, 0xdf60efc3, 0xa867df55, + 0x316e8eef, 0x4669be79, 0xcb61b38c, 0xbc66831a, 0x256fd2a0, 0x5268e236, + 0xcc0c7795, 0xbb0b4703, 0x220216b9, 0x5505262f, 0xc5ba3bbe, 0xb2bd0b28, + 0x2bb45a92, 0x5cb36a04, 0xc2d7ffa7, 0xb5d0cf31, 0x2cd99e8b, 0x5bdeae1d, + 0x9b64c2b0, 0xec63f226, 0x756aa39c, 0x026d930a, 0x9c0906a9, 0xeb0e363f, + 0x72076785, 0x05005713, 0x95bf4a82, 0xe2b87a14, 0x7bb12bae, 0x0cb61b38, + 0x92d28e9b, 0xe5d5be0d, 0x7cdcefb7, 0x0bdbdf21, 0x86d3d2d4, 0xf1d4e242, + 0x68ddb3f8, 0x1fda836e, 0x81be16cd, 0xf6b9265b, 0x6fb077e1, 0x18b74777, + 0x88085ae6, 0xff0f6a70, 0x66063bca, 0x11010b5c, 0x8f659eff, 0xf862ae69, + 0x616bffd3, 0x166ccf45, 0xa00ae278, 0xd70dd2ee, 0x4e048354, 0x3903b3c2, + 0xa7672661, 0xd06016f7, 0x4969474d, 0x3e6e77db, 0xaed16a4a, 0xd9d65adc, + 0x40df0b66, 0x37d83bf0, 0xa9bcae53, 0xdebb9ec5, 0x47b2cf7f, 0x30b5ffe9, + 0xbdbdf21c, 0xcabac28a, 0x53b39330, 0x24b4a3a6, 0xbad03605, 0xcdd70693, + 0x54de5729, 0x23d967bf, 0xb3667a2e, 0xc4614ab8, 0x5d681b02, 0x2a6f2b94, + 0xb40bbe37, 0xc30c8ea1, 0x5a05df1b, 0x2d02ef8d ] + +def CRC32(array,sz=None): + if sz == None: + sz = len(array) + retval = 0xffffffff + + for idx in range(sz): + b = array[idx] + n = (retval ^ b) & 0xff; + retval = (retval >> 8) ^ CRCTable[n] + + retval = retval ^ 0xFFFFFFFF + + return retval + + +def main(): + print("CRC32[andrea] = %08x" % CRC32(bytes("andrea would like to test this."))) + + +if __name__ == '__main__': + main() + diff --git a/packet.py b/packet.py new file mode 100644 index 0000000..c0fc157 --- /dev/null +++ b/packet.py @@ -0,0 +1,89 @@ + +import crc +import serial +import time + +OP_SET_TARGETS = 0x01 +OP_ARM = 0x02 +OP_GO = 0x03 +OP_PING = 0x04 +OP_REG_WRITE = 0x05 +OP_REG_READ = 0x06 + + +REG_INDEX_ADJUST = 0 +REG_ROTATE_NOP = 1 +REG_ONE_REV_MIN = 2 +REG_REV_COUNT_0 = 3 +REG_REV_COUNT_1 = 4 +REG_REV_COUNT_2 = 5 +REG_REV_COUNT_3 = 6 +REG_REV_COUNT_4 = 7 +REG_REV_COUNT_5 = 8 +REG_REV_COUNT_6 = 9 +REG_FREQ_D = 10 +REG_FREQ_N = 11 +REG_CRC_ERRORS = 12 +REG_ZERO_NOISE = 13 + + +def build(address, flags, payload, print_it=True): + packet_len = 1+2+1+2+len(payload)+4 + b = bytearray(packet_len) + b[0] = 0xff + b[1] = address & 0xff + b[2] = address >> 8 + b[3] = flags + b[4] = len(payload) & 0xff + b[5] = len(payload) >> 8 + b[6:6+len(payload)] = payload + b[6+len(payload)+0] = 0xff + b[6+len(payload)+1] = 0xff + b[6+len(payload)+2] = 0xff + b[6+len(payload)+3] = 0xff + crc32 = crc.CRC32(b, packet_len - 4); + b[6+len(payload)+0] = (crc32 >> (0*8)) & 0xff + b[6+len(payload)+1] = (crc32 >> (1*8)) & 0xff + b[6+len(payload)+2] = (crc32 >> (2*8)) & 0xff + b[6+len(payload)+3] = (crc32 >> (3*8)) & 0xff + #if print_it: + #print('Tx: %s' % (('xxxx','STGT', 'ARM ', 'GO ', 'PING', 'REGW', 'REGR')[b[6]]) ), + #for bb in b: + #print(" %02x" % bb), + #print('') + + return b + +def ping(address, print_it=True): + return build(address, 0, [0x04, 0x00, 0x00], print_it) + +def set_targets(address, targets, print_it=True): + payload = bytearray(8) + payload[0] = OP_SET_TARGETS + for i in range(len(payload)-1): + if i < len(targets): + payload[i+1] = targets[i] + else: + payload[i+1] = ' ' + return build(address, 0, payload, print_it) + +def arm(address, print_it=True): + return build(address, 0, [OP_ARM], print_it) + +def go(address, print_it=True): + return build(address, 0, [OP_GO], print_it) + +def reg_write(address, reg, val, print_it=True): + return build(address, 0, [OP_REG_WRITE, reg & 0xff, ((val>>8)&0xff), val & 0xff], print_it) +def reg_read(address, reg, print_it=True): + return build(address, 0, [OP_REG_READ, reg & 0xff], print_it) + +def send(sport, s): + sport.rts = False # Set high... logic is inverted + sport.write([s[0]]) + for c in s[1:]: + if c == 0xfe or c == 0xff: + sport.write([0xfe]) + sport.write([c]) + time.sleep(.01) # Delay + sport.rts = True # Set low... logic is inverted diff --git a/protoflap.py b/protoflap.py new file mode 100644 index 0000000..e12aefb --- /dev/null +++ b/protoflap.py @@ -0,0 +1,75 @@ +#!/usr/bin/env python +# -*- coding: utf-8 -*- + +from vestactrl import setup_digits, board_init_uart +import textwrap +import urllib2 +import json +import time + +def send_sign(text): + """ + Wraps and sends text to the Vestaboard. + """ + COLS = 22 + ROWS = 6 + + # Wrap text to fit the board's width. + lines = textwrap.wrap(text, width=COLS) + + # Truncate if the message is too long for the board's height. + if len(lines) > ROWS: + lines = lines[:ROWS] + + special_chars = { + ' ': '`0', + '\\w': '`1', # white + '\\r': '`2', # red + '\\o': '`3', # orange + '\\y': '`4', # yellow + '\\g': '`5', # green + '\\b': '`6', # blue + '\\v': '`7', # violet + '\\d': '`8', # degree + # '`9', # also degree + } + + for code, color in special_chars.items(): + lines = [line.replace(code, color) for line in lines] + + # setup_digits handles displaying the lines on the board. + # It will also vertically center the block of text. + try: + setup_digits(lines, left_to_right_swap=False, real_hw=True) + except BaseException as e: + print "Error setting digits:" + str(e) + + +def poll_and_display(): + """ + Polls the Protospace API and displays the sign message. + """ + last_message = "" + url = 'https://api.my.protospace.ca/stats/' + + while True: + try: + response = urllib2.urlopen(url) + data = json.load(response) + message = data.get('vestaboard') + + if message and message != last_message: + print "Updating sign with new message: " + message + send_sign(message.encode('utf-8')) + last_message = message + + except (urllib2.URLError, ValueError, KeyError) as e: + print "Error: {}".format(e) + + time.sleep(5) + + +if __name__ == '__main__': + # Initialize communication with the board. + board_init_uart() + poll_and_display() diff --git a/vestactrl.py b/vestactrl.py new file mode 100644 index 0000000..1f1fa3a --- /dev/null +++ b/vestactrl.py @@ -0,0 +1,228 @@ +#!/usr/bin/env python +# -*- coding: utf-8 -*- + +import serial +import serial.rs485 +import sys +import time +import packet +import string + +ser = None + +def read_and_print(sport, print_it=False): + s = sport.read(6) + barr = bytearray(s) + ll = (barr[5]<<8) + barr[4] + s2 = sport.read(ll+4) + barr += bytearray(s2) + #if print_it: + #print('Rx:'), + #for b in barr: + #print(" %02x" % b), + #print('') + return barr + +def color_handling(s): + b = bytearray(s) + for idx in range(len(b)): + if chr(b[idx]) == '`': + b[idx+1] = int(chr(b[idx+1])) + + s=b.translate(None,'`') + return s + +def send_packet(s): + ser.rts = False # Set high... logic is inverted + ser.write([s[0]]) + for c in s[1:]: + if c == 0xfe or c == 0xff: + #print('escape') + ser.write([0xfe]) + ser.write([c]) + time.sleep(.005) # Delay + ser.rts = True # Set low... logic is inverted + +def test (string, print_it): + + time.sleep(.5) + s = color_handling(string) + # 6 rows instead of 7 now + val = ' '*(6-len(s))+s + send_packet(packet.set_targets(0x0001, val, print_it)) + read_and_print(ser, print_it) + + send_packet(packet.arm(0x0001, print_it)) + read_and_print(ser, print_it) + + send_packet(packet.go(0x0001, print_it)) + read_and_print(ser, print_it) + + time.sleep(12) + # 6 rows insteaad of 7 now + for i in range(6): + send_packet(packet.reg_read(0x0001, packet.REG_REV_COUNT_0+i, print_it)) + res = read_and_print(ser, print_it) + count = (res[9]<<8)+res[8] + #print('%d,' % count), + #print('%s,' % string) +# 22 col instead of 23 now +all_columns = [1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18, 19, 20, 21, 22] +#all_columns = [1, 2, 3, 4, 5, 6, 7, 8] + +def init_all_columns(): + for c in all_columns: + send_packet(packet.reg_write(c, packet.REG_INDEX_ADJUST, 20)) + read_and_print(ser) + send_packet(packet.reg_write(c, packet.REG_ROTATE_NOP, 0)) + read_and_print(ser) + send_packet(packet.reg_write(c, packet.REG_ONE_REV_MIN, 0)) + read_and_print(ser) + #send_packet(packet.reg_write(c, packet.REG_FREQ_D, 5)) + #read_and_print(ser) + #send_packet(packet.reg_write(c, packet.REG_FREQ_N, 2)) + #read_and_print(ser) + +def print_board(rows,print_it=True): + if print_it: + print('#'*24) + for l in rows: + # 22 col insteaed of 23 now + print '#' + ('%-22s' % l) + '#' + print('#'*24) + for l in rows: + print " ".join("{:02x}".format(ord(c)) for c in l) + + +def setup_digits(strings, left_to_right_swap = False, real_hw=True): + #print('string sent in app: %s') % strings + #print('string length: %d') % len(strings) + print_it = True + # digits raw major + # 22 col instead of 23 and 6 rows instead of now + #drm = ['\x00'*22, '\x00'*22, '\x00'*22, '\x00'*22, '\x00'*22, '\x00'*22] + drm = [' '*22, ' '*22, ' '*22, ' '*22, ' '*22, ' '*22] + # 6 rows instead of 7 now + offset = (6-len(strings))/2 + max_len = 0 + for idx in range(len(strings)): + s = strings[idx] + # 22 col instaed of 23 now + s = color_handling(s)[:22] + if left_to_right_swap: + s = s[::-1] + if len(s) > max_len: + max_len = len(s) + # 22 col insteaad of 23 now + drm[offset+idx] = ('%-22s' % s) + #print_board(drm) + #print('Length of DRM: %d') % len(drm) + for idx in range(len(drm)): + #print('IDX: %d') % idx + initial_length = len(drm[idx]) + whitespace_number = drm[idx].count(' ') + final_length = initial_length - whitespace_number + left_side = (22-final_length)/2 + #print('left side: %d') % left_side + right_side = 22 - left_side - final_length + #print('right side: %d') % right_side + # 22 col instead of 23 now + drm[idx] = drm[idx].replace(' ', '') + drm[idx] = ('%-22s' % (('\x00'*(left_side)) + drm[idx] + ('\x00'*(right_side))))[:22] + #print 'Rows: %d' % len(drm) + #print 'Max Len: %d' % max_len + #print_board(drm) + # 6 row instead of 7 now + while len(drm) < 6: + # 22 col insteaad of 23 now + drm.append('%-22s' % '\x00') + # digits column major + dcm = [] + # 6 row instead of 7 now + tups = zip(drm[0], drm[1], drm[2], drm[3], drm[4], drm[5]) + #tups = zip(drm[0]) + for t in tups: + dcm.append(''.join(t)) + #print('tups: %s') % tups + if real_hw: + for idx in range(len(all_columns)): + #print 'idx: %d' % idx + #print '>>>> [%d] %s' % (idx+1, dcm[idx][::-1]) +############################################################################################## + send_packet(packet.set_targets(idx+1, dcm[idx][::-1], print_it)) + read_and_print(ser, print_it) + send_packet(packet.arm(idx+1, print_it)) + read_and_print(ser, print_it) + + send_packet(packet.go(0x0001, print_it)) + read_and_print(ser, print_it) + #print('skipping stuff...') +############################################################################################## + #else: + #print tups + +def emc_blanks(): + setup_digits(['`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7', '`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7', '`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7', '`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7', '`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7', '`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7`7'], left_to_right_swap=True) + +def blanks(): + #for c in all_columns: + # send_packet(packet.reg_write(c, packet.REG_FREQ_D, 8)) + # read_and_print(ser) + # send_packet(packet.reg_write(c, packet.REG_FREQ_N, 2)) + # read_and_print(ser) + setup_digits(['`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0', '`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0', '`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0', '`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0', '`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0', '`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0'], left_to_right_swap=True) + #setup_digits(['', '', '', '', '', ''], left_to_right_swap=True) + +def test_long_blanks(): + #for c in all_columns: + # send_packet(packet.reg_write(c, packet.REG_FREQ_D, 8)) + # read_and_print(ser) + # send_packet(packet.reg_write(c, packet.REG_FREQ_N, 2)) + # read_and_print(ser) + setup_digits(['`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0', '`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0', '`0`0`0`0`0`0`0`0`0TEST`0`0`0`0`0`0`0`0`0', '`0`0`0`0`0LONG`0MESSAGE`0`0`0`0`0', '`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0', '`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0'], left_to_right_swap=False) + #setup_digits(['', '', '', '', '', ''], left_to_right_swap=True) + +def test_rapid_blanks(): + #for c in all_columns: + # send_packet(packet.reg_write(c, packet.REG_FREQ_D, 8)) + # read_and_print(ser) + # send_packet(packet.reg_write(c, packet.REG_FREQ_N, 2)) + # read_and_print(ser) + setup_digits(['`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0', '`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0', '`0`0`0`0`0`0`0`0`0TSET`0`0`0`0`0`0`0`0`0', '`0`0`0NOISSECCUS`0DIPAR`0`0`0', '`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0', '`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0'], left_to_right_swap=True) + #setup_digits(['', '', '', '', '', ''], left_to_right_swap=True) + +def test_check_blanks(): + #for c in all_columns: + # send_packet(packet.reg_write(c, packet.REG_FREQ_D, 8)) + # read_and_print(ser) + # send_packet(packet.reg_write(c, packet.REG_FREQ_N, 2)) + # read_and_print(ser) + setup_digits(['`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0', '`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0', '`0`0`0`0`0`0`0`0`0TSET`0`0`0`0`0`0`0`0`0', '`0`0`0`0`0`0KCEHC`0PALF`0`0`0`0`0`0', '`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0', '`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0'], left_to_right_swap=True) + #setup_digits(['', '', '', '', '', ''], left_to_right_swap=True) + +def test_power_blanks(): + setup_digits(['`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0', '`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0', '`0`0`0`0`0`0`0`0`0TSET`0`0`0`0`0`0`0`0`0', '`0`0`0`0`0`0WARD`0REWOP`0`0`0`0`0`0', '`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0', '`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0`0'], left_to_right_swap=True) + +def board_init_uart(): + global ser + #tty = '/dev/ttyUSB0' + tty = '/dev/ttyAMA0' + ser = serial.Serial(tty, 38400) + +#def main(ser, args): +# init_all_columns() +# +# blanks() +# time.sleep(15) +# setup_digits(['vestaboard', 'welcome to', 't', 'e', 's', 't', '#'], left_to_right_swap=True) +# time.sleep(15) +# setup_digits(['colors `1`2`3', '`4`5`6 samples', '', '', '', '', ''], left_to_right_swap=True) +# time.sleep(15) +# setup_digits(['`0`1`2`3`4`5`6`5`4`3`2`1', '`6`5`4`3`2`1`0`1`2`3`4`5', '', '', '', '', ''], left_to_right_swap=True) +# time.sleep(15) +# blanks() +# +#if __name__ == '__main__': +# tty = '/dev/ttyUSB0' +# with serial.Serial(tty, 38400) as ser: +# main(ser, sys.argv[1:])