Packet sniffing kinda works.
[goodfet] / client / GoodFETCC.py
1 #!/usr/bin/env python
2 # GoodFET Client Library
3
4 # (C) 2009 Travis Goodspeed <travis at radiantmachines.com>
5 #
6 # This code is being rewritten and refactored.  You've been warned!
7
8 import sys;
9 import binascii;
10
11 from GoodFET import GoodFET;
12 from intelhex import IntelHex;
13
14 import xml.dom.minidom, time;
15
16 class GoodFETCC(GoodFET):
17     """A GoodFET variant for use with Chipcon 8051 Zigbee SoC."""
18     APP=0x30;
19     
20     
21     
22     
23     smartrfpath="/opt/smartrf7";
24     def loadsymbols(self):
25         try: self.SRF_loadsymbols();
26         except:
27             if self.verbose>0: print "SmartRF not found at %s." % self.smartrfpath;
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)
32         
33     def CMDrs(self,args=[]):
34         """Chip command to grab the radio state."""
35         try:
36             self.SRF_radiostate();
37         except:
38             print "Error printing radio state.";
39             print "SmartRF not found at %s." % self.smartrfpath;
40     def SRF_bitfieldstr(self,bf):
41         name="unused";
42         start=0;
43         stop=0;
44         access="";
45         reset="0x00";
46         description="";
47         for e in bf.childNodes:
48             if e.localName=="Name" and e.childNodes: name= e.childNodes[0].nodeValue;
49             elif e.localName=="Start": start=e.childNodes[0].nodeValue;
50             elif e.localName=="Stop": stop=e.childNodes[0].nodeValue;
51         return "   [%s:%s] %30s " % (start,stop,name);
52     def SRF_radiostate(self):
53         ident=self.CCident();
54         chip=self.CCversions.get(ident&0xFF00);
55         dom=self.SRF_chipdom(chip,"register_definition.xml");
56         for e in dom.getElementsByTagName("registerdefinition"):
57             for f in e.childNodes:
58                 if f.localName=="DeviceName":
59                     print "// %s RadioState" % (f.childNodes[0].nodeValue);
60                 elif f.localName=="Register":
61                     name="unknownreg";
62                     address="0xdead";
63                     description="";
64                     bitfields="";
65                     for g in f.childNodes:
66                         if g.localName=="Name":
67                             name=g.childNodes[0].nodeValue;
68                         elif g.localName=="Address":
69                             address=g.childNodes[0].nodeValue;
70                         elif g.localName=="Description":
71                             if g.childNodes:
72                                 description=g.childNodes[0].nodeValue;
73                         elif g.localName=="Bitfield":
74                             bitfields+="%17s/* %-50s */\n" % ("",self.SRF_bitfieldstr(g));
75                     #print "SFRX(%10s, %s); /* %50s */" % (name,address, description);
76                     print "%-10s=0x%02x; /* %-50s */" % (
77                         name,self.CCpeekdatabyte(eval(address)), description);
78                     if bitfields!="": print bitfields.rstrip();
79     def RF_setfreq(self,frequency):
80         """Set the frequency in Hz."""
81         #FIXME CC1110 specific
82         
83         hz=frequency;
84         freq=int(hz/396.728515625);
85         
86         freq0=freq&0xFF;
87         freq1=(freq&0xFF00)>>8;
88         freq2=(freq&0xFF0000)>>16;
89         
90         self.pokebysym("FREQ2",freq2);
91         self.pokebysym("FREQ1",freq1);
92         self.pokebysym("FREQ0",freq0);
93         
94
95     def RF_getfreq(self):
96         """Get the frequency in Hz."""
97         #FIXME CC1110 specific
98         
99         #return (2400+self.peek(0x05))*10**6
100         #self.poke(0x05,chan);
101         
102         #freq2=self.CCpeekdatabyte(0xdf09);
103         #freq1=self.CCpeekdatabyte(0xdf0a);
104         #freq0=self.CCpeekdatabyte(0xdf0b);
105         freq=0;
106         try:
107             freq2=self.peekbysym("FREQ2");
108             freq1=self.peekbysym("FREQ1");
109             freq0=self.peekbysym("FREQ0");
110             freq=(freq2<<16)+(freq1<<8)+freq0;
111         except:
112             freq=0;
113             
114         hz=freq*396.728515625;
115         
116         return hz;
117     def shellcodefile(self,filename,wait=1):
118         """Run a fragment of shellcode by name."""
119         #FIXME: should identify chip model number, use shellcode for that chip.
120         file=__file__;
121         file=file.replace("GoodFETCC.pyc","GoodFETCC.py");
122         path=file.replace("client/GoodFETCC.py","shellcode/chipcon/cc1110/");
123         #print "File\t%s" % file;
124         #print "Path\t%s" % path;
125         filename=path+filename;
126         #print "Loading shelcode from %s" % filename;
127         
128         #Load the shellcode.
129         h=IntelHex(filename);
130         for i in h._buf.keys():
131             self.CCpokedatabyte(i,h[i]);
132         
133         #Execute it.
134         self.CCdebuginstr([0x02, 0xf0, 0x00]); #ljmp 0xF000
135         self.resume();
136         while wait>0 and (0==self.CCstatus()&0x20):
137             time.sleep(0.1);
138             #print "Waiting for shell code to return.";
139         return;
140     def shellcode(self,code,wait=1):
141         """Copy a block of code into RAM and execute it."""
142         i=0;
143         ram=0xF000;
144         for byte in code:
145             self.pokebyte(0xF000+i,byte);
146             i=i+1;
147         #print "Code loaded, executing."
148         self.CCdebuginstr([0x02, 0xf0, 0x00]); #ljmp 0xF000
149         self.resume();
150         while wait>0 and (0==self.CCstatus()&0x20):
151             time.sleep(0.1);
152             #print "Waiting for shell code to return.";
153         return;
154     def CC1110_crystal(self):
155         """Start the main crystal of the CC1110 oscillating, needed for radio use."""
156         code=[0x53, 0xBE, 0xFB, #anl SLEEP, #0xFB
157               #one:
158               0xE5, 0xBE,       #mov a,SLEEP
159               0x30, 0xE6, 0xFB, #jnb acc.6, back
160               0x53, 0xc6, 0xB8, #anl CLKCON, #0xB8
161               #two
162               0xE5, 0xC6,       #mov a,CLKCON
163               0x20, 0xE6, 0xFB, #jb acc.6, two
164               0x43, 0xBE, 0x04, #orl SLEEP, #0x04
165               0xA5,             #HALT
166               ];
167         self.shellcode(code);
168         
169         #Slower to load, but produced from C.
170         #self.shellcodefile("crystal.ihx");
171         return;
172     def RF_idle(self):
173         """Move the radio to its idle state."""
174         self.CC_RFST_IDLE();
175         return;
176     
177     #Chipcon RF strobes.  CC1110 specific
178     RFST_IDLE=0x04;
179     RFST_RX=0x02;
180     RFST_TX=0x03;
181     RFST_CAL=0x01;
182     def CC_RFST_IDLE(self):
183         """Switch the radio to idle mode, clearing overflows and errors."""
184         self.CC_RFST(self.RFST_IDLE);
185     def CC_RFST_TX(self):
186         """Switch the radio to TX mode."""
187         self.CC_RFST(self.RFST_TX);
188     def CC_RFST_RX(self):
189         """Switch the radio to RX mode."""
190         self.CC_RFST(self.RFST_RX);
191     def CC_RFST_CAL(self):
192         """Calibrate strobe the radio."""
193         self.CC_RFST(self.RFST_CAL);
194     def CC_RFST(self,state=RFST_IDLE):
195         RFST=0xDFE1
196         self.pokebyte(RFST,state); #Return to idle state.
197         return;
198         
199     def config_simpliciti(self,band="none"):
200         self.pokebysym("FSCTRL1"  , 0x08)   # Frequency synthesizer control.
201         self.pokebysym("FSCTRL0"  , 0x00)   # Frequency synthesizer control.
202         
203         #Don't change these while the radio is active.
204         self.pokebysym("FSCAL3"   , 0xEA)   # Frequency synthesizer calibration.
205         self.pokebysym("FSCAL2"   , 0x2A)   # Frequency synthesizer calibration.
206         self.pokebysym("FSCAL1"   , 0x00)   # Frequency synthesizer calibration.
207         self.pokebysym("FSCAL0"   , 0x1F)   # Frequency synthesizer calibration.
208         
209         if band=="ismeu" or band=="eu":
210             self.pokebysym("FREQ2"    , 0x21)   # Frequency control word, high byte.
211             self.pokebysym("FREQ1"    , 0x71)   # Frequency control word, middle byte.
212             self.pokebysym("FREQ0"    , 0x7a)   # Frequency control word, low byte.
213         if band=="ismus" or band=="us":
214             self.pokebysym("FREQ2"    , 0x22)   # Frequency control word, high byte.
215             self.pokebysym("FREQ1"    , 0xB1)   # Frequency control word, middle byte.
216             self.pokebysym("FREQ0"    , 0x3B)   # Frequency control word, low byte.
217         if band=="ismlf" or band=="lf":
218             self.pokebysym("FREQ2"    , 0x10)   # Frequency control word, high byte.
219             self.pokebysym("FREQ1"    , 0xB0)   # Frequency control word, middle byte.
220             self.pokebysym("FREQ0"    , 0x71)   # Frequency control word, low byte.
221         
222         self.pokebysym("MDMCFG4"  , 0x7B)   # Modem configuration.
223         self.pokebysym("MDMCFG3"  , 0x83)   # Modem configuration.
224         self.pokebysym("MDMCFG2"  , 0x13)   # Modem configuration.
225         self.pokebysym("MDMCFG1"  , 0x22)   # Modem configuration.
226         self.pokebysym("MDMCFG0"  , 0xF8)   # Modem configuration.
227         if band=="ismus" or band=="us":
228             self.pokebysym("CHANNR"   , 0); # 20)   # Channel number.
229         else:
230             self.pokebysym("CHANNR"   , 0x00)   # Channel number.
231         self.pokebysym("DEVIATN"  , 0x42)   # Modem deviation setting (when FSK modulation is enabled).
232         
233         self.pokebysym("FREND1"   , 0xB6)   # Front end RX configuration.
234         self.pokebysym("FREND0"   , 0x10)   # Front end RX configuration.
235         self.pokebysym("MCSM0"    , 0x18)   # Main Radio Control State Machine configuration.
236         self.pokebysym("FOCCFG"   , 0x1D)   # Frequency Offset Compensation Configuration.
237         self.pokebysym("BSCFG"    , 0x1C)   # Bit synchronization Configuration.
238         
239         self.pokebysym("AGCCTRL2" , 0xC7)   # AGC control.
240         self.pokebysym("AGCCTRL1" , 0x00)   # AGC control.
241         self.pokebysym("AGCCTRL0" , 0xB2)   # AGC control.
242         
243         self.pokebysym("TEST2"    , 0x81)   # Various test settings.
244         self.pokebysym("TEST1"    , 0x35)   # Various test settings.
245         self.pokebysym("TEST0"    , 0x09)   # Various test settings.
246         #self.pokebysym("PA_TABLE0", 0xC0)   # PA output power setting.
247         self.pokebysym("PKTCTRL1" , 0x04)   # Packet automation control.
248         #self.pokebysym("PKTCTRL0" , 0x05)   # Packet automation control, w/ checksum.
249         self.pokebysym("PKTCTRL0" , 0x01)   # Packet automation control, w/o checksum.
250         self.pokebysym("ADDR"     , 0x00)   # Device address.
251         self.pokebysym("PKTLEN"   , 0xFF)   # Packet length.
252         
253         self.pokebysym("SYNC1",0x04);
254         self.pokebysym("SYNC0",0x05);
255         
256     def RF_carrier(self):
257         """Hold a carrier wave on the present frequency."""
258         
259         self.CC1110_crystal(); #FIXME, '1110 specific.
260         self.RF_idle();
261         
262         #self.resume();
263         #time.sleep(1);
264         #self.halt();
265         
266         RFST=0xDFE1;
267         
268         
269         self.pokebysym("FSCTRL1"  , 0x0a)   # Frequency synthesizer control.
270         self.pokebysym("FSCTRL0"  , 0x00)   # Frequency synthesizer control.
271         
272         #Don't change these while the radio is active.
273         self.pokebysym("FSCAL3"   , 0xA9)   # Frequency synthesizer calibration.
274         self.pokebysym("FSCAL2"   , 0x0A)   # Frequency synthesizer calibration.
275         self.pokebysym("FSCAL1"   , 0x00)   # Frequency synthesizer calibration.
276         self.pokebysym("FSCAL0"   , 0x11)   # Frequency synthesizer calibration.
277         
278         
279         #self.pokebysym("FREQ2"    , 0x10)   # Frequency control word, high byte.
280         #self.pokebysym("FREQ1"    , 0xEC)   # Frequency control word, middle byte.
281         #self.pokebysym("FREQ0"    , 0x4E)   # Frequency control word, low byte.
282         self.pokebysym("MDMCFG4"  , 0x86)   # Modem configuration.
283         self.pokebysym("MDMCFG3"  , 0x83)   # Modem configuration.
284         self.pokebysym("MDMCFG2"  , 0x30)   # Modem configuration.
285         self.pokebysym("MDMCFG1"  , 0x22)   # Modem configuration.
286         self.pokebysym("MDMCFG0"  , 0xF8)   # Modem configuration.
287         self.pokebysym("CHANNR"   , 0x00)   # Channel number.
288         self.pokebysym("DEVIATN"  , 0x00)   # Modem deviation setting (when FSK modulation is enabled).
289         self.pokebysym("FREND1"   , 0x56)   # Front end RX configuration.
290         
291         self.pokebysym("FREND0"   , 0x10)   # Front end RX configuration.
292         self.pokebysym("MCSM0"    , 0x14)   # Main Radio Control State Machine configuration.
293         self.pokebysym("FOCCFG"   , 0x16)   # Frequency Offset Compensation Configuration.
294         self.pokebysym("BSCFG"    , 0x6C)   # Bit synchronization Configuration.
295         
296         self.pokebysym("AGCCTRL2" , 0x03)   # AGC control.
297         self.pokebysym("AGCCTRL1" , 0x40)   # AGC control.
298         self.pokebysym("AGCCTRL0" , 0x91)   # AGC control.
299         
300         self.pokebysym("TEST2"    , 0x88)   # Various test settings.
301         self.pokebysym("TEST1"    , 0x31)   # Various test settings.
302         self.pokebysym("TEST0"    , 0x09)   # Various test settings.
303         self.pokebysym("PA_TABLE0", 0xC0)   # PA output power setting.
304         self.pokebysym("PKTCTRL1" , 0x04)   # Packet automation control.
305         self.pokebysym("PKTCTRL0" , 0x22)   # Packet automation control.
306         self.pokebysym("ADDR"     , 0x00)   # Device address.
307         self.pokebysym("PKTLEN"   , 0xFF)   # Packet length.
308         
309         self.pokebysym("SYNC1",0xAA);
310         self.pokebysym("SYNC0",0xAA);
311         
312         
313         
314         #while ((MARCSTATE & MARCSTATE_MARC_STATE) != MARC_STATE_TX); 
315         state=0;
316         
317         while((state!=0x13)):
318             self.pokebyte(RFST,0x03); #RFST=RFST_STX
319             time.sleep(0.1);
320             state=self.peekbysym("MARCSTATE")&0x1F;
321             #print "state=%02x" % state;
322         print "Holding a carrier on %f MHz." % (self.RF_getfreq()/10**6);
323         
324         #Not needed, radio works when CPU is halted.
325         #self.resume();
326         
327         return;
328             
329     def RF_getsmac(self):
330         """Return the source MAC address."""
331         
332         #Register 0A is RX_ADDR_P0, five bytes.
333         mac=self.peekbysym("ADDR");
334         return mac;
335     def RF_setsmac(self,mac):
336         """Set the source MAC address."""
337         self.pokebysym("ADDR",mac);
338         return 0;
339     def RF_gettmac(self):
340         """Return the target MAC address."""
341         return 0;
342     def RF_settmac(self,mac):
343         """Set the target MAC address."""
344         return 0;
345     def RF_rxpacket(self):
346         """Get a packet from the radio.  Returns None if none is waiting."""
347         RFST=0xDFE1
348         self.pokebyte(RFST,0x01); #SCAL
349         #self.pokebyte(RFST,0x02); #SRX
350         
351         self.shellcodefile("rxpacket.ihx");
352         #time.sleep(1);
353         self.halt();
354         return self.peekblock(0xFE00,32,"data");
355     def RF_txpacket(self,payload):
356         """Transmit a packet.  Untested."""
357         
358         print "FIXME, Chipcon packet transmission is not yet implemented.";
359         return;
360
361     def RF_getrssi(self):
362         """Returns the received signal strenght, with a weird offset."""
363         try:
364             rssireg=self.symbols.get("RSSI");
365             return self.CCpeekdatabyte(rssireg)^0x80;
366         except:
367             if self.verbose>0: print "RSSI reg doesn't exist.";
368         try:
369             #RSSI doesn't exist on 2.4GHz devices.  Maybe RSSIL and RSSIH?
370             rssilreg=self.symbols.get("RSSIL");
371             rssil=self.CCpeekdatabyte(rssilreg);
372             rssihreg=self.symbols.get("RSSIL");
373             rssih=self.CCpeekdatabyte(rssihreg);
374             return (rssih<<8)|rssil;
375         except:
376             if self.verbose>0: print "RSSIL/RSSIH regs don't exist.";
377         
378         return 0;
379     
380     
381     
382     def SRF_loadsymbols(self):
383         ident=self.CCident();
384         chip=self.CCversions.get(ident&0xFF00);
385         dom=self.SRF_chipdom(chip,"register_definition.xml");
386         for e in dom.getElementsByTagName("registerdefinition"):
387             for f in e.childNodes:
388                 if f.localName=="Register":
389                     name="unknownreg";
390                     address="0xdead";
391                     description="";
392                     bitfields="";
393                     for g in f.childNodes:
394                         if g.localName=="Name":
395                             name=g.childNodes[0].nodeValue;
396                         elif g.localName=="Address":
397                             address=g.childNodes[0].nodeValue;
398                         elif g.localName=="Description":
399                             if g.childNodes:
400                                 description=g.childNodes[0].nodeValue;
401                         elif g.localName=="Bitfield":
402                             bitfields+="%17s/* %-50s */\n" % ("",self.SRF_bitfieldstr(g));
403                     #print "SFRX(%10s, %s); /* %50s */" % (name,address, description);
404                     self.symbols.define(eval(address),name,description,"data");
405     def halt(self):
406         """Halt the CPU."""
407         self.CChaltcpu();
408     def CChaltcpu(self):
409         """Halt the CPU."""
410         self.writecmd(self.APP,0x86,0,self.data);
411     def resume(self):
412         self.CCreleasecpu();
413     def CCreleasecpu(self):
414         """Resume the CPU."""
415         self.writecmd(self.APP,0x87,0,self.data);
416     def test(self):
417         self.CCreleasecpu();
418         self.CChaltcpu();
419         #print "Status: %s" % self.CCstatusstr();
420         
421         #Grab ident three times, should be equal.
422         ident1=self.CCident();
423         ident2=self.CCident();
424         ident3=self.CCident();
425         if(ident1!=ident2 or ident2!=ident3):
426             print "Error, repeated ident attempts unequal."
427             print "%04x, %04x, %04x" % (ident1, ident2, ident3);
428         
429         #Single step, printing PC.
430         print "Tracing execution at startup."
431         for i in range(1,15):
432             pc=self.CCgetPC();
433             byte=self.CCpeekcodebyte(i);
434             #print "PC=%04x, %02x" % (pc, byte);
435             self.CCstep_instr();
436         
437         print "Verifying that debugging a NOP doesn't affect the PC."
438         for i in range(1,15):
439             pc=self.CCgetPC();
440             self.CCdebuginstr([0x00]);
441             if(pc!=self.CCgetPC()):
442                 print "ERROR: PC changed during CCdebuginstr([NOP])!";
443         
444         print "Checking pokes to XRAM."
445         for i in range(0xf000,0xf020):
446             self.CCpokedatabyte(i,0xde);
447             if(self.CCpeekdatabyte(i)!=0xde):
448                 print "Error in XDATA at 0x%04x" % i;
449         
450         #print "Status: %s." % self.CCstatusstr();
451         #Exit debugger
452         self.stop();
453         print "Done.";
454
455     def setup(self):
456         """Move the FET into the CC2430/CC2530 application."""
457         #print "Initializing Chipcon.";
458         self.writecmd(self.APP,0x10,0,self.data);
459     def CCrd_config(self):
460         """Read the config register of a Chipcon."""
461         self.writecmd(self.APP,0x82,0,self.data);
462         return ord(self.data[0]);
463     def CCwr_config(self,config):
464         """Write the config register of a Chipcon."""
465         self.writecmd(self.APP,0x81,1,[config&0xFF]);
466     def CClockchip(self):
467         """Set the flash lock bit in info mem."""
468         self.writecmd(self.APP, 0x9A, 0, None);
469     def lock(self):
470         """Set the flash lock bit in info mem."""
471         self.CClockchip();
472     
473
474     CCversions={0x0100:"cc1110",
475                 0x1100:"cc1111",
476                 0x8500:"cc2430",
477                 0x8900:"cc2431",
478                 0x8100:"cc2510",
479                 0x9100:"cc2511",
480                 0xA500:"cc2530", #page 52 of SWRU191
481                 0xB500:"cc2531",
482                 0xFF00:"CCmissing"};
483     CCpagesizes={0x01: 1024, #"CC1110",
484                  0x11: 1024, #"CC1111",
485                  0x85: 2048, #"CC2430",
486                  0x89: 2048, #"CC2431",
487                  0x81: 1024, #"CC2510",
488                  0x91: 1024, #"CC2511",
489                  0xA5: 2048, #"CC2530", #page 52 of SWRU191
490                  0xB5: 2048, #"CC2531",
491                  0xFF: 0    } #"CCmissing"};
492     def infostring(self):
493         return self.CCidentstr();
494     def CCidentstr(self):
495         ident=self.CCident();
496         chip=self.CCversions.get(ident&0xFF00);
497         pagesize=self.CCpagesizes.get(ident>0xFF);
498         try:
499             return "%s/r%0.4x/ps0x%0.4x" % (chip, ident, pagesize); 
500         except:
501             return "%04x" % ident;
502     def CCident(self):
503         """Get a chipcon's ID."""
504         self.writecmd(self.APP,0x8B,0,None);
505         chip=ord(self.data[0]);
506         rev=ord(self.data[1]);
507         return (chip<<8)+rev;
508     def CCpagesize(self):
509         """Get a chipcon's ID."""
510         self.writecmd(self.APP,0x8B,0,None);
511         chip=ord(self.data[0]);
512         size=self.CCpagesizes.get(chip);
513         if(size<10):
514             print "ERROR: Pagesize undefined.";
515             print "chip=%0.4x" %chip;
516             sys.exit(1);
517             #return 2048;
518         return size;
519     def getpc(self):
520         return self.CCgetPC();
521     def CCgetPC(self):
522         """Get a chipcon's PC."""
523         self.writecmd(self.APP,0x83,0,None);
524         hi=ord(self.data[0]);
525         lo=ord(self.data[1]);
526         return (hi<<8)+lo;
527     def CCcmd(self,phrase):
528         self.writecmd(self.APP,0x00,len(phrase),phrase);
529         val=ord(self.data[0]);
530         print "Got %02x" % val;
531         return val;
532     def CCdebuginstr(self,instr):
533         self.writecmd(self.APP,0x88,len(instr),instr);
534         return ord(self.data[0]);
535     #def peekblock(self,adr,length,memory="vn"):
536     #    """Return a block of data, broken"""
537     #    data=[adr&0xff, (adr&0xff00)>>8,
538     #          length&0xFF,(length&0xFF00)>>8];
539     #    self.writecmd(self.APP,0x91,4,data);
540     #    return [ord(x) for x in self.data]
541     def peek8(self,address, memory="code"):
542         if(memory=="code" or memory=="flash" or memory=="vn"):
543             return self.CCpeekcodebyte(address);
544         elif(memory=="data" or memory=="xdata" or memory=="ram"):
545             return self.CCpeekdatabyte(address);
546         elif(memory=="idata" or memory=="iram"):
547             return self.CCpeekirambyte(address);
548         print "%s is an unknown memory." % memory;
549         return 0xdead;
550     def CCpeekcodebyte(self,adr):
551         """Read the contents of code memory at an address."""
552         self.data=[adr&0xff, (adr&0xff00)>>8];
553         self.writecmd(self.APP,0x90,2,self.data);
554         return ord(self.data[0]);
555     def CCpeekdatabyte(self,adr):
556         """Read the contents of data memory at an address."""
557         self.data=[adr&0xff, (adr&0xff00)>>8];
558         self.writecmd(self.APP,0x91, 2, self.data);
559         return ord(self.data[0]);
560     def CCpeekirambyte(self,adr):
561         """Read the contents of IRAM at an address."""
562         self.data=[adr&0xff];
563         self.writecmd(self.APP,0x02, 1, self.data);
564         return ord(self.data[0]);
565     def CCpeekiramword(self,adr):
566         """Read the little-endian contents of IRAM at an address."""
567         return self.CCpeekirambyte(adr)+(
568             self.CCpeekirambyte(adr+1)<<8);
569     def CCpokeiramword(self,adr,val):
570         self.CCpokeirambyte(adr,val&0xff);
571         self.CCpokeirambyte(adr+1,(val>>8)&0xff);
572     def CCpokeirambyte(self,adr,val):
573         """Write the contents of IRAM at an address."""
574         self.data=[adr&0xff, val&0xff];
575         self.writecmd(self.APP,0x02, 2, self.data);
576         return ord(self.data[0]);
577     def pokebyte(self,adr,val,mem="data"):
578         if mem!="data":
579             print "FIXME: poking of non data bytes not yet supported.";
580         self.CCpokedatabyte(adr,val);
581     def CCpokedatabyte(self,adr,val):
582         """Write a byte to data memory."""
583         self.data=[adr&0xff, (adr&0xff00)>>8, val];
584         self.writecmd(self.APP, 0x92, 3, self.data);
585         return ord(self.data[0]);
586     def CCchiperase(self):
587         """Erase all of the target's memory."""
588         self.writecmd(self.APP,0x80,0,None);
589     def erase(self):
590         """Erase all of the target's memory."""
591         self.CCchiperase();
592         self.start();
593     
594     def CCstatus(self):
595         """Check the status."""
596         self.writecmd(self.APP,0x84,0,None);
597         return ord(self.data[0])
598     #Same as CC2530
599     CCstatusbits={0x80 : "erase_busy",
600                   0x40 : "pcon_idle",
601                   0x20 : "cpu_halted",
602                   0x10 : "pm0",
603                   0x08 : "halt_status",
604                   0x04 : "locked",
605                   0x02 : "oscstable",
606                   0x01 : "overflow"
607                   };
608     CCconfigbits={0x20 : "soft_power_mode",   #new for CC2530
609                   0x08 : "timers_off",
610                   0x04 : "dma_pause",
611                   0x02 : "timer_suspend",
612                   0x01 : "sel_flash_info_page" #stricken from CC2530
613                   };
614                   
615     def status(self):
616         """Check the status as a string."""
617         status=self.CCstatus();
618         str="";
619         i=1;
620         while i<0x100:
621             if(status&i):
622                 str="%s %s" %(self.CCstatusbits[i],str);
623             i*=2;
624         return str;
625     def start(self):
626         """Start debugging."""
627         self.setup();
628         self.writecmd(self.APP,0x20,0,self.data);
629         ident=self.CCidentstr();
630         #print "Target identifies as %s." % ident;
631         #print "Status: %s." % self.status();
632         self.CCreleasecpu();
633         self.CChaltcpu();
634         #Get SmartRF Studio regs if they exist.
635         self.loadsymbols(); 
636         
637     def stop(self):
638         """Stop debugging."""
639         self.writecmd(self.APP,0x21,0,self.data);
640     def CCstep_instr(self):
641         """Step one instruction."""
642         self.writecmd(self.APP,0x89,0,self.data);
643     def CCeraseflashbuffer(self):
644         """Erase the 2kB flash buffer"""
645         self.writecmd(self.APP,0x99);
646     def CCflashpage(self,adr):
647         """Flash 2kB a page of flash from 0xF000 in XDATA"""
648         data=[adr&0xFF,
649               (adr>>8)&0xFF,
650               (adr>>16)&0xFF,
651               (adr>>24)&0xFF];
652         print "Flashing buffer to 0x%06x" % adr;
653         self.writecmd(self.APP,0x95,4,data);
654     
655     def setsecret(self,value):
656         """Set a secret word for later retreival.  Used by glitcher."""
657         page = 0x0000;
658         pagelen = self.CCpagesize(); #Varies by chip.
659         print "page=%04x, pagelen=%04x" % (page,pagelen);
660         
661         self.CCeraseflashbuffer();
662         print "Setting secret to %x" % value;
663         self.CCpokedatabyte(0xF000,value);
664         self.CCpokedatabyte(0xF800,value);
665         print "Setting secret to %x==%x" % (value,
666                                             self.CCpeekdatabyte(0xf000));
667         self.CCflashpage(0);
668         print "code[0]=%x" % self.CCpeekcodebyte(0);
669     def getsecret(self):
670         """Get a secret word.  Used by glitcher."""
671         secret=self.CCpeekcodebyte(0);
672         #print "Got secret %02x" % secret;
673         return secret;
674     
675     def dump(self,file,start=0,stop=0xffff):
676         """Dump an intel hex file from code memory."""
677         print "Dumping code from %04x to %04x as %s." % (start,stop,file);
678         h = IntelHex(None);
679         i=start;
680         while i<=stop:
681             h[i]=self.CCpeekcodebyte(i);
682             if(i%0x100==0):
683                 print "Dumped %04x."%i;
684                 h.write_hex_file(file); #buffer to disk.
685             i+=1;
686         h.write_hex_file(file);
687
688     def flash(self,file):
689         """Flash an intel hex file to code memory."""
690         print "Flashing %s" % file;
691         
692         h = IntelHex(file);
693         page = 0x0000;
694         pagelen = self.CCpagesize(); #Varies by chip.
695         
696         #print "page=%04x, pagelen=%04x" % (page,pagelen);
697         
698         bcount = 0;
699         
700         #Wipe the RAM buffer for the next flash page.
701         self.CCeraseflashbuffer();
702         for i in h._buf.keys():
703             while(i>=page+pagelen):
704                 if bcount>0:
705                     self.CCflashpage(page);
706                     #client.CCeraseflashbuffer();
707                     bcount=0;
708                     print "Flashed page at %06x" % page
709                 page+=pagelen;
710                     
711             #Place byte into buffer.
712             self.CCpokedatabyte(0xF000+i-page,
713                                 h[i]);
714             bcount+=1;
715             if(i%0x100==0):
716                 print "Buffering %04x toward %06x" % (i,page);
717         #last page
718         self.CCflashpage(page);
719         print "Flashed final page at %06x" % page;
720