2 # GoodFET Chipcon Example
4 # (C) 2009 Travis Goodspeed <travis at radiantmachines.com>
6 # This code is being rewritten and refactored. You've been warned!
11 from GoodFETCC import GoodFETCC;
12 from GoodFETConsole import GoodFETConsole;
13 from intelhex import IntelHex;
16 def printpacket(packet):
19 #print "Printing packet."
22 #if i>packet[0]+1: break;
23 s="%s %02x" % (s,foo);
26 def handlesimplicitipacket(packet):
32 #if i>packet[0]+1: break;
33 s="%s %02x" % (s,foo);
51 #payload begins at byte 12.
56 #print "Join request.";
58 print "Not a join request. WTF?";
61 reply=[0x12, #reply is one byte shorter
62 src[0], src[1], src[2], src[3],
65 0x81, tid, #reply, tid
68 #4,3,2,1, #default join token
69 #8,7,6,5, #default link token
73 client.RF_txpacket(reply);
76 print "Security request.";
78 print "Frequency request.";
80 print "Management request.";
82 print "Unknown Port %02x" %port;
85 print "Usage: %s verb [objects]\n" % sys.argv[0];
86 print "%s erase" % sys.argv[0];
87 print "%s flash $foo.hex" % sys.argv[0];
88 print "%s test" % sys.argv[0];
89 print "%s term" % sys.argv[0];
90 print "%s info" % sys.argv[0];
91 print "%s halt" % sys.argv[0];
92 print "%s regs" % sys.argv[0];
93 print "%s dumpcode $foo.hex [0x$start 0x$stop]" % sys.argv[0];
94 print "%s dumpdata $foo.hex [0x$start 0x$stop]" % sys.argv[0];
95 print "%s writedata $foo.hex [0x$start 0x$stop]" % sys.argv[0];
96 print "%s verify $foo.hex [0x$start 0x$stop]" % sys.argv[0];
97 print "%s peekdata 0x$start [0x$stop]" % sys.argv[0];
98 print "%s pokedata 0x$adr 0x$val" % sys.argv[0];
99 print "%s peek 0x$iram" % sys.argv[0];
100 print "%s poke 0x$iram 0x$val" % sys.argv[0];
101 print "%s peekcode 0x$start [0x$stop]" % sys.argv[0];
103 print "%s rssi [freq]\n\tGraphs signal strength on [freq] Hz." % sys.argv[0];
104 print "%s carrier [freq]\n\tHolds a carrier on [freq] Hz." % sys.argv[0];
105 print "%s reflex [freq]\n\tJams on [freq] Hz." % sys.argv[0];
106 print "%s sniffsimpliciti [us|eu|lf]\n\tSniffs SimpliciTI packets." % sys.argv[0];
110 #Initailize FET and set baud rate
111 #client=GoodFET.GoodFETCC.GoodFETCC();
121 if(sys.argv[1]=="carrier"):
123 client.RF_setfreq(eval(sys.argv[2]));
128 if(sys.argv[1]=="reflex"):
129 client.CC1110_crystal();
132 client.config_simpliciti();
136 client.RF_setfreq(eval(sys.argv[2]));
137 print "Listening on %f MHz." % (client.RF_getfreq()/10**6);
138 print "Jamming if RSSI>=%i" % threshold;
140 client.pokebyte(0xFE00,threshold,"xdata"); #Write threshold to shellcode.
141 client.shellcodefile("reflex.ihx");
144 while(0==client.ishalted()):
146 rssi=client.peek8(0xFE00,"xdata");
147 print "Activated jamming with RSSI of %i, going again for another packet." % rssi;
151 client.CC_RFST_CAL(); #SCAL
156 client.CC_RFST_RX(); #SRX
157 rssi=client.RF_getrssi();
158 client.CC_RFST_IDLE(); #idle
161 for foo in range(0,rssi>>2):
162 string=("%s."%string);
163 print "%02x %04i %04i %s" % (rssi,rssi, maxrssi, string);
167 #print "Triggered jamming for 1s.";
170 print "JAMMING JAMMING JAMMING JAMMING";
171 if(sys.argv[1]=="rssi"):
172 client.CC1110_crystal();
175 client.config_simpliciti();
178 client.RF_setfreq(eval(sys.argv[2]));
179 print "Listening on %f MHz." % (client.RF_getfreq()/10.0**6);
183 client.CC_RFST_CAL();
188 rssi=client.RF_getrssi();
189 client.CC_RFST_IDLE(); #idle
192 for foo in range(0,rssi>>2):
193 string=("%s."%string);
194 print "%02x %04i %s" % (rssi,rssi, string);
196 if(sys.argv[1]=="sniffsimpliciti"):
197 #TODO remove all poke() calls.
202 client.CC1110_crystal();
205 client.config_simpliciti(region);
207 print "Listening as %x on %f MHz" % (client.RF_getsmac(),
208 client.RF_getfreq()/10.0**6);
209 #Now we're ready to get packets.
213 packet=client.RF_rxpacket();
217 if(sys.argv[1]=="simpliciti"):
218 #TODO remove all poke() calls.
223 client.CC1110_crystal();
226 client.config_simpliciti(region);
228 print "Listening as %x on %f MHz" % (client.RF_getsmac(),
229 client.RF_getfreq()/10.0**6);
230 #Now we're ready to get packets.
234 packet=client.RF_rxpacket();
235 handlesimplicitipacket(packet);
240 if(sys.argv[1]=="term"):
241 GoodFETConsole(client).run();
242 if(sys.argv[1]=="test"):
244 if(sys.argv[1]=="deadtest"):
245 for i in range(1,10):
246 print "IDENT as %s" % client.CCidentstr();
247 if(sys.argv[1]=="dumpcode"):
252 start=int(sys.argv[3],16);
254 stop=int(sys.argv[4],16);
256 print "Dumping code from %04x to %04x as %s." % (start,stop,f);
260 h[i]=client.CCpeekcodebyte(i);
262 print "Dumped %04x."%i;
265 if(sys.argv[1]=="dumpdata"):
270 start=int(sys.argv[3],16);
272 stop=int(sys.argv[4],16);
274 print "Dumping data from %04x to %04x as %s." % (start,stop,f);
278 h[i]=client.CCpeekdatabyte(i);
280 print "Dumped %04x."%i;
283 if(sys.argv[1]=="status"):
284 print "Status: %s" %client.status();
285 if(sys.argv[1]=="halt"):
288 if(sys.argv[1]=="info"):
289 print "Ident %s" % client.CCidentstr();
292 print "Freq %10.3f MHz" % (client.RF_getfreq()/10**6);
293 print "RSSI %02x" % client.RF_getrssi();
295 print "Freq, RSSI, etc unknown. Install SmartRF7.";
296 #print "Rate %10i kbps" % (client.RF_getrate()/1000);
297 #print "PacketLen %02i bytes" % client.RF_getpacketlen();
298 #print "SMAC 0x%010x" % client.RF_getsmac();
299 #print "TMAC 0x%010x" % client.RF_gettmac();
301 if(sys.argv[1]=="regs"):
304 if(sys.argv[1]=="erase"):
305 print "Status: %s" % client.status();
306 client.CCchiperase();
307 print "Status: %s" %client.status();
309 if(sys.argv[1]=="peekinfo"):
310 print "Select info flash."
311 client.CCwr_config(1);
312 print "Config is %02x" % client.CCrd_config();
316 start=int(sys.argv[2],16);
319 stop=int(sys.argv[3],16);
320 print "Peeking from %04x to %04x." % (start,stop);
322 print "%04x: %02x" % (start,client.CCpeekcodebyte(start));
324 if(sys.argv[1]=="poke"):
325 client.CCpokeirambyte(int(sys.argv[2],16),
326 int(sys.argv[3],16));
327 if(sys.argv[1]=="randtest"):
329 client.CCpokeirambyte(0xBD,0x01); #RNDH=0x01
330 client.CCpokeirambyte(0xB4,0x04); #ADCCON1=0x04
331 client.CCpokeirambyte(0xBD,0x01); #RNDH=0x01
332 client.CCpokeirambyte(0xB4,0x04); #ADCCON1=0x04
335 for foo in range(1,10):
336 print "%02x" % client.CCpeekirambyte(0xBD); #RNDH
337 client.CCpokeirambyte(0xB4,0x04); #ADCCON1=0x04
338 client.CCreleasecpu();
340 print "%02x" % client.CCpeekdatabyte(0xDF61); #CHIP ID
341 if(sys.argv[1]=="adctest"):
342 # ADCTest 0xDF3A 0xDF3B
343 print "ADC TEST %02x%02x" % (
344 client.CCpeekdatabyte(0xDF3A),
345 client.CCpeekdatabyte(0xDF3B));
346 if(sys.argv[1]=="config"):
347 print "Config is %02x" % client.CCrd_config();
349 if(sys.argv[1]=="flash"):
354 start=int(sys.argv[3],16);
356 stop=int(sys.argv[4],16);
359 if(sys.argv[1]=="lock"):
360 print "Status: %s" %client.status();
362 print "Status: %s" %client.status();
363 if(sys.argv[1]=="flashpage"):
366 target=int(sys.argv[2],16);
367 print "Writing a page of flash from 0xF000 in XDATA"
368 client.CCflashpage(target);
369 if(sys.argv[1]=="erasebuffer"):
370 print "Erasing flash buffer.";
371 client.CCeraseflashbuffer();
373 if(sys.argv[1]=="writedata"):
378 start=int(sys.argv[3],16);
380 stop=int(sys.argv[4],16);
384 for i in h._buf.keys():
385 if(i>=start and i<=stop):
386 client.CCpokedatabyte(i,h[i]);
389 #if(sys.argv[1]=="flashtest"):
390 # client.CCflashtest();
391 if(sys.argv[1]=="peekdata"):
394 start=int(sys.argv[2],16);
397 stop=int(sys.argv[3],16);
398 print "Peeking from %04x to %04x." % (start,stop);
400 print "%04x: %02x" % (start,client.CCpeekdatabyte(start));
402 if(sys.argv[1]=="peek"):
405 start=int(sys.argv[2],16);
408 stop=int(sys.argv[3],16);
409 print "Peeking from %04x to %04x." % (start,stop);
411 print "%04x: %02x" % (start,client.CCpeekirambyte(start));
413 if(sys.argv[1]=="verify"):
418 start=int(sys.argv[3],16);
420 stop=int(sys.argv[4],16);
423 for i in h._buf.keys():
424 if(i>=start and i<stop):
425 peek=client.CCpeekcodebyte(i)
427 print "ERROR at %04x, found %02x not %02x"%(i,peek,h[i]);
430 if(sys.argv[1]=="peekcode"):
433 start=int(sys.argv[2],16);
436 stop=int(sys.argv[3],16);
437 print "Peeking from %04x to %04x." % (start,stop);
439 print "%04x: %02x" % (start,client.CCpeekcodebyte(start));
441 if(sys.argv[1]=="pokedata"):
445 start=int(sys.argv[2],16);
447 val=int(sys.argv[3],16);
448 print "Poking %04x to become %02x." % (start,val);
449 client.CCpokedatabyte(start,val);