Move protoflap code to its own repo

This commit is contained in:
Tanner
2025-10-14 22:15:13 +01:00
parent 8e1a356ace
commit 924fdf9542
4 changed files with 461 additions and 0 deletions

69
crc.py Normal file
View File

@@ -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()

89
packet.py Normal file
View File

@@ -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

75
protoflap.py Normal file
View File

@@ -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()

228
vestactrl.py Normal file
View File

@@ -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:])