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, #link 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.";
83 print "Not a join request. WTF?";
86 reply=[0x12, #reply is one byte shorter
87 src[0], src[1], src[2], src[3],
88 0x78,0x56,0x34,0x10, #my address.
90 0x81, tid, #reply, tid
92 0xef,0xbe,0xad,0xde, #Join token
95 print "#FIXME FAST: repeatedly broadcasting ACK to catch JOIN on the next attempt.";
97 for foo in range(1,50):
98 client.RF_txpacket(reply);
102 print "Security request.";
104 print "Frequency request.";
106 print "Management request.";
108 print "Unknown Port %02x" %port;
110 if(len(sys.argv)==1):
111 print "Usage: %s verb [objects]\n" % sys.argv[0];
112 print "%s erase" % sys.argv[0];
113 print "%s flash $foo.hex" % sys.argv[0];
114 print "%s test" % sys.argv[0];
115 print "%s term" % sys.argv[0];
116 print "%s info" % sys.argv[0];
117 print "%s halt" % sys.argv[0];
118 print "%s regs" % sys.argv[0];
119 print "%s dumpcode $foo.hex [0x$start 0x$stop]" % sys.argv[0];
120 print "%s dumpdata $foo.hex [0x$start 0x$stop]" % sys.argv[0];
121 print "%s writedata $foo.hex [0x$start 0x$stop]" % sys.argv[0];
122 print "%s verify $foo.hex [0x$start 0x$stop]" % sys.argv[0];
123 print "%s peekdata 0x$start [0x$stop]" % sys.argv[0];
124 print "%s pokedata 0x$adr 0x$val" % sys.argv[0];
125 print "%s peek 0x$iram" % sys.argv[0];
126 print "%s poke 0x$iram 0x$val" % sys.argv[0];
127 print "%s peekcode 0x$start [0x$stop]" % sys.argv[0];
129 print "%s rssi [freq]\n\tGraphs signal strength on [freq] Hz." % sys.argv[0];
130 print "%s carrier [freq]\n\tHolds a carrier on [freq] Hz." % sys.argv[0];
131 print "%s reflex [freq]\n\tJams on [freq] Hz." % sys.argv[0];
132 print "%s sniffsimpliciti [us|eu|lf]\n\tSniffs SimpliciTI packets." % sys.argv[0];
133 print "%s sniffdash7 [lf]\n\tSniffs Dash7. (untested)" % sys.argv[0];
138 #Initailize FET and set baud rate
139 #client=GoodFET.GoodFETCC.GoodFETCC();
149 if(sys.argv[1]=="carrier"):
151 client.RF_setfreq(eval(sys.argv[2]));
156 if(sys.argv[1]=="reflex"):
157 client.CC1110_crystal();
160 client.config_simpliciti();
164 client.RF_setfreq(eval(sys.argv[2]));
165 print "Listening on %f MHz." % (client.RF_getfreq()/10**6);
166 print "Jamming if RSSI>=%i" % threshold;
168 client.pokebyte(0xFE00,threshold,"xdata"); #Write threshold to shellcode.
169 client.shellcodefile("reflex.ihx");
172 while(0==client.ishalted()):
174 rssi=client.peek8(0xFE00,"xdata");
175 print "Activated jamming with RSSI of %i, going again for another packet." % rssi;
176 #client.CCdebuginstr([0x02, 0xf0, 0x00]); #ljmp 0xF000
180 client.CC_RFST_CAL(); #SCAL
185 client.CC_RFST_RX(); #SRX
186 rssi=client.RF_getrssi();
187 client.CC_RFST_IDLE(); #idle
190 for foo in range(0,rssi>>2):
191 string=("%s."%string);
192 print "%02x %04i %04i %s" % (rssi,rssi, maxrssi, string);
196 #print "Triggered jamming for 1s.";
199 print "JAMMING JAMMING JAMMING JAMMING";
200 if(sys.argv[1]=="rssi"):
201 client.CC1110_crystal();
204 client.config_simpliciti();
207 client.RF_setfreq(eval(sys.argv[2]));
208 print "Listening on %f MHz." % (client.RF_getfreq()/10.0**6);
212 client.CC_RFST_CAL();
217 rssi=client.RF_getrssi();
218 client.CC_RFST_IDLE(); #idle
221 for foo in range(0,rssi>>2):
222 string=("%s."%string);
223 print "%02x %04i %s" % (rssi,rssi, string);
225 if(sys.argv[1]=="sniffsimpliciti"):
230 client.CC1110_crystal();
233 client.config_simpliciti(region);
235 print "Listening as %x on %f MHz" % (client.RF_getsmac(),
236 client.RF_getfreq()/10.0**6);
237 #Now we're ready to get packets.
241 packet=client.RF_rxpacket();
244 if(sys.argv[1]=="sniffdash7"):
249 client.CC1110_crystal();
252 client.config_dash7(region);
254 print "Listening as %x on %f MHz" % (client.RF_getsmac(),
255 client.RF_getfreq()/10.0**6);
256 #Now we're ready to get packets.
260 packet=client.RF_rxpacket();
264 if(sys.argv[1]=="simpliciti"):
269 client.CC1110_crystal();
272 client.config_simpliciti(region);
274 print "# Listening as %x on %f MHz" % (client.RF_getsmac(),
275 client.RF_getfreq()/10.0**6);
276 #Now we're ready to get packets.
280 packet=client.RF_rxpacket();
281 handlesimplicitipacket(packet);
286 if(sys.argv[1]=="term"):
287 GoodFETConsole(client).run();
288 if(sys.argv[1]=="test"):
290 if(sys.argv[1]=="deadtest"):
291 for i in range(1,10):
292 print "IDENT as %s" % client.CCidentstr();
293 if(sys.argv[1]=="dumpcode"):
298 start=int(sys.argv[3],16);
300 stop=int(sys.argv[4],16);
302 print "Dumping code from %04x to %04x as %s." % (start,stop,f);
306 h[i]=client.CCpeekcodebyte(i);
308 print "Dumped %04x."%i;
311 if(sys.argv[1]=="dumpdata"):
316 start=int(sys.argv[3],16);
318 stop=int(sys.argv[4],16);
320 print "Dumping data from %04x to %04x as %s." % (start,stop,f);
324 h[i]=client.CCpeekdatabyte(i);
326 print "Dumped %04x."%i;
329 if(sys.argv[1]=="status"):
330 print "Status: %s" %client.status();
331 if(sys.argv[1]=="halt"):
334 if(sys.argv[1]=="info"):
335 print "Ident %s" % client.CCidentstr();
338 print "Freq %10.3f MHz" % (client.RF_getfreq()/10**6);
339 print "RSSI %02x" % client.RF_getrssi();
341 print "Freq, RSSI, etc unknown. Install SmartRF7.";
342 #print "Rate %10i kbps" % (client.RF_getrate()/1000);
343 #print "PacketLen %02i bytes" % client.RF_getpacketlen();
344 #print "SMAC 0x%010x" % client.RF_getsmac();
345 #print "TMAC 0x%010x" % client.RF_gettmac();
347 if(sys.argv[1]=="regs"):
350 if(sys.argv[1]=="erase"):
351 print "Status: %s" % client.status();
352 client.CCchiperase();
353 print "Status: %s" %client.status();
355 if(sys.argv[1]=="peekinfo"):
356 print "Select info flash."
357 client.CCwr_config(1);
358 print "Config is %02x" % client.CCrd_config();
362 start=int(sys.argv[2],16);
365 stop=int(sys.argv[3],16);
366 print "Peeking from %04x to %04x." % (start,stop);
368 print "%04x: %02x" % (start,client.CCpeekcodebyte(start));
370 if(sys.argv[1]=="poke"):
371 client.CCpokeirambyte(int(sys.argv[2],16),
372 int(sys.argv[3],16));
373 if(sys.argv[1]=="randtest"):
375 client.CCpokeirambyte(0xBD,0x01); #RNDH=0x01
376 client.CCpokeirambyte(0xB4,0x04); #ADCCON1=0x04
377 client.CCpokeirambyte(0xBD,0x01); #RNDH=0x01
378 client.CCpokeirambyte(0xB4,0x04); #ADCCON1=0x04
381 for foo in range(1,10):
382 print "%02x" % client.CCpeekirambyte(0xBD); #RNDH
383 client.CCpokeirambyte(0xB4,0x04); #ADCCON1=0x04
384 client.CCreleasecpu();
386 print "%02x" % client.CCpeekdatabyte(0xDF61); #CHIP ID
387 if(sys.argv[1]=="adctest"):
388 # ADCTest 0xDF3A 0xDF3B
389 print "ADC TEST %02x%02x" % (
390 client.CCpeekdatabyte(0xDF3A),
391 client.CCpeekdatabyte(0xDF3B));
392 if(sys.argv[1]=="config"):
393 print "Config is %02x" % client.CCrd_config();
395 if(sys.argv[1]=="flash"):
400 start=int(sys.argv[3],16);
402 stop=int(sys.argv[4],16);
405 if(sys.argv[1]=="lock"):
406 print "Status: %s" %client.status();
408 print "Status: %s" %client.status();
409 if(sys.argv[1]=="flashpage"):
412 target=int(sys.argv[2],16);
413 print "Writing a page of flash from 0xF000 in XDATA"
414 client.CCflashpage(target);
415 if(sys.argv[1]=="erasebuffer"):
416 print "Erasing flash buffer.";
417 client.CCeraseflashbuffer();
419 if(sys.argv[1]=="writedata"):
424 start=int(sys.argv[3],16);
426 stop=int(sys.argv[4],16);
430 for i in h._buf.keys():
431 if(i>=start and i<=stop):
432 client.CCpokedatabyte(i,h[i]);
435 #if(sys.argv[1]=="flashtest"):
436 # client.CCflashtest();
437 if(sys.argv[1]=="peekdata"):
440 start=int(sys.argv[2],16);
443 stop=int(sys.argv[3],16);
444 print "Peeking from %04x to %04x." % (start,stop);
446 print "%04x: %02x" % (start,client.CCpeekdatabyte(start));
448 if(sys.argv[1]=="peek"):
451 start=int(sys.argv[2],16);
454 stop=int(sys.argv[3],16);
455 print "Peeking from %04x to %04x." % (start,stop);
457 print "%04x: %02x" % (start,client.CCpeekirambyte(start));
459 if(sys.argv[1]=="verify"):
464 start=int(sys.argv[3],16);
466 stop=int(sys.argv[4],16);
469 for i in h._buf.keys():
470 if(i>=start and i<stop):
471 peek=client.CCpeekcodebyte(i)
473 print "ERROR at %04x, found %02x not %02x"%(i,peek,h[i]);
476 if(sys.argv[1]=="peekcode"):
479 start=int(sys.argv[2],16);
482 stop=int(sys.argv[3],16);
483 print "Peeking from %04x to %04x." % (start,stop);
485 print "%04x: %02x" % (start,client.CCpeekcodebyte(start));
487 if(sys.argv[1]=="pokedata"):
491 start=int(sys.argv[2],16);
493 val=int(sys.argv[3],16);
494 print "Poking %04x to become %02x." % (start,val);
495 client.CCpokedatabyte(start,val);