root / trunk / programmer / netprog.py @ 159
History | View | Annotate | Download (3.26 KB)
1 |
#!/usr/bin/python
|
---|---|
2 |
import sys |
3 |
import serial |
4 |
|
5 |
TT_BOOT = 'b'
|
6 |
TT_PROGRAM_MODE = 'p'
|
7 |
TT_ACK = 'a'
|
8 |
TT_NACK = 'n'
|
9 |
TT_BAD = 0
|
10 |
TT_PROGD = 'd'
|
11 |
|
12 |
DUMB_SERIAL = 0
|
13 |
|
14 |
BAUD_RATE = 9600
|
15 |
|
16 |
MAX_DATA_LEN = 32
|
17 |
|
18 |
if len(sys.argv) < 4: |
19 |
print "usage: netprog.py /path/to/bus/device toolnum binaryfile" |
20 |
exit(1) |
21 |
|
22 |
#for testing, tool number 3
|
23 |
class dumbBus (serial.Serial): |
24 |
def __init__(self): |
25 |
self.step = 0 |
26 |
def flushInput(self): |
27 |
pass
|
28 |
def write(self, s): |
29 |
print '>', |
30 |
def read(self, n): |
31 |
if n == 5: |
32 |
if self.step == 0: |
33 |
#print ord('^'), 3,1,ord(TT_BOOT), (3 ^ 1 ^ ord(TT_BOOT))
|
34 |
print '<', |
35 |
self.step += 1 |
36 |
return '^' + chr(3) + chr(1) + TT_BOOT + chr(3 ^ 1 ^ ord(TT_BOOT)) |
37 |
else:
|
38 |
#print ord('^'), 3,1,ord(TT_ACK), (3 ^ 1 ^ ord(TT_ACK))
|
39 |
print '<', |
40 |
return '^' + chr(3) + chr(1) + TT_ACK + chr(3 ^ 1 ^ ord(TT_ACK)) |
41 |
else:
|
42 |
return 0 |
43 |
|
44 |
if DUMB_SERIAL == 0: |
45 |
bus = serial.Serial(sys.argv[1], BAUD_RATE, timeout = 10) |
46 |
else:
|
47 |
bus = dumbBus() |
48 |
|
49 |
bus.flushInput() |
50 |
#print bus
|
51 |
|
52 |
def sendCommand(t, cmd): |
53 |
msg = '^' + chr(1) + chr(t) + cmd + chr(1 ^ t ^ ord(cmd)) |
54 |
print "sending..." |
55 |
bus.write(msg) |
56 |
|
57 |
def sendProgram(t, size): |
58 |
if size > 2**16: |
59 |
print "ERROR: program too big!!" |
60 |
|
61 |
def lsb(s): return s & 0xFF |
62 |
def msb(s): return (s>>8) & 0xFF |
63 |
|
64 |
body = chr(1) + chr(t) + TT_PROGRAM_MODE + chr(lsb(size)) + chr(msb(size)) |
65 |
print 1,t,TT_PROGRAM_MODE,lsb(size),msb(size), |
66 |
xor = 0
|
67 |
for c in body: |
68 |
xor = xor ^ ord(c)
|
69 |
print xor
|
70 |
|
71 |
msg = '^' + body + chr(xor) |
72 |
print "sending P" |
73 |
bus.write(msg) |
74 |
|
75 |
def sendData(t, data): |
76 |
body = chr(1) + chr(t) + TT_PROGD + data |
77 |
n = len(data)
|
78 |
while n < MAX_DATA_LEN:
|
79 |
body = body + chr(0) |
80 |
n = n + 1
|
81 |
xor = 0
|
82 |
for c in body: |
83 |
xor = xor ^ ord(c)
|
84 |
|
85 |
msg = '^' + body + chr(xor) |
86 |
bus.write(msg) |
87 |
print '.', |
88 |
sys.stdout.flush() |
89 |
|
90 |
def readPacket(): |
91 |
msg = bus.read(5)
|
92 |
if len(msg) < 5: |
93 |
print "message too short! len =",len(msg) |
94 |
return TT_BAD
|
95 |
if msg[0] != '^': |
96 |
print "did not get start delimeter!" |
97 |
return TT_BAD
|
98 |
src = msg[1]
|
99 |
#print "src: ", ord(src)
|
100 |
if msg[2] != chr(1): |
101 |
print "packet dest not 1!" |
102 |
return TT_BAD
|
103 |
cmd = msg[3]
|
104 |
if msg[4] != chr(ord(src) ^ 1 ^ ord(msg[3])): |
105 |
print "checksum was wrong!" |
106 |
print ord(msg[0]), ord(msg[1]), ord(msg[2]), ord(msg[3]), ord(msg[4]) |
107 |
print (ord(src) ^ 1 ^ ord(msg[3])) |
108 |
return TT_BAD
|
109 |
|
110 |
return cmd
|
111 |
|
112 |
toolID = int(sys.argv[2]) |
113 |
|
114 |
print "sending file: ", sys.argv[3], " to tool ", toolID |
115 |
|
116 |
fin = open(sys.argv[3], "r") |
117 |
fin.seek(0,2) |
118 |
flen = fin.tell() |
119 |
fin.seek(0,0) |
120 |
|
121 |
print "waiting for boot packet..." |
122 |
while readPacket() != TT_BOOT:
|
123 |
print "got some other byte ???" |
124 |
exit(-4) |
125 |
|
126 |
sendProgram(toolID, flen) |
127 |
r = readPacket() |
128 |
if r != TT_ACK:
|
129 |
print "ERROR: tool did not ACK!!! got", r |
130 |
exit(-1) |
131 |
|
132 |
print 'sending data', |
133 |
sys.stdout.flush() |
134 |
while True: |
135 |
data = fin.read(MAX_DATA_LEN) |
136 |
#print data
|
137 |
#print '-------------------'
|
138 |
|
139 |
sendData(toolID, data) |
140 |
if readPacket() != TT_ACK:
|
141 |
print "last data packet not ACK'd!!" |
142 |
break
|
143 |
|
144 |
if len(data) < MAX_DATA_LEN: |
145 |
break
|