2 # GoodFET Client Library
4 # (C) 2009 Travis Goodspeed <travis at radiantmachines.com>
6 # This code is being rewritten and refactored. You've been warned!
11 from GoodFET import GoodFET;
12 from intelhex import IntelHex;
14 import xml.dom.minidom;
16 class GoodFETCC(GoodFET):
17 """A GoodFET variant for use with Chipcon 8051 Zigbee SoC."""
23 smartrfpath="/opt/smartrf7";
24 def loadsymbols(self):
25 try: self.SRF_loadsymbols();
27 if self.verbose==1: print "SmartRF load failed.";
28 def SRF_chipdom(self,chip="cc1110", doc="register_definition.xml"):
29 fn="%s/config/xml/%s/%s" % (self.smartrfpath,chip,doc);
30 #print "Opening %s" % fn;
31 return xml.dom.minidom.parse(fn)
33 def CMDrs(self,args=[]):
34 """Chip command to grab the radio state."""
35 self.SRF_radiostate();
36 def SRF_bitfieldstr(self,bf):
43 for e in bf.childNodes:
44 if e.localName=="Name" and e.childNodes: name= e.childNodes[0].nodeValue;
45 elif e.localName=="Start": start=e.childNodes[0].nodeValue;
46 elif e.localName=="Stop": stop=e.childNodes[0].nodeValue;
47 return " [%s:%s] %30s " % (start,stop,name);
48 def SRF_radiostate(self):
50 chip=self.CCversions.get(ident&0xFF00);
51 dom=self.SRF_chipdom(chip,"register_definition.xml");
52 for e in dom.getElementsByTagName("registerdefinition"):
53 for f in e.childNodes:
54 if f.localName=="DeviceName":
55 print "// %s RadioState" % (f.childNodes[0].nodeValue);
56 elif f.localName=="Register":
61 for g in f.childNodes:
62 if g.localName=="Name":
63 name=g.childNodes[0].nodeValue;
64 elif g.localName=="Address":
65 address=g.childNodes[0].nodeValue;
66 elif g.localName=="Description":
68 description=g.childNodes[0].nodeValue;
69 elif g.localName=="Bitfield":
70 bitfields+="%17s/* %-50s */\n" % ("",self.SRF_bitfieldstr(g));
71 #print "SFRX(%10s, %s); /* %50s */" % (name,address, description);
72 print "%-10s=0x%02x; /* %-50s */" % (
73 name,self.CCpeekdatabyte(eval(address)), description);
74 if bitfields!="": print bitfields.rstrip();
76 """Returns the received signal strenght, from 0 to 1."""
77 rssireg=self.symbols.get("RSSI");
78 return self.CCpeekdatabyte(rssireg);
79 def SRF_loadsymbols(self):
81 chip=self.CCversions.get(ident&0xFF00);
82 dom=self.SRF_chipdom(chip,"register_definition.xml");
83 for e in dom.getElementsByTagName("registerdefinition"):
84 for f in e.childNodes:
85 if f.localName=="Register":
90 for g in f.childNodes:
91 if g.localName=="Name":
92 name=g.childNodes[0].nodeValue;
93 elif g.localName=="Address":
94 address=g.childNodes[0].nodeValue;
95 elif g.localName=="Description":
97 description=g.childNodes[0].nodeValue;
98 elif g.localName=="Bitfield":
99 bitfields+="%17s/* %-50s */\n" % ("",self.SRF_bitfieldstr(g));
100 #print "SFRX(%10s, %s); /* %50s */" % (name,address, description);
101 self.symbols.define(eval(address),name,description,"data");
107 self.writecmd(self.APP,0x86,0,self.data);
110 def CCreleasecpu(self):
111 """Resume the CPU."""
112 self.writecmd(self.APP,0x87,0,self.data);
116 #print "Status: %s" % self.CCstatusstr();
118 #Grab ident three times, should be equal.
119 ident1=self.CCident();
120 ident2=self.CCident();
121 ident3=self.CCident();
122 if(ident1!=ident2 or ident2!=ident3):
123 print "Error, repeated ident attempts unequal."
124 print "%04x, %04x, %04x" % (ident1, ident2, ident3);
126 #Single step, printing PC.
127 print "Tracing execution at startup."
128 for i in range(1,15):
130 byte=self.CCpeekcodebyte(i);
131 #print "PC=%04x, %02x" % (pc, byte);
134 print "Verifying that debugging a NOP doesn't affect the PC."
135 for i in range(1,15):
137 self.CCdebuginstr([0x00]);
138 if(pc!=self.CCgetPC()):
139 print "ERROR: PC changed during CCdebuginstr([NOP])!";
141 print "Checking pokes to XRAM."
142 for i in range(0xf000,0xf020):
143 self.CCpokedatabyte(i,0xde);
144 if(self.CCpeekdatabyte(i)!=0xde):
145 print "Error in XDATA at 0x%04x" % i;
147 #print "Status: %s." % self.CCstatusstr();
153 """Move the FET into the CC2430/CC2530 application."""
154 #print "Initializing Chipcon.";
155 self.writecmd(self.APP,0x10,0,self.data);
156 def CCrd_config(self):
157 """Read the config register of a Chipcon."""
158 self.writecmd(self.APP,0x82,0,self.data);
159 return ord(self.data[0]);
160 def CCwr_config(self,config):
161 """Write the config register of a Chipcon."""
162 self.writecmd(self.APP,0x81,1,[config&0xFF]);
163 def CClockchip(self):
164 """Set the flash lock bit in info mem."""
165 self.writecmd(self.APP, 0x9A, 0, None);
167 """Set the flash lock bit in info mem."""
171 CCversions={0x0100:"cc1110",
176 0xA500:"cc2530", #page 52 of SWRU191
179 CCpagesizes={0x01: 1024, #"CC1110",
180 0x85: 2048, #"CC2430",
181 0x89: 2048, #"CC2431",
182 0x81: 1024, #"CC2510",
183 0x91: 1024, #"CC2511",
184 0xA5: 2048, #"CC2530", #page 52 of SWRU191
185 0xB5: 2048, #"CC2531",
186 0xFF: 0 } #"CCmissing"};
187 def infostring(self):
188 return self.CCidentstr();
189 def CCidentstr(self):
190 ident=self.CCident();
191 chip=self.CCversions.get(ident&0xFF00);
192 return "%s/r%02x" % (chip, ident&0xFF);
194 """Get a chipcon's ID."""
195 self.writecmd(self.APP,0x8B,0,None);
196 chip=ord(self.data[0]);
197 rev=ord(self.data[1]);
198 return (chip<<8)+rev;
199 def CCpagesize(self):
200 """Get a chipcon's ID."""
201 self.writecmd(self.APP,0x8B,0,None);
202 chip=ord(self.data[0]);
203 size=self.CCpagesizes.get(chip);
205 print "ERROR: Pagesize undefined.";
206 print "chip=%02x" %chip;
211 return self.CCgetPC();
213 """Get a chipcon's PC."""
214 self.writecmd(self.APP,0x83,0,None);
215 hi=ord(self.data[0]);
216 lo=ord(self.data[1]);
218 def CCcmd(self,phrase):
219 self.writecmd(self.APP,0x00,len(phrase),phrase);
220 val=ord(self.data[0]);
221 print "Got %02x" % val;
223 def CCdebuginstr(self,instr):
224 self.writecmd(self.APP,0x88,len(instr),instr);
225 return ord(self.data[0]);
226 def peek8(self,address, memory="code"):
227 if(memory=="code" or memory=="flash" or memory=="vn"):
228 return self.CCpeekcodebyte(address);
229 elif(memory=="data" or memory=="xdata" or memory=="ram"):
230 return self.CCpeekdatabyte(address);
231 elif(memory=="idata" or memory=="iram"):
232 return self.CCpeekirambyte(address);
233 print "%s is an unknown memory." % memory;
235 def CCpeekcodebyte(self,adr):
236 """Read the contents of code memory at an address."""
237 self.data=[adr&0xff, (adr&0xff00)>>8];
238 self.writecmd(self.APP,0x90,2,self.data);
239 return ord(self.data[0]);
240 def CCpeekdatabyte(self,adr):
241 """Read the contents of data memory at an address."""
242 self.data=[adr&0xff, (adr&0xff00)>>8];
243 self.writecmd(self.APP,0x91, 2, self.data);
244 return ord(self.data[0]);
245 def CCpeekirambyte(self,adr):
246 """Read the contents of IRAM at an address."""
247 self.data=[adr&0xff];
248 self.writecmd(self.APP,0x02, 1, self.data);
249 return ord(self.data[0]);
250 def CCpeekiramword(self,adr):
251 """Read the little-endian contents of IRAM at an address."""
252 return self.CCpeekirambyte(adr)+(
253 self.CCpeekirambyte(adr+1)<<8);
254 def CCpokeiramword(self,adr,val):
255 self.CCpokeirambyte(adr,val&0xff);
256 self.CCpokeirambyte(adr+1,(val>>8)&0xff);
257 def CCpokeirambyte(self,adr,val):
258 """Write the contents of IRAM at an address."""
259 self.data=[adr&0xff, val&0xff];
260 self.writecmd(self.APP,0x02, 2, self.data);
261 return ord(self.data[0]);
263 def CCpokedatabyte(self,adr,val):
264 """Write a byte to data memory."""
265 self.data=[adr&0xff, (adr&0xff00)>>8, val];
266 self.writecmd(self.APP, 0x92, 3, self.data);
267 return ord(self.data[0]);
268 def CCchiperase(self):
269 """Erase all of the target's memory."""
270 self.writecmd(self.APP,0x80,0,None);
272 """Erase all of the target's memory."""
276 """Check the status."""
277 self.writecmd(self.APP,0x84,0,None);
278 return ord(self.data[0])
280 CCstatusbits={0x80 : "erase_busy",
284 0x08 : "halt_status",
289 CCconfigbits={0x20 : "soft_power_mode", #new for CC2530
292 0x02 : "timer_suspend",
293 0x01 : "sel_flash_info_page" #stricken from CC2530
297 """Check the status as a string."""
298 status=self.CCstatus();
303 str="%s %s" %(self.CCstatusbits[i],str);
307 """Start debugging."""
309 self.writecmd(self.APP,0x20,0,self.data);
310 ident=self.CCidentstr();
311 #print "Target identifies as %s." % ident;
312 #print "Status: %s." % self.status();
315 #Get SmartRF Studio regs if they exist.
318 #print "Status: %s." % self.status();
321 """Stop debugging."""
322 self.writecmd(self.APP,0x21,0,self.data);
323 def CCstep_instr(self):
324 """Step one instruction."""
325 self.writecmd(self.APP,0x89,0,self.data);
326 def CCeraseflashbuffer(self):
327 """Erase the 2kB flash buffer"""
328 self.writecmd(self.APP,0x99);
329 def CCflashpage(self,adr):
330 """Flash 2kB a page of flash from 0xF000 in XDATA"""
335 print "Flashing buffer to 0x%06x" % adr;
336 self.writecmd(self.APP,0x95,4,data);
337 def dump(self,file,start=0,stop=0xffff):
338 """Dump an intel hex file from code memory."""
339 print "Dumping code from %04x to %04x as %s." % (start,stop,file);
343 h[i]=self.CCpeekcodebyte(i);
345 print "Dumped %04x."%i;
346 h.write_hex_file(file); #buffer to disk.
348 h.write_hex_file(file);
350 def flash(self,file):
351 """Flash an intel hex file to code memory."""
352 print "Flashing %s" % file;
356 pagelen = self.CCpagesize(); #Varies by chip.
358 #print "page=%04x, pagelen=%04x" % (page,pagelen);
362 #Wipe the RAM buffer for the next flash page.
363 self.CCeraseflashbuffer();
364 for i in h._buf.keys():
365 while(i>=page+pagelen):
367 self.CCflashpage(page);
368 #client.CCeraseflashbuffer();
370 print "Flashed page at %06x" % page
373 #Place byte into buffer.
374 self.CCpokedatabyte(0xF000+i-page,
378 print "Buffering %04x toward %06x" % (i,page);
380 self.CCflashpage(page);
381 print "Flashed final page at %06x" % page;