|
| 1 | +#!/usr/bin/env python |
| 2 | + |
| 3 | +from oldlib import dac |
| 4 | +from oldlib.common import * |
| 5 | +from find_dac import find_dac_with_mac |
| 6 | + |
| 7 | +import math |
| 8 | +import itertools |
| 9 | +import sys |
| 10 | +import time |
| 11 | + |
| 12 | +COLOR_R = CMAX |
| 13 | +COLOR_G = CMAX |
| 14 | +COLOR_B = CMAX |
| 15 | + |
| 16 | +SIZE = 9000 |
| 17 | +XOFF = 0 |
| 18 | +YOFF = 0 |
| 19 | + |
| 20 | +def line_generator(pt1, pt2, backward=False, steps = 100): |
| 21 | + xdiff = pt1.x - pt2.x |
| 22 | + ydiff = pt1.y - pt2.y |
| 23 | + if not backward: |
| 24 | + for i in xrange(0, steps, 1): |
| 25 | + j = float(i)/steps |
| 26 | + x = pt1.x + (xdiff * j) |
| 27 | + y = pt1.y + (ydiff * j) |
| 28 | + yield (x, y, COLOR_R, COLOR_G, COLOR_B) |
| 29 | + |
| 30 | + else: |
| 31 | + for i in xrange(steps, 0, -1): |
| 32 | + j = float(i)/steps |
| 33 | + x = pt1.x + (xdiff * j) |
| 34 | + y = pt1.y + (ydiff * j) |
| 35 | + yield (x, y, COLOR_R, COLOR_G, COLOR_B) |
| 36 | + |
| 37 | +class LinePointStream(object): |
| 38 | + |
| 39 | + def __init__(self, size=500, r=0, g=0, b=0, x=0, y=0): |
| 40 | + self.size = size |
| 41 | + self.r = r |
| 42 | + self.g = g |
| 43 | + self.b = b |
| 44 | + |
| 45 | + self.stream = self.produce() |
| 46 | + |
| 47 | + self.linePts = [ |
| 48 | + (Point(0+x, 0+y), Point(0+x, size+y)), |
| 49 | + (Point(0+x, -size+y), Point(-size+x, -size+y)), |
| 50 | + (Point(size+x, -size+y), Point(size+x, -2*size+y)), |
| 51 | + (Point(size+x, 0+y), Point(2*size+x, 0+y)) |
| 52 | + ] |
| 53 | + |
| 54 | + self.curLineIdx = len(self.linePts)-1 |
| 55 | + self.advanceLine() |
| 56 | + |
| 57 | + def advanceLine(self): |
| 58 | + self.curLineIdx = (self.curLineIdx+1) % len(self.linePts) |
| 59 | + self.curLine = line_generator( |
| 60 | + self.linePts[self.curLineIdx][0], |
| 61 | + self.linePts[self.curLineIdx][1]) |
| 62 | + |
| 63 | + def produce(self): |
| 64 | + while True: |
| 65 | + try: |
| 66 | + yield self.curLine.next() |
| 67 | + except: |
| 68 | + self.advanceLine() |
| 69 | + |
| 70 | + """ |
| 71 | + # Line out |
| 72 | + for i in xrange(0, steps, 1): |
| 73 | + j = float(i)/steps |
| 74 | + x = self.x1 + (xdiff * j) |
| 75 | + y = self.y1 + (ydiff * j) |
| 76 | + yield (x, y, self.r, self.g, self.b) |
| 77 | +
|
| 78 | + # Line back in |
| 79 | + for i in xrange(0, steps, 1): |
| 80 | + j = float(i)/steps |
| 81 | + x = self.x2 - xdiff * j |
| 82 | + y = self.y2 - ydiff * j |
| 83 | + yield (x, y, self.r, self.g, self.b) |
| 84 | + """ |
| 85 | + |
| 86 | + def read(self, n): |
| 87 | + d = [self.stream.next() for i in xrange(n)] |
| 88 | + return d |
| 89 | + |
| 90 | +while True: |
| 91 | + macaddr = sys.argv[1] |
| 92 | + print 'Going to find DAC w/ mac %s' % macaddr |
| 93 | + m = find_dac_with_mac(macaddr) |
| 94 | + try: |
| 95 | + d = dac.DAC(m) |
| 96 | + ps = LinePointStream(SIZE, x=XOFF, y=YOFF) |
| 97 | + print 'Play stream...' |
| 98 | + d.play_stream(ps) |
| 99 | + |
| 100 | + except KeyboardInterrupt: |
| 101 | + sys.exit() |
| 102 | + |
| 103 | + except Exception as e: |
| 104 | + # Hopefully the galvos aren't melting... |
| 105 | + print "EXCEPTION" |
| 106 | + print e |
| 107 | + time.sleep(0.01) |
| 108 | + continue |
| 109 | + |
0 commit comments