Beginnings of selftest. Fixed poke instruction.
[goodfet] / client / goodfet.msp430
1 #!/usr/bin/env python
2
3 import sys;
4 import binascii;
5
6 from GoodFETMSP430 import GoodFETMSP430;
7 from intelhex import IntelHex16bit, IntelHex;
8
9
10 if(len(sys.argv)==1):
11     print "Usage: %s verb [objects]\n" % sys.argv[0];
12     print "%s test" % sys.argv[0];
13     print "%s dump $foo.hex [0x$start 0x$stop]" % sys.argv[0];
14     print "%s erase" % sys.argv[0];
15     print "%s eraseinfo" % sys.argv[0];
16     print "%s flash $foo.hex [0x$start 0x$stop]" % sys.argv[0];
17     print "%s verify $foo.hex [0x$start 0x$stop]" % sys.argv[0];
18     print "%s poke 0x$adr 0x$val" % sys.argv[0];
19     print "%s serial [$val]" % sys.argv[0];
20     print "%s peek 0x$start [0x$stop]" % sys.argv[0];
21     print "%s run" % sys.argv[0];
22     sys.exit();
23
24 #Initialize FET and set baud rate
25 client=GoodFETMSP430();
26 client.serInit()
27
28 #Connect to target
29 client.setup();
30 #print "setup"
31
32 #Identify model number.
33 client.start();
34
35 if(sys.argv[1]=="info"):
36     #print "Model    %08x " % client.MSP430deviceid();
37     #print "Core     %04x " % client.MSP430coreid();
38     #print "Identity %04x" % client.MSP430ident();
39     print "Identifies as %s (%04x)" % (
40         client.MSP430identstr(),
41         client.MSP430ident());
42 if(sys.argv[1]=="test"):
43     client.MSP430test();
44 if(sys.argv[1]=="glitch"):
45     for foo in range(0,100):
46         print "Identifies as %04x" % client.MSP430ident();
47 if(sys.argv[1]=="dump"):
48     f = sys.argv[2];
49     start=0x0200;
50     stop=0xFFFF;
51     if(len(sys.argv)>3):
52         start=int(sys.argv[3],16);
53     if(len(sys.argv)>4):
54         stop=int(sys.argv[4],16);
55     
56     print "Dumping from %04x to %04x as %s." % (start,stop,f);
57     #h = IntelHex16bit(None);
58     h = IntelHex(None);
59     i=start;
60     while i<=stop:
61         data=client.MSP430peekblock(i);
62         print "Dumped %06x."%i;
63         for j in data:
64             if i<=stop: h[i]=ord(j);
65             i+=1;
66     h.write_hex_file(f);
67 if(sys.argv[1]=="erase"):
68     print "Erasing main flash memory."
69     client.MSP430masserase();
70 if(sys.argv[1]=="eraseinfo"):
71     print "Erasing info memory."
72     client.MSP430infoerase();
73
74 if(sys.argv[1]=="selftest"):
75     entry=client.peek16(0xFFC0);
76     print "Calling self-test at 0x%04x." %entry;
77     client.MSP430setPC(entry);
78     print "PC=%04x" % client.MSP430getreg(0);
79     client.MSP430releasecpu();
80     
81     import time;
82     time.sleep(30)
83
84 if(sys.argv[1]=="ivt"):
85     client.MSP430dumpmem(0xFFC0,0xFFFF);
86 if(sys.argv[1]=="regs"):
87     for i in range(0,16):
88         print "r%i=%04x" % (i,client.MSP430getreg(i));
89
90 if(sys.argv[1]=="flash"):
91     f=sys.argv[2];
92     start=0;
93     stop=0x10000;
94     if(len(sys.argv)>3):
95         start=int(sys.argv[3],16);
96     if(len(sys.argv)>4):
97         stop=int(sys.argv[4],16);
98     
99     h = IntelHex16bit(f);
100     
101     #Should this be default?
102     #Makes flashing multiple images inconvenient.
103     #client.MSP430masserase();
104     
105     count=0; #Bytes in commit.
106     first=0;
107     vals=[];
108     last=0;  #Last address committed.
109     for i in h._buf.keys():
110         if((count>0x40 or last+2!=i) and count>0 and i&1==0):
111             #print "%i, %x, %x" % (len(vals), last, i);
112             client.MSP430pokeflashblock(first,vals);
113             count=0;
114             first=0;
115             last=0;
116             vals=[];
117         if(i>=start and i<stop  and i&1==0):
118             val=h[i>>1];
119             if(count==0):
120                 first=i;
121             last=i;
122             count+=2;
123             vals+=[val&0xff,(val&0xff00)>>8];
124             if(i%0x100==0):
125                 print "%04x" % i;
126     if count>0: #last commit, ivt
127         client.MSP430pokeflashblock(first,vals);
128 if(sys.argv[1]=="verify"):
129     f=sys.argv[2];
130     start=0;
131     stop=0xFFFF;
132     if(len(sys.argv)>3):
133         start=int(sys.argv[3],16);
134     if(len(sys.argv)>4):
135         stop=int(sys.argv[4],16);
136     
137     h = IntelHex16bit(f);
138     for i in h._buf.keys():
139         if(i>=start and i<stop and i&1==0):
140             peek=client.MSP430peek(i)
141             if(h[i>>1]!=peek):
142                 print "ERROR at %04x, found %04x not %04x"%(i,peek,h[i>>1]);
143             if(i%0x100==0):
144                 print "%04x" % i;
145 if(sys.argv[1]=="peek"):
146     start=0x0000;
147     if(len(sys.argv)>2):
148         start=int(sys.argv[2],16);
149     stop=start;
150     if(len(sys.argv)>3):
151         stop=int(sys.argv[3],16);
152     print "Peeking from %04x to %04x." % (start,stop);
153     while start<=stop:
154         print "%04x: %04x" % (start,client.MSP430peek(start));
155         start=start+2;
156
157 if(sys.argv[1]=="poke"):
158     start=0x0000;
159     val=0x00;
160     if(len(sys.argv)>2):
161         start=int(sys.argv[2],16);
162     if(len(sys.argv)>3):
163         val=int(sys.argv[3],16);
164     print "Poking %06x to become %04x." % (start,val);
165     
166     while client.MSP430peek(start)&(~val)>0:
167         client.MSP430pokeflash(start,val);
168         print "Poked to %04x" % client.MSP430peek(start);
169 if(sys.argv[1]=="serial"):
170     oid=0xdeadbeef;
171     if(len(sys.argv)>2):
172         oid=eval(sys.argv[2]);
173     else:
174         #Crashes Windows.
175         #simpchin=u=unichr(24207)+unichr(21015)+unichr(21495);  #Chinese for "Serial Number".
176         #print simpchin;
177         
178         oid=input(u"Serial Number? ");
179     adr=0xFFB0;
180     if(len(sys.argv)>2):
181         start=int(sys.argv[2],16);
182     if(len(sys.argv)>3):
183         val=int(sys.argv[3],16);
184     print "Poking 32-bit OID to 0x%04x as %08x." % (adr,oid);
185     client.MSP430pokeflash(adr,oid&0xFFFF);
186     client.MSP430pokeflash(adr+2,(oid>>16)&0xFFFF);
187
188 if(sys.argv[1]=="run"):
189     #Set PC to RESET vector's value.
190     #client.MSP430setPC(client.MSP430peek(0xfffe));
191     #client.MSP430releasecpu();
192     client.MSP430run();
193
194 if(sys.argv[1]=="whatever"):
195     for i in [0x24FF, 0x2500, 0x2502, 0x2504]:
196         print "%04x" % client.MSP430peek(i);
197
198 #client.MSP430releasecpu();
199 #client.MSP430stop();