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):
21 s="%s %02x" % (s,foo);
25 def handlesimplicitipacket(packet):
28 global simplepacketcount;
29 simplepacketcount=simplepacketcount+1;
45 #payload begins at byte 10.
47 if packet[len+2]&0x80==0:
48 print "# Dropped broken packet.";
56 print "%09i %03i %4i %4i %4i" % (simplepacketcount,button,x,y,z);
59 #Link request. Gotta send a proper reply to get data.
61 #14 ff ff ff ff 3c b7 e3 98
66 src[0], src[1], src[2], src[3],
67 0x78,0x56,0x34,0x10, #my address.
69 0x81, tid, #reply, tid
71 0x20,0x00,0xad,0xde, #Join token
74 print "#FIXME FAST: repeatedly broadcasting ACK to catch LINK on the next attempt.";
75 for foo in range(1,50):
76 client.RF_txpacket(reply);
80 #print "Join request.";
82 print "Not a join request. WTF?";
85 reply=[0x12, #reply is one byte shorter
86 src[0], src[1], src[2], src[3],
87 0x78,0x56,0x34,0x10, #my address.
89 0x81, tid, #reply, tid
91 0xef,0xbe,0xad,0xde, #Join token
94 print "#FIXME FAST: repeatedly broadcasting ACK to catch JOIN on the next attempt.";
95 for foo in range(1,50):
96 client.RF_txpacket(reply);
100 print "Security request.";
102 print "Frequency request.";
104 print "Management request.";
106 print "Unknown Port %02x" %port;
108 if(len(sys.argv)==1):
109 print "Usage: %s verb [objects]\n" % sys.argv[0];
110 print "%s erase" % sys.argv[0];
111 print "%s flash $foo.hex" % sys.argv[0];
112 print "%s test" % sys.argv[0];
113 print "%s term" % sys.argv[0];
114 print "%s info" % sys.argv[0];
115 print "%s halt" % sys.argv[0];
116 print "%s regs" % sys.argv[0];
117 print "%s dumpcode $foo.hex [0x$start 0x$stop]" % sys.argv[0];
118 print "%s dumpdata $foo.hex [0x$start 0x$stop]" % sys.argv[0];
119 print "%s writedata $foo.hex [0x$start 0x$stop]" % sys.argv[0];
120 print "%s verify $foo.hex [0x$start 0x$stop]" % sys.argv[0];
121 print "%s peekdata 0x$start [0x$stop]" % sys.argv[0];
122 print "%s pokedata 0x$adr 0x$val" % sys.argv[0];
123 print "%s peek 0x$iram" % sys.argv[0];
124 print "%s poke 0x$iram 0x$val" % sys.argv[0];
125 print "%s peekcode 0x$start [0x$stop]" % sys.argv[0];
127 print "%s rssi [freq]\n\tGraphs signal strength on [freq] Hz." % sys.argv[0];
128 print "%s carrier [freq]\n\tHolds a carrier on [freq] Hz." % sys.argv[0];
129 print "%s reflex [freq]\n\tJams on [freq] Hz." % sys.argv[0];
130 print "%s sniffsimpliciti [us|eu|lf]\n\tSniffs SimpliciTI packets." % sys.argv[0];
134 #Initailize FET and set baud rate
135 #client=GoodFET.GoodFETCC.GoodFETCC();
145 if(sys.argv[1]=="carrier"):
147 client.RF_setfreq(eval(sys.argv[2]));
152 if(sys.argv[1]=="reflex"):
153 client.CC1110_crystal();
156 client.config_simpliciti();
160 client.RF_setfreq(eval(sys.argv[2]));
161 print "Listening on %f MHz." % (client.RF_getfreq()/10**6);
162 print "Jamming if RSSI>=%i" % threshold;
164 client.pokebyte(0xFE00,threshold,"xdata"); #Write threshold to shellcode.
165 client.shellcodefile("reflex.ihx");
168 while(0==client.ishalted()):
170 rssi=client.peek8(0xFE00,"xdata");
171 print "Activated jamming with RSSI of %i, going again for another packet." % rssi;
172 #client.CCdebuginstr([0x02, 0xf0, 0x00]); #ljmp 0xF000
176 client.CC_RFST_CAL(); #SCAL
181 client.CC_RFST_RX(); #SRX
182 rssi=client.RF_getrssi();
183 client.CC_RFST_IDLE(); #idle
186 for foo in range(0,rssi>>2):
187 string=("%s."%string);
188 print "%02x %04i %04i %s" % (rssi,rssi, maxrssi, string);
192 #print "Triggered jamming for 1s.";
195 print "JAMMING JAMMING JAMMING JAMMING";
196 if(sys.argv[1]=="rssi"):
197 client.CC1110_crystal();
200 client.config_simpliciti();
203 client.RF_setfreq(eval(sys.argv[2]));
204 print "Listening on %f MHz." % (client.RF_getfreq()/10.0**6);
208 client.CC_RFST_CAL();
213 rssi=client.RF_getrssi();
214 client.CC_RFST_IDLE(); #idle
217 for foo in range(0,rssi>>2):
218 string=("%s."%string);
219 print "%02x %04i %s" % (rssi,rssi, string);
221 if(sys.argv[1]=="sniffsimpliciti"):
222 #TODO remove all poke() calls.
227 client.CC1110_crystal();
230 client.config_simpliciti(region);
232 print "Listening as %x on %f MHz" % (client.RF_getsmac(),
233 client.RF_getfreq()/10.0**6);
234 #Now we're ready to get packets.
238 packet=client.RF_rxpacket();
242 if(sys.argv[1]=="simpliciti"):
243 #TODO remove all poke() calls.
248 client.CC1110_crystal();
251 client.config_simpliciti(region);
253 print "# Listening as %x on %f MHz" % (client.RF_getsmac(),
254 client.RF_getfreq()/10.0**6);
255 #Now we're ready to get packets.
259 packet=client.RF_rxpacket();
260 handlesimplicitipacket(packet);
265 if(sys.argv[1]=="term"):
266 GoodFETConsole(client).run();
267 if(sys.argv[1]=="test"):
269 if(sys.argv[1]=="deadtest"):
270 for i in range(1,10):
271 print "IDENT as %s" % client.CCidentstr();
272 if(sys.argv[1]=="dumpcode"):
277 start=int(sys.argv[3],16);
279 stop=int(sys.argv[4],16);
281 print "Dumping code from %04x to %04x as %s." % (start,stop,f);
285 h[i]=client.CCpeekcodebyte(i);
287 print "Dumped %04x."%i;
290 if(sys.argv[1]=="dumpdata"):
295 start=int(sys.argv[3],16);
297 stop=int(sys.argv[4],16);
299 print "Dumping data from %04x to %04x as %s." % (start,stop,f);
303 h[i]=client.CCpeekdatabyte(i);
305 print "Dumped %04x."%i;
308 if(sys.argv[1]=="status"):
309 print "Status: %s" %client.status();
310 if(sys.argv[1]=="halt"):
313 if(sys.argv[1]=="info"):
314 print "Ident %s" % client.CCidentstr();
317 print "Freq %10.3f MHz" % (client.RF_getfreq()/10**6);
318 print "RSSI %02x" % client.RF_getrssi();
320 print "Freq, RSSI, etc unknown. Install SmartRF7.";
321 #print "Rate %10i kbps" % (client.RF_getrate()/1000);
322 #print "PacketLen %02i bytes" % client.RF_getpacketlen();
323 #print "SMAC 0x%010x" % client.RF_getsmac();
324 #print "TMAC 0x%010x" % client.RF_gettmac();
326 if(sys.argv[1]=="regs"):
329 if(sys.argv[1]=="erase"):
330 print "Status: %s" % client.status();
331 client.CCchiperase();
332 print "Status: %s" %client.status();
334 if(sys.argv[1]=="peekinfo"):
335 print "Select info flash."
336 client.CCwr_config(1);
337 print "Config is %02x" % client.CCrd_config();
341 start=int(sys.argv[2],16);
344 stop=int(sys.argv[3],16);
345 print "Peeking from %04x to %04x." % (start,stop);
347 print "%04x: %02x" % (start,client.CCpeekcodebyte(start));
349 if(sys.argv[1]=="poke"):
350 client.CCpokeirambyte(int(sys.argv[2],16),
351 int(sys.argv[3],16));
352 if(sys.argv[1]=="randtest"):
354 client.CCpokeirambyte(0xBD,0x01); #RNDH=0x01
355 client.CCpokeirambyte(0xB4,0x04); #ADCCON1=0x04
356 client.CCpokeirambyte(0xBD,0x01); #RNDH=0x01
357 client.CCpokeirambyte(0xB4,0x04); #ADCCON1=0x04
360 for foo in range(1,10):
361 print "%02x" % client.CCpeekirambyte(0xBD); #RNDH
362 client.CCpokeirambyte(0xB4,0x04); #ADCCON1=0x04
363 client.CCreleasecpu();
365 print "%02x" % client.CCpeekdatabyte(0xDF61); #CHIP ID
366 if(sys.argv[1]=="adctest"):
367 # ADCTest 0xDF3A 0xDF3B
368 print "ADC TEST %02x%02x" % (
369 client.CCpeekdatabyte(0xDF3A),
370 client.CCpeekdatabyte(0xDF3B));
371 if(sys.argv[1]=="config"):
372 print "Config is %02x" % client.CCrd_config();
374 if(sys.argv[1]=="flash"):
379 start=int(sys.argv[3],16);
381 stop=int(sys.argv[4],16);
384 if(sys.argv[1]=="lock"):
385 print "Status: %s" %client.status();
387 print "Status: %s" %client.status();
388 if(sys.argv[1]=="flashpage"):
391 target=int(sys.argv[2],16);
392 print "Writing a page of flash from 0xF000 in XDATA"
393 client.CCflashpage(target);
394 if(sys.argv[1]=="erasebuffer"):
395 print "Erasing flash buffer.";
396 client.CCeraseflashbuffer();
398 if(sys.argv[1]=="writedata"):
403 start=int(sys.argv[3],16);
405 stop=int(sys.argv[4],16);
409 for i in h._buf.keys():
410 if(i>=start and i<=stop):
411 client.CCpokedatabyte(i,h[i]);
414 #if(sys.argv[1]=="flashtest"):
415 # client.CCflashtest();
416 if(sys.argv[1]=="peekdata"):
419 start=int(sys.argv[2],16);
422 stop=int(sys.argv[3],16);
423 print "Peeking from %04x to %04x." % (start,stop);
425 print "%04x: %02x" % (start,client.CCpeekdatabyte(start));
427 if(sys.argv[1]=="peek"):
430 start=int(sys.argv[2],16);
433 stop=int(sys.argv[3],16);
434 print "Peeking from %04x to %04x." % (start,stop);
436 print "%04x: %02x" % (start,client.CCpeekirambyte(start));
438 if(sys.argv[1]=="verify"):
443 start=int(sys.argv[3],16);
445 stop=int(sys.argv[4],16);
448 for i in h._buf.keys():
449 if(i>=start and i<stop):
450 peek=client.CCpeekcodebyte(i)
452 print "ERROR at %04x, found %02x not %02x"%(i,peek,h[i]);
455 if(sys.argv[1]=="peekcode"):
458 start=int(sys.argv[2],16);
461 stop=int(sys.argv[3],16);
462 print "Peeking from %04x to %04x." % (start,stop);
464 print "%04x: %02x" % (start,client.CCpeekcodebyte(start));
466 if(sys.argv[1]=="pokedata"):
470 start=int(sys.argv[2],16);
472 val=int(sys.argv[3],16);
473 print "Poking %04x to become %02x." % (start,val);
474 client.CCpokedatabyte(start,val);