git.rot13.org Git - goodfet/blob - 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         #Some frequencies fail, probably and FSCAL thing.
  83
  84         hz=frequency;
  85         freq=int(hz/396.728515625);
  86
  87         freq0=freq&0xFF;
  88         freq1=(freq&0xFF00)>>8;
  89         freq2=(freq&0xFF0000)>>16;
  90
  91         self.pokebysym("FREQ2",freq2);
  92         self.pokebysym("FREQ1",freq1);
  93         self.pokebysym("FREQ0",freq0);
  94
  95         self.pokebysym("TEST1",0x31);
  96         self.pokebysym("TEST0",0x09);
  97
  98
  99         #self.pokebysym("FSCAL2" ,   0x2A);  #above mid
 100         self.pokebysym("FSCAL2" ,   0x0A);  #beneath mid
 101
 102         #self.CC_RFST_CAL(); #SCAL
 103         #time.sleep(1);
 104
 105
 106     def RF_getfreq(self):
 107         """Get the frequency in Hz."""
 108         #FIXME CC1110 specific
 109
 110         #return (2400+self.peek(0x05))*10**6
 111         #self.poke(0x05,chan);
 112
 113         #freq2=self.CCpeekdatabyte(0xdf09);
 114         #freq1=self.CCpeekdatabyte(0xdf0a);
 115         #freq0=self.CCpeekdatabyte(0xdf0b);
 116         freq=0;
 117         try:
 118             freq2=self.peekbysym("FREQ2");
 119             freq1=self.peekbysym("FREQ1");
 120             freq0=self.peekbysym("FREQ0");
 121             freq=(freq2<<16)+(freq1<<8)+freq0;
 122         except:
 123             freq=0;
 124
 125         hz=freq*396.728515625;
 126
 127         return hz;
 128     lastshellcode="none";
 129     def shellcodefile(self,filename,wait=1):
 130         """Run a fragment of shellcode by name."""
 131         #FIXME: should identify chip model number, use shellcode for that chip.
 132
 133         if self.lastshellcode!=filename:
 134             self.lastshellcode=filename;
 135             file=__file__;
 136             file=file.replace("GoodFETCC.pyc","GoodFETCC.py");
 137             path=file.replace("GoodFETCC.py","shellcode/chipcon/cc1110/");
 138             filename=path+filename;
 139
 140             #Load the shellcode.
 141             h=IntelHex(filename);
 142             for i in h._buf.keys():
 143                 self.CCpokedatabyte(i,h[i]);
 144
 145         #Execute it.
 146         self.CCdebuginstr([0x02, 0xf0, 0x00]); #ljmp 0xF000
 147         self.resume();
 148         while wait>0 and (0==self.CCstatus()&0x20):
 149             a=1;
 150             #time.sleep(0.1);
 151             #print "Waiting for shell code to return.";
 152         return;
 153     def ishalted(self):
 154         return self.CCstatus()&0x20;
 155     def shellcode(self,code,wait=1):
 156         """Copy a block of code into RAM and execute it."""
 157         i=0;
 158         ram=0xF000;
 159         for byte in code:
 160             self.pokebyte(0xF000+i,byte);
 161             i=i+1;
 162         #print "Code loaded, executing."
 163         self.CCdebuginstr([0x02, 0xf0, 0x00]); #ljmp 0xF000
 164         self.resume();
 165         while wait>0 and (0==self.CCstatus()&0x20):
 166             a=1;
 167             #time.sleep(0.1);
 168             #print "Waiting for shell code to return.";
 169         return;
 170     def CC1110_crystal(self):
 171         """Start the main crystal of the CC1110 oscillating, needed for radio use."""
 172         code=[0x53, 0xBE, 0xFB, #anl SLEEP, #0xFB
 173               #one:
 174               0xE5, 0xBE,       #mov a,SLEEP
 175               0x30, 0xE6, 0xFB, #jnb acc.6, back
 176               0x53, 0xc6, 0xB8, #anl CLKCON, #0xB8
 177               #two
 178               0xE5, 0xC6,       #mov a,CLKCON
 179               0x20, 0xE6, 0xFB, #jb acc.6, two
 180               0x43, 0xBE, 0x04, #orl SLEEP, #0x04
 181               0xA5,             #HALT
 182               ];
 183         self.shellcode(code);
 184
 185         #Slower to load, but produced from C.
 186         #self.shellcodefile("crystal.ihx");
 187         return;
 188     def RF_idle(self):
 189         """Move the radio to its idle state."""
 190         self.CC_RFST_IDLE();
 191         return;
 192
 193     #Chipcon RF strobes.  CC1110 specific
 194     RFST_IDLE=0x04;
 195     RFST_RX=0x02;
 196     RFST_TX=0x03;
 197     RFST_CAL=0x01;
 198     def CC_RFST_IDLE(self):
 199         """Switch the radio to idle mode, clearing overflows and errors."""
 200         self.CC_RFST(self.RFST_IDLE);
 201     def CC_RFST_TX(self):
 202         """Switch the radio to TX mode."""
 203         self.CC_RFST(self.RFST_TX);
 204     def CC_RFST_RX(self):
 205         """Switch the radio to RX mode."""
 206         self.CC_RFST(self.RFST_RX);
 207     def CC_RFST_CAL(self):
 208         """Calibrate strobe the radio."""
 209         self.CC_RFST(self.RFST_CAL);
 210     def CC_RFST(self,state=RFST_IDLE):
 211         RFST=0xDFE1
 212         self.pokebyte(RFST,state); #Return to idle state.
 213         return;
 214     def config_dash7(self,band="lf"):
 215         #These settings came from the OpenTag project's GIT repo on 18 Dec, 2010.
 216         #Waiting for official confirmation of the accuracy.
 217
 218         self.pokebysym("FSCTRL1"  , 0x08)   # Frequency synthesizer control.
 219         self.pokebysym("FSCTRL0"  , 0x00)   # Frequency synthesizer control.
 220
 221         #Don't change these while the radio is active.
 222         self.pokebysym("FSCAL3"   , 0xEA)   # Frequency synthesizer calibration.
 223         self.pokebysym("FSCAL2"   , 0x2A)   # Frequency synthesizer calibration.
 224         self.pokebysym("FSCAL1"   , 0x00)   # Frequency synthesizer calibration.
 225         self.pokebysym("FSCAL0"   , 0x1F)   # Frequency synthesizer calibration.
 226
 227         if band=="ismeu" or band=="eu":
 228             print "There is no official eu band for dash7."
 229             self.pokebysym("FREQ2"    , 0x21)   # Frequency control word, high byte.
 230             self.pokebysym("FREQ1"    , 0x71)   # Frequency control word, middle byte.
 231             self.pokebysym("FREQ0"    , 0x7a)   # Frequency control word, low byte.
 232         elif band=="ismus" or band=="us":
 233             print "There is no official us band for dash7."
 234             self.pokebysym("FREQ2"    , 0x22)   # Frequency control word, high byte.
 235             self.pokebysym("FREQ1"    , 0xB1)   # Frequency control word, middle byte.
 236             self.pokebysym("FREQ0"    , 0x3B)   # Frequency control word, low byte.
 237         elif band=="ismlf" or band=="lf":
 238             # 433.9198 MHz, same as Simpliciti.
 239             self.pokebysym("FREQ2"    , 0x10)   # Frequency control word, high byte.
 240             self.pokebysym("FREQ1"    , 0xB0)   # Frequency control word, middle byte.
 241             self.pokebysym("FREQ0"    , 0x71)   # Frequency control word, low byte.
 242         elif band=="none":
 243             pass;
 244         else:
 245             #Got a frequency, not a band.
 246             self.RF_setfreq(eval(band));
 247         self.pokebysym("MDMCFG4"  , 0x8B)   # 62.5 kbps w/ 200 kHz filter
 248         self.pokebysym("MDMCFG3"  , 0x3B)
 249         self.pokebysym("MDMCFG2"  , 0x11)
 250         self.pokebysym("MDMCFG1"  , 0x02)
 251         self.pokebysym("MDMCFG0"  , 0x53)
 252         self.pokebysym("CHANNR"   , 0x00)   # Channel zero.
 253         self.pokebysym("DEVIATN"  , 0x50)   # 50 kHz deviation
 254
 255         self.pokebysym("FREND1"   , 0xB6)   # Front end RX configuration.
 256         self.pokebysym("FREND0"   , 0x10)   # Front end RX configuration.
 257         self.pokebysym("MCSM2"    , 0x1E)
 258         self.pokebysym("MCSM1"    , 0x3F)
 259         self.pokebysym("MCSM0"    , 0x30)
 260         self.pokebysym("FOCCFG"   , 0x1D)   # Frequency Offset Compensation Configuration.
 261         self.pokebysym("BSCFG"    , 0x1E)   # 6.25% data error rate
 262
 263         self.pokebysym("AGCCTRL2" , 0xC7)   # AGC control.
 264         self.pokebysym("AGCCTRL1" , 0x00)   # AGC control.
 265         self.pokebysym("AGCCTRL0" , 0xB2)   # AGC control.
 266
 267         self.pokebysym("TEST2"    , 0x81)   # Various test settings.
 268         self.pokebysym("TEST1"    , 0x35)   # Various test settings.
 269         self.pokebysym("TEST0"    , 0x09)   # Various test settings.
 270         self.pokebysym("PA_TABLE0", 0xc0)   # Max output power.
 271         self.pokebysym("PKTCTRL1" , 0x04)   # Packet automation control, w/ lqi
 272         #self.pokebysym("PKTCTRL1" , 0x00)   # Packet automation control. w/o lqi
 273         self.pokebysym("PKTCTRL0" , 0x05)   # Packet automation control, w/ checksum.
 274         #self.pokebysym("PKTCTRL0" , 0x00)   # Packet automation control, w/o checksum, fixed length
 275         self.pokebysym("ADDR"     , 0x01)   # Device address.
 276         self.pokebysym("PKTLEN"   , 0xFF)   # Packet length.
 277
 278         self.pokebysym("SYNC1",0xD3);
 279         self.pokebysym("SYNC0",0x91);
 280         return;
 281     def config_iclicker(self,band="lf"):
 282         #Mike Ossmann figured most of this out, with help from neighbors.
 283
 284         self.pokebysym("FSCTRL1"  , 0x06)   # Frequency synthesizer control.
 285         self.pokebysym("FSCTRL0"  , 0x00)   # Frequency synthesizer control.
 286
 287         #Don't change these while the radio is active.
 288         self.pokebysym("FSCAL3"   , 0xE9)
 289         self.pokebysym("FSCAL2"   , 0x2A)
 290         self.pokebysym("FSCAL1"   , 0x00)
 291         self.pokebysym("FSCAL0"   , 0x1F)
 292
 293         if band=="ismeu" or band=="eu":
 294             print "The EU band is unknown.";
 295         elif band=="ismus" or band=="us":
 296             #905.5MHz
 297             self.pokebysym("FREQ2"    , 0x22)   # Frequency control word, high byte.
 298             self.pokebysym("FREQ1"    , 0xD3)   # Frequency control word, middle byte.
 299             self.pokebysym("FREQ0"    , 0xAC)   # Frequency control word, low byte.
 300         elif band=="ismlf" or band=="lf":
 301             print "There is no LF version of the iclicker."
 302         elif band=="none":
 303             pass;
 304         else:
 305             #Got a frequency, not a band.
 306             self.RF_setfreq(eval(band));
 307         # 812.5kHz bandwidth, 152.34 kbaud
 308         self.pokebysym("MDMCFG4"  , 0x1C)
 309         self.pokebysym("MDMCFG3"  , 0x80)
 310         # no FEC, 2 byte preamble, 250kHz chan spacing
 311
 312         #15/16 sync
 313         #self.pokebysym("MDMCFG2"  , 0x01)
 314         #16/16 sync
 315         self.pokebysym("MDMCFG2"  , 0x02)
 316
 317         self.pokebysym("MDMCFG1"  , 0x03)
 318         self.pokebysym("MDMCFG0"  , 0x3b)
 319
 320         self.pokebysym("CHANNR"   , 0x2e)   # Channel zero.
 321
 322         #self.pokebysym("DEVIATN"  , 0x71)  # 118.5
 323         self.pokebysym("DEVIATN"  , 0x72)   # 253.9 kHz deviation
 324
 325         self.pokebysym("FREND1"   , 0x56)   # Front end RX configuration.
 326         self.pokebysym("FREND0"   , 0x10)   # Front end RX configuration.
 327         self.pokebysym("MCSM2"    , 0x07)
 328         self.pokebysym("MCSM1"    , 0x30)   #Auto freq. cal.
 329         self.pokebysym("MCSM0"    , 0x14)
 330
 331         self.pokebysym("TEST2"    , 0x88)   #
 332         self.pokebysym("TEST1"    , 0x31)   #
 333         self.pokebysym("TEST0"    , 0x09)   # High VCO (Upper band.)
 334         self.pokebysym("PA_TABLE0", 0xC0)   # Max output power.
 335         self.pokebysym("PKTCTRL1" , 0x45)   # Preamble qualidy 2*4=6, adr check, status
 336         self.pokebysym("PKTCTRL0" , 0x00)   # No whitening, CR, fixed len.
 337
 338         self.pokebysym("PKTLEN"   , 0x09)   # Packet length.
 339
 340         self.pokebysym("SYNC1",0xB0);
 341         self.pokebysym("SYNC0",0xB0);
 342         self.pokebysym("ADDR", 0xB0);
 343         return;
 344     def config_simpliciti(self,band="none"):
 345         self.pokebysym("FSCTRL1"  , 0x0C) #08   # Frequency synthesizer control.
 346         self.pokebysym("FSCTRL0"  , 0x00)   # Frequency synthesizer control.
 347
 348         #Don't change these while the radio is active.
 349         self.pokebysym("FSCAL3"   , 0xEA)   # Frequency synthesizer calibration.
 350         self.pokebysym("FSCAL2"   , 0x2A)   # Frequency synthesizer calibration.
 351         self.pokebysym("FSCAL1"   , 0x00)   # Frequency synthesizer calibration.
 352         self.pokebysym("FSCAL0"   , 0x1F)   # Frequency synthesizer calibration.
 353
 354         if band=="ismeu" or band=="eu":
 355             self.pokebysym("FREQ2"    , 0x21)   # Frequency control word, high byte.
 356             self.pokebysym("FREQ1"    , 0x71)   # Frequency control word, middle byte.
 357             self.pokebysym("FREQ0"    , 0x7a)   # Frequency control word, low byte.
 358         elif band=="ismus" or band=="us":
 359             self.pokebysym("FREQ2"    , 0x22)   # Frequency control word, high byte.
 360             self.pokebysym("FREQ1"    , 0xB1)   # Frequency control word, middle byte.
 361             self.pokebysym("FREQ0"    , 0x3B)   # Frequency control word, low byte.
 362         elif band=="ismlf" or band=="lf":
 363             self.pokebysym("FREQ2"    , 0x10)   # Frequency control word, high byte.
 364             self.pokebysym("FREQ1"    , 0xB0)   # Frequency control word, middle byte.
 365             self.pokebysym("FREQ0"    , 0x71)   # Frequency control word, low byte.
 366         elif band=="none":
 367             band="none";
 368         else:
 369             #Got a frequency, not a band.
 370             self.RF_setfreq(eval(band));
 371         self.pokebysym("MDMCFG4"  , 0x7B)   # Modem configuration.
 372         self.pokebysym("MDMCFG3"  , 0x83)   # Modem configuration.
 373         self.pokebysym("MDMCFG2"  , 0x13)   # Modem configuration.
 374         self.pokebysym("MDMCFG1"  , 0x22)   # Modem configuration.
 375         self.pokebysym("MDMCFG0"  , 0xF8)   # Modem configuration.
 376         if band=="ismus" or band=="us":
 377             self.pokebysym("CHANNR"   , 20)   # Channel number.
 378         else:
 379             self.pokebysym("CHANNR"   , 0x00)   # Channel number.
 380         self.pokebysym("DEVIATN"  , 0x42)   # Modem deviation setting (when FSK modulation is enabled).
 381
 382         self.pokebysym("FREND1"   , 0xB6)   # Front end RX configuration.
 383         self.pokebysym("FREND0"   , 0x10)   # Front end RX configuration.
 384         self.pokebysym("MCSM0"    , 0x18)   # Main Radio Control State Machine configuration.
 385         self.pokebysym("FOCCFG"   , 0x1D)   # Frequency Offset Compensation Configuration.
 386         self.pokebysym("BSCFG"    , 0x1C)   # Bit synchronization Configuration.
 387
 388         self.pokebysym("AGCCTRL2" , 0xC7)   # AGC control.
 389         self.pokebysym("AGCCTRL1" , 0x00)   # AGC control.
 390         self.pokebysym("AGCCTRL0" , 0xB2)   # AGC control.
 391
 392         self.pokebysym("TEST2"    , 0x81)   # Various test settings.
 393         self.pokebysym("TEST1"    , 0x35)   # Various test settings.
 394         self.pokebysym("TEST0"    , 0x09)   # Various test settings.
 395         self.pokebysym("PA_TABLE0", 0xc0)   # Max output power.
 396         self.pokebysym("PKTCTRL1" , 0x04)   # Packet automation control, w/ lqi
 397         #self.pokebysym("PKTCTRL1" , 0x00)   # Packet automation control. w/o lqi
 398         self.pokebysym("PKTCTRL0" , 0x05)   # Packet automation control, w/ checksum.
 399         #self.pokebysym("PKTCTRL0" , 0x00)   # Packet automation control, w/o checksum, fixed length
 400         self.pokebysym("ADDR"     , 0x01)   # Device address.
 401         self.pokebysym("PKTLEN"   , 0xFF)   # Packet length.
 402
 403         self.pokebysym("SYNC1",0xD3);
 404         self.pokebysym("SYNC0",0x91);
 405
 406     def RF_carrier(self):
 407         """Hold a carrier wave on the present frequency."""
 408
 409         self.CC1110_crystal(); #FIXME, '1110 specific.
 410         self.RF_idle();
 411
 412
 413         RFST=0xDFE1;
 414
 415         self.config_simpliciti();
 416
 417         #Don't change these while the radio is active.
 418         #self.pokebysym("FSCAL3"   , 0xA9)   # Frequency synthesizer calibration.
 419         #self.pokebysym("FSCAL2"   , 0x0A)   # Frequency synthesizer calibration.
 420         #self.pokebysym("FSCAL1"   , 0x00)   # Frequency synthesizer calibration.
 421         #self.pokebysym("FSCAL0"   , 0x11)   # Frequency synthesizer calibration.
 422
 423         #Ramp up the power.
 424         #self.pokebysym("PA_TABLE0", 0xFF)   # PA output power setting.
 425
 426         #This is what drops to OOK.
 427         #Comment to keep GFSK, might be better at jamming.
 428         self.pokebysym("MDMCFG4"  , 0x86)   # Modem configuration.
 429         self.pokebysym("MDMCFG3"  , 0x83)   # Modem configuration.
 430         self.pokebysym("MDMCFG2"  , 0x30)   # Modem configuration.
 431         self.pokebysym("MDMCFG1"  , 0x22)   # Modem configuration.
 432         self.pokebysym("MDMCFG0"  , 0xF8)   # Modem configuration.
 433
 434
 435         self.pokebysym("SYNC1",0xAA);
 436         self.pokebysym("SYNC0",0xAA);
 437
 438
 439
 440         #while ((MARCSTATE & MARCSTATE_MARC_STATE) != MARC_STATE_TX);
 441         state=0;
 442
 443         while((state!=0x13)):
 444             self.pokebyte(RFST,0x03); #RFST=RFST_STX
 445             time.sleep(0.1);
 446             state=self.peekbysym("MARCSTATE")&0x1F;
 447             #print "state=%02x" % state;
 448         print "Holding a carrier on %f MHz." % (self.RF_getfreq()/10**6);
 449
 450         return;
 451
 452     def RF_getsmac(self):
 453         """Return the source MAC address."""
 454
 455         #Register 0A is RX_ADDR_P0, five bytes.
 456         mac=self.peekbysym("ADDR");
 457         return mac;
 458     def RF_setsmac(self,mac):
 459         """Set the source MAC address."""
 460         self.pokebysym("ADDR",mac);
 461         return 0;
 462     def RF_gettmac(self):
 463         """Return the target MAC address."""
 464         return 0;
 465     def RF_settmac(self,mac):
 466         """Set the target MAC address."""
 467         return 0;
 468     def RF_rxpacket(self):
 469         """Get a packet from the radio.  Returns None if none is waiting."""
 470         self.shellcodefile("rxpacket.ihx");
 471         len=self.peek8(0xFE00,"xdata");
 472         return self.peekblock(0xFE00,len+3,"data");
 473     def RF_txpacket(self,packet):
 474         """Transmit a packet.  Untested."""
 475
 476         self.pokeblock(0xFE00,packet,"data");
 477         self.shellcodefile("txpacket.ihx");
 478         return;
 479     def RF_txrxpacket(self,packet):
 480         """Transmit a packet.  Untested."""
 481
 482         self.pokeblock(0xFE00,packet,"data");
 483         self.shellcodefile("txrxpacket.ihx");
 484         len=self.peek8(0xFE00,"xdata");
 485         return self.peekblock(0xFE00,len+3,"data");
 486
 487     def RF_getrssi(self):
 488         """Returns the received signal strenght, with a weird offset."""
 489         try:
 490             rssireg=self.symbols.get("RSSI");
 491             return self.CCpeekdatabyte(rssireg)^0x80;
 492         except:
 493             if self.verbose>0: print "RSSI reg doesn't exist.";
 494         try:
 495             #RSSI doesn't exist on 2.4GHz devices.  Maybe RSSIL and RSSIH?
 496             rssilreg=self.symbols.get("RSSIL");
 497             rssil=self.CCpeekdatabyte(rssilreg);
 498             rssihreg=self.symbols.get("RSSIL");
 499             rssih=self.CCpeekdatabyte(rssihreg);
 500             return (rssih<<8)|rssil;
 501         except:
 502             if self.verbose>0: print "RSSIL/RSSIH regs don't exist.";
 503
 504         return 0;
 505
 506
 507
 508     def SRF_loadsymbols(self):
 509         ident=self.CCident();
 510         chip=self.CCversions.get(ident&0xFF00);
 511         dom=self.SRF_chipdom(chip,"register_definition.xml");
 512         for e in dom.getElementsByTagName("registerdefinition"):
 513             for f in e.childNodes:
 514                 if f.localName=="Register":
 515                     name="unknownreg";
 516                     address="0xdead";
 517                     description="";
 518                     bitfields="";
 519                     for g in f.childNodes:
 520                         if g.localName=="Name":
 521                             name=g.childNodes[0].nodeValue;
 522                         elif g.localName=="Address":
 523                             address=g.childNodes[0].nodeValue;
 524                         elif g.localName=="Description":
 525                             if g.childNodes:
 526                                 description=g.childNodes[0].nodeValue;
 527                         elif g.localName=="Bitfield":
 528                             bitfields+="%17s/* %-50s */\n" % ("",self.SRF_bitfieldstr(g));
 529                     #print "SFRX(%10s, %s); /* %50s */" % (name,address, description);
 530                     self.symbols.define(eval(address),name,description,"data");
 531     def halt(self):
 532         """Halt the CPU."""
 533         self.CChaltcpu();
 534     def CChaltcpu(self):
 535         """Halt the CPU."""
 536         self.writecmd(self.APP,0x86,0,self.data);
 537     def resume(self):
 538         self.CCreleasecpu();
 539     def CCreleasecpu(self):
 540         """Resume the CPU."""
 541         self.writecmd(self.APP,0x87,0,self.data);
 542     def test(self):
 543         self.CCreleasecpu();
 544         self.CChaltcpu();
 545         #print "Status: %s" % self.CCstatusstr();
 546
 547         #Grab ident three times, should be equal.
 548         ident1=self.CCident();
 549         ident2=self.CCident();
 550         ident3=self.CCident();
 551         if(ident1!=ident2 or ident2!=ident3):
 552             print "Error, repeated ident attempts unequal."
 553             print "%04x, %04x, %04x" % (ident1, ident2, ident3);
 554
 555         #Single step, printing PC.
 556         print "Tracing execution at startup."
 557         for i in range(1,15):
 558             pc=self.CCgetPC();
 559             byte=self.CCpeekcodebyte(i);
 560             #print "PC=%04x, %02x" % (pc, byte);
 561             self.CCstep_instr();
 562
 563         print "Verifying that debugging a NOP doesn't affect the PC."
 564         for i in range(1,15):
 565             pc=self.CCgetPC();
 566             self.CCdebuginstr([0x00]);
 567             if(pc!=self.CCgetPC()):
 568                 print "ERROR: PC changed during CCdebuginstr([NOP])!";
 569
 570         print "Checking pokes to XRAM."
 571         for i in range(0xf000,0xf020):
 572             self.CCpokedatabyte(i,0xde);
 573             if(self.CCpeekdatabyte(i)!=0xde):
 574                 print "Error in XDATA at 0x%04x" % i;
 575
 576         #print "Status: %s." % self.CCstatusstr();
 577         #Exit debugger
 578         self.stop();
 579         print "Done.";
 580
 581     def setup(self):
 582         """Move the FET into the CC2430/CC2530 application."""
 583         #print "Initializing Chipcon.";
 584         self.writecmd(self.APP,0x10,0,self.data);
 585     def CCrd_config(self):
 586         """Read the config register of a Chipcon."""
 587         self.writecmd(self.APP,0x82,0,self.data);
 588         return ord(self.data[0]);
 589     def CCwr_config(self,config):
 590         """Write the config register of a Chipcon."""
 591         self.writecmd(self.APP,0x81,1,[config&0xFF]);
 592     def CClockchip(self):
 593         """Set the flash lock bit in info mem."""
 594         self.writecmd(self.APP, 0x9A, 0, None);
 595     def lock(self):
 596         """Set the flash lock bit in info mem."""
 597         self.CClockchip();
 598
 599
 600     CCversions={0x0100:"cc1110",
 601                 0x1100:"cc1111",
 602                 0x8500:"cc2430",
 603                 0x8900:"cc2431",
 604                 0x8100:"cc2510",
 605                 0x9100:"cc2511",
 606                 0xA500:"cc2530", #page 52 of SWRU191
 607                 0xB500:"cc2531",
 608                 0xFF00:"CCmissing"};
 609     CCpagesizes={0x01: 1024, #"CC1110",
 610                  0x11: 1024, #"CC1111",
 611                  0x85: 2048, #"CC2430",
 612                  0x89: 2048, #"CC2431",
 613                  0x81: 1024, #"CC2510",
 614                  0x91: 1024, #"CC2511",
 615                  0xA5: 2048, #"CC2530", #page 52 of SWRU191
 616                  0xB5: 2048, #"CC2531",
 617                  0xFF: 0    } #"CCmissing"};
 618     def infostring(self):
 619         return self.CCidentstr();
 620     def CCidentstr(self):
 621         ident=self.CCident();
 622         chip=self.CCversions.get(ident&0xFF00);
 623         pagesize=self.CCpagesizes.get(ident>0xFF);
 624         try:
 625             return "%s/r%0.4x/ps0x%0.4x" % (chip, ident, pagesize);
 626         except:
 627             return "%04x" % ident;
 628     def CCident(self):
 629         """Get a chipcon's ID."""
 630         self.writecmd(self.APP,0x8B,0,None);
 631         chip=ord(self.data[0]);
 632         rev=ord(self.data[1]);
 633         return (chip<<8)+rev;
 634     def CCpagesize(self):
 635         """Get a chipcon's ID."""
 636         self.writecmd(self.APP,0x8B,0,None);
 637         chip=ord(self.data[0]);
 638         size=self.CCpagesizes.get(chip);
 639         if(size<10):
 640             print "ERROR: Pagesize undefined.";
 641             print "chip=%0.4x" %chip;
 642             sys.exit(1);
 643             #return 2048;
 644         return size;
 645     def getpc(self):
 646         return self.CCgetPC();
 647     def CCgetPC(self):
 648         """Get a chipcon's PC."""
 649         self.writecmd(self.APP,0x83,0,None);
 650         hi=ord(self.data[0]);
 651         lo=ord(self.data[1]);
 652         return (hi<<8)+lo;
 653     def CCcmd(self,phrase):
 654         self.writecmd(self.APP,0x00,len(phrase),phrase);
 655         val=ord(self.data[0]);
 656         print "Got %02x" % val;
 657         return val;
 658     def CCdebuginstr(self,instr):
 659         self.writecmd(self.APP,0x88,len(instr),instr);
 660         return ord(self.data[0]);
 661     #def peekblock(self,adr,length,memory="vn"):
 662     #    """Return a block of data, broken"""
 663     #    data=[adr&0xff, (adr&0xff00)>>8,
 664     #          length&0xFF,(length&0xFF00)>>8];
 665     #    self.writecmd(self.APP,0x91,4,data);
 666     #    return [ord(x) for x in self.data]
 667     def peek8(self,address, memory="code"):
 668         if(memory=="code" or memory=="flash" or memory=="vn"):
 669             return self.CCpeekcodebyte(address);
 670         elif(memory=="data" or memory=="xdata" or memory=="ram"):
 671             return self.CCpeekdatabyte(address);
 672         elif(memory=="idata" or memory=="iram"):
 673             return self.CCpeekirambyte(address);
 674         print "%s is an unknown memory." % memory;
 675         return 0xdead;
 676     def CCpeekcodebyte(self,adr):
 677         """Read the contents of code memory at an address."""
 678         self.data=[adr&0xff, (adr&0xff00)>>8];
 679         self.writecmd(self.APP,0x90,2,self.data);
 680         return ord(self.data[0]);
 681     def CCpeekdatabyte(self,adr):
 682         """Read the contents of data memory at an address."""
 683         self.data=[adr&0xff, (adr&0xff00)>>8];
 684         self.writecmd(self.APP,0x91, 2, self.data);
 685         return ord(self.data[0]);
 686     def CCpeekirambyte(self,adr):
 687         """Read the contents of IRAM at an address."""
 688         self.data=[adr&0xff];
 689         self.writecmd(self.APP,0x02, 1, self.data);
 690         return ord(self.data[0]);
 691     def CCpeekiramword(self,adr):
 692         """Read the little-endian contents of IRAM at an address."""
 693         return self.CCpeekirambyte(adr)+(
 694             self.CCpeekirambyte(adr+1)<<8);
 695     def CCpokeiramword(self,adr,val):
 696         self.CCpokeirambyte(adr,val&0xff);
 697         self.CCpokeirambyte(adr+1,(val>>8)&0xff);
 698     def CCpokeirambyte(self,adr,val):
 699         """Write the contents of IRAM at an address."""
 700         self.data=[adr&0xff, val&0xff];
 701         self.writecmd(self.APP,0x02, 2, self.data);
 702         return ord(self.data[0]);
 703     def pokebyte(self,adr,val,mem="xdata"):
 704         self.CCpokedatabyte(adr,val);
 705     def CCpokedatabyte(self,adr,val):
 706         """Write a byte to data memory."""
 707         self.data=[adr&0xff, (adr&0xff00)>>8, val];
 708         self.writecmd(self.APP, 0x92, 3, self.data);
 709         return ord(self.data[0]);
 710     def CCchiperase(self):
 711         """Erase all of the target's memory."""
 712         self.writecmd(self.APP,0x80,0,None);
 713     def erase(self):
 714         """Erase all of the target's memory."""
 715         self.CCchiperase();
 716         self.start();
 717
 718     def CCstatus(self):
 719         """Check the status."""
 720         self.writecmd(self.APP,0x84,0,None);
 721         return ord(self.data[0])
 722     #Same as CC2530
 723     CCstatusbits={0x80 : "erase_busy",
 724                   0x40 : "pcon_idle",
 725                   0x20 : "cpu_halted",
 726                   0x10 : "pm0",
 727                   0x08 : "halt_status",
 728                   0x04 : "locked",
 729                   0x02 : "oscstable",
 730                   0x01 : "overflow"
 731                   };
 732     CCconfigbits={0x20 : "soft_power_mode",   #new for CC2530
 733                   0x08 : "timers_off",
 734                   0x04 : "dma_pause",
 735                   0x02 : "timer_suspend",
 736                   0x01 : "sel_flash_info_page" #stricken from CC2530
 737                   };
 738
 739     def status(self):
 740         """Check the status as a string."""
 741         status=self.CCstatus();
 742         str="";
 743         i=1;
 744         while i<0x100:
 745             if(status&i):
 746                 str="%s %s" %(self.CCstatusbits[i],str);
 747             i*=2;
 748         return str;
 749     def start(self):
 750         """Start debugging."""
 751         self.setup();
 752         self.writecmd(self.APP,0x20,0,self.data);
 753         ident=self.CCident();
 754         if ident==0xFFFF or ident==0x0000:
 755             self.writecmd(self.APP,0x20,0,self.data);
 756             ident=self.CCident();
 757
 758
 759         #print "Target identifies as %s." % ident;
 760         #print "Status: %s." % self.status();
 761         self.CCreleasecpu();
 762         self.CChaltcpu();
 763         #Get SmartRF Studio regs if they exist.
 764         self.loadsymbols();
 765
 766     def stop(self):
 767         """Stop debugging."""
 768         self.writecmd(self.APP,0x21,0,self.data);
 769     def CCstep_instr(self):
 770         """Step one instruction."""
 771         self.writecmd(self.APP,0x89,0,self.data);
 772     def CCeraseflashbuffer(self):
 773         """Erase the 2kB flash buffer"""
 774         self.writecmd(self.APP,0x99);
 775     def CCflashpage(self,adr):
 776         """Flash 2kB a page of flash from 0xF000 in XDATA"""
 777         data=[adr&0xFF,
 778               (adr>>8)&0xFF,
 779               (adr>>16)&0xFF,
 780               (adr>>24)&0xFF];
 781         print "Flashing buffer to 0x%06x" % adr;
 782         self.writecmd(self.APP,0x95,4,data);
 783
 784     def setsecret(self,value):
 785         """Set a secret word for later retreival.  Used by glitcher."""
 786         page = 0x0000;
 787         pagelen = self.CCpagesize(); #Varies by chip.
 788         print "page=%04x, pagelen=%04x" % (page,pagelen);
 789
 790         self.CCeraseflashbuffer();
 791         print "Setting secret to %x" % value;
 792         self.CCpokedatabyte(0xF000,value);
 793         self.CCpokedatabyte(0xF800,value);
 794         print "Setting secret to %x==%x" % (value,
 795                                             self.CCpeekdatabyte(0xf000));
 796         self.CCflashpage(0);
 797         print "code[0]=%x" % self.CCpeekcodebyte(0);
 798     def getsecret(self):
 799         """Get a secret word.  Used by glitcher."""
 800         secret=self.CCpeekcodebyte(0);
 801         #print "Got secret %02x" % secret;
 802         return secret;
 803
 804     def dump(self,file,start=0,stop=0xffff):
 805         """Dump an intel hex file from code memory."""
 806         print "Dumping code from %04x to %04x as %s." % (start,stop,file);
 807         h = IntelHex(None);
 808         i=start;
 809         while i<=stop:
 810             h[i]=self.CCpeekcodebyte(i);
 811             if(i%0x100==0):
 812                 print "Dumped %04x."%i;
 813                 h.write_hex_file(file); #buffer to disk.
 814             i+=1;
 815         h.write_hex_file(file);
 816
 817     def flash(self,file):
 818         """Flash an intel hex file to code memory."""
 819         print "Flashing %s" % file;
 820
 821         h = IntelHex(file);
 822         page = 0x0000;
 823         pagelen = self.CCpagesize(); #Varies by chip.
 824
 825         #print "page=%04x, pagelen=%04x" % (page,pagelen);
 826
 827         bcount = 0;
 828
 829         #Wipe the RAM buffer for the next flash page.
 830         self.CCeraseflashbuffer();
 831         for i in h._buf.keys():
 832             while(i>=page+pagelen):
 833                 if bcount>0:
 834                     self.CCflashpage(page);
 835                     #client.CCeraseflashbuffer();
 836                     bcount=0;
 837                     print "Flashed page at %06x" % page
 838                 page+=pagelen;
 839
 840             #Place byte into buffer.
 841             self.CCpokedatabyte(0xF000+i-page,
 842                                 h[i]);
 843             bcount+=1;
 844             if(i%0x100==0):
 845                 print "Buffering %04x toward %06x" % (i,page);
 846         #last page
 847         self.CCflashpage(page);
 848         print "Flashed final page at %06x" % page;
 849