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.";
54 if x>=128: x=0-(x^0xFF)-1;
56 if y>=128: y=0-(y^0xFF)-1;
58 if z>=128: z=0-(z^0xFF)-1;
60 print "%09i %03i %4i %4i %4i" % (simplepacketcount,button,x,y,z);
63 #Link request. Gotta send a proper reply to get data.
65 #14 ff ff ff ff 3c b7 e3 98
70 src[0], src[1], src[2], src[3],
71 0x78,0x56,0x34,0x10, #my address.
73 0x81, tid, #reply, tid
75 0x20,0x00,0xad,0xde, #link token
78 print "#FIXME FAST: repeatedly broadcasting ACK to catch LINK on the next attempt.";
79 for foo in range(1,50):
80 client.RF_txpacket(reply);
84 #print "Join request.";
87 print "Not a join request. WTF?";
90 reply=[0x12, #reply is one byte shorter
91 src[0], src[1], src[2], src[3],
92 0x78,0x56,0x34,0x10, #my address.
94 0x81, tid, #reply, tid
96 0xef,0xbe,0xad,0xde, #Join token
99 print "#FIXME FAST: repeatedly broadcasting ACK to catch JOIN on the next attempt.";
101 for foo in range(1,50):
102 client.RF_txpacket(reply);
106 print "Security request.";
108 print "Frequency request.";
110 print "Management request.";
112 print "Unknown Port %02x" %port;
114 if(len(sys.argv)==1):
115 print "Usage: %s verb [objects]\n" % sys.argv[0];
116 print "%s erase" % sys.argv[0];
117 print "%s flash $foo.hex" % sys.argv[0];
118 print "%s test" % sys.argv[0];
119 print "%s term" % sys.argv[0];
120 print "%s info" % sys.argv[0];
121 print "%s infotest" % sys.argv[0];
122 print "%s halt" % sys.argv[0];
123 print "%s regs" % sys.argv[0];
124 print "%s dumpcode $foo.hex [0x$start 0x$stop]" % sys.argv[0];
125 print "%s dumpdata $foo.hex [0x$start 0x$stop]" % sys.argv[0];
126 print "%s writedata $foo.hex [0x$start 0x$stop]" % sys.argv[0];
127 print "%s verify $foo.hex [0x$start 0x$stop]" % sys.argv[0];
128 print "%s peekdata 0x$start [0x$stop]" % sys.argv[0];
129 print "%s pokedata 0x$adr 0x$val" % sys.argv[0];
130 print "%s peek 0x$iram" % sys.argv[0];
131 print "%s poke 0x$iram 0x$val" % sys.argv[0];
132 print "%s peekcode 0x$start [0x$stop]" % sys.argv[0];
134 print "%s rssi [freq]\n\tGraphs signal strength on [freq] Hz." % sys.argv[0];
135 print "%s carrier [freq]\n\tHolds a carrier on [freq] Hz." % sys.argv[0];
136 print "%s reflex [freq]\n\tJams on [freq] Hz." % sys.argv[0];
137 print "%s sniffsimpliciti [us|eu|lf]\n\tSniffs SimpliciTI packets." % sys.argv[0];
138 print "%s sniffdash7 [lf]\n\tSniffs Dash7. (untested)" % sys.argv[0];
139 print "%s snifficlicker [us]\n\tSniffs iClicker." % sys.argv[0];
141 print "%s simpliciti [us|eu|lf]\n\tSimpliciti access point for Chronos watch." % sys.argv[0];
142 print "%s iclicker [us|eu|lf]\n\tSniffs iClicker packets as ASCII." % sys.argv[0];
146 #Initailize FET and set baud rate
147 #client=GoodFET.GoodFETCC.GoodFETCC();
157 if(sys.argv[1]=="carrier"):
159 client.RF_setfreq(eval(sys.argv[2]));
164 if(sys.argv[1]=="reflex"):
165 client.CC1110_crystal();
168 client.config_simpliciti();
172 client.RF_setfreq(eval(sys.argv[2]));
173 print "Listening on %f MHz." % (client.RF_getfreq()/10**6);
174 print "Jamming if RSSI>=%i" % threshold;
176 client.pokebyte(0xFE00,threshold,"xdata"); #Write threshold to shellcode.
177 client.shellcodefile("reflex.ihx");
180 while(0==client.ishalted()):
182 rssi=client.peek8(0xFE00,"xdata");
183 print "Activated jamming with RSSI of %i, going again for another packet." % rssi;
184 #client.CCdebuginstr([0x02, 0xf0, 0x00]); #ljmp 0xF000
188 if(sys.argv[1]=="rssi"):
189 client.CC1110_crystal();
192 client.config_simpliciti();
195 client.RF_setfreq(eval(sys.argv[2]));
196 print "Listening on %f MHz." % (client.RF_getfreq()/10.0**6);
200 client.CC_RFST_CAL();
205 rssi=client.RF_getrssi();
206 client.CC_RFST_IDLE(); #idle
209 for foo in range(0,rssi>>2):
210 string=("%s."%string);
211 print "%02x %04i %s" % (rssi,rssi, string);
213 if(sys.argv[1]=="sniff"):
214 client.CC1110_crystal();
217 #client.config_simpliciti(region);
219 print "Listening as %x on %f MHz" % (client.RF_getsmac(),
220 client.RF_getfreq()/10.0**6);
221 #Now we're ready to get packets.
225 packet=client.RF_rxpacket();
229 if(sys.argv[1]=="sniffsimpliciti"):
234 client.CC1110_crystal();
237 client.config_simpliciti(region);
239 print "Listening as %x on %f MHz" % (client.RF_getsmac(),
240 client.RF_getfreq()/10.0**6);
241 #Now we're ready to get packets.
245 packet=client.RF_rxpacket();
248 if(sys.argv[1]=="sniffdash7"):
253 client.CC1110_crystal();
256 client.config_dash7(region);
258 print "Listening as %x on %f MHz" % (client.RF_getsmac(),
259 client.RF_getfreq()/10.0**6);
260 #Now we're ready to get packets.
264 packet=client.RF_rxpacket();
267 if(sys.argv[1]=="snifficlicker"):
272 client.CC1110_crystal();
275 client.config_iclicker(region);
277 print "Listening as %x on %f MHz" % (client.RF_getsmac(),
278 client.RF_getfreq()/10.0**6);
279 #Now we're ready to get packets.
283 packet=client.RF_rxpacket();
286 if(sys.argv[1]=="iclicker"):
287 buttons=[0, 'A', 'j', 3, 4, 'B',
288 6, 7, 8, 9, 'E', 0xB, 0xC,
294 client.CC1110_crystal();
297 client.config_iclicker(region);
299 print "Listening as %x on %f MHz" % (client.RF_getsmac(),
300 client.RF_getfreq()/10.0**6);
301 #Now we're ready to get packets.
305 packet=client.RF_rxpacket();
307 button=((packet[5]&1)<<3) | (packet[6]>>5);
308 print "Button %c" % buttons[button];
311 if(sys.argv[1]=="simpliciti"):
316 client.CC1110_crystal();
319 client.config_simpliciti(region);
321 print "# Listening as %x on %f MHz" % (client.RF_getsmac(),
322 client.RF_getfreq()/10.0**6);
323 #Now we're ready to get packets.
327 packet=client.RF_rxpacket();
328 handlesimplicitipacket(packet);
333 if(sys.argv[1]=="term"):
334 GoodFETConsole(client).run();
335 if(sys.argv[1]=="test"):
337 if(sys.argv[1]=="deadtest"):
338 for i in range(1,10):
339 print "IDENT as %s" % client.CCidentstr();
340 if(sys.argv[1]=="dumpcode"):
345 start=int(sys.argv[3],16);
347 stop=int(sys.argv[4],16);
349 print "Dumping code from %04x to %04x as %s." % (start,stop,f);
353 h[i]=client.CCpeekcodebyte(i);
355 print "Dumped %04x."%i;
358 if(sys.argv[1]=="dumpdata"):
363 start=int(sys.argv[3],16);
365 stop=int(sys.argv[4],16);
367 print "Dumping data from %04x to %04x as %s." % (start,stop,f);
371 h[i]=client.CCpeekdatabyte(i);
373 print "Dumped %04x."%i;
376 if(sys.argv[1]=="status"):
377 print "Status: %s" %client.status();
378 if(sys.argv[1]=="halt"):
382 if(sys.argv[1]=="infotest"):
385 print "Ident %s" % client.CCidentstr();
386 if(sys.argv[1]=="info"):
387 print "Ident %s" % client.CCidentstr();
390 print "Freq %10.3f MHz" % (client.RF_getfreq()/10**6);
391 print "RSSI %02x" % client.RF_getrssi();
393 print "Freq, RSSI, etc unknown. Install SmartRF7.";
394 #print "Rate %10i kbps" % (client.RF_getrate()/1000);
395 #print "PacketLen %02i bytes" % client.RF_getpacketlen();
396 #print "SMAC 0x%010x" % client.RF_getsmac();
397 #print "TMAC 0x%010x" % client.RF_gettmac();
399 if(sys.argv[1]=="regs"):
402 if(sys.argv[1]=="erase"):
403 print "Status: %s" % client.status();
404 client.CCchiperase();
405 print "Status: %s" %client.status();
407 if(sys.argv[1]=="peekinfo"):
408 print "Select info flash."
409 client.CCwr_config(1);
410 print "Config is %02x" % client.CCrd_config();
414 start=int(sys.argv[2],16);
417 stop=int(sys.argv[3],16);
418 print "Peeking from %04x to %04x." % (start,stop);
420 print "%04x: %02x" % (start,client.CCpeekcodebyte(start));
422 if(sys.argv[1]=="poke"):
423 client.CCpokeirambyte(int(sys.argv[2],16),
424 int(sys.argv[3],16));
425 if(sys.argv[1]=="randtest"):
427 client.CCpokeirambyte(0xBD,0x01); #RNDH=0x01
428 client.CCpokeirambyte(0xB4,0x04); #ADCCON1=0x04
429 client.CCpokeirambyte(0xBD,0x01); #RNDH=0x01
430 client.CCpokeirambyte(0xB4,0x04); #ADCCON1=0x04
433 for foo in range(1,10):
434 print "%02x" % client.CCpeekirambyte(0xBD); #RNDH
435 client.CCpokeirambyte(0xB4,0x04); #ADCCON1=0x04
436 client.CCreleasecpu();
438 print "%02x" % client.CCpeekdatabyte(0xDF61); #CHIP ID
439 if(sys.argv[1]=="adctest"):
440 # ADCTest 0xDF3A 0xDF3B
441 print "ADC TEST %02x%02x" % (
442 client.CCpeekdatabyte(0xDF3A),
443 client.CCpeekdatabyte(0xDF3B));
444 if(sys.argv[1]=="config"):
445 print "Config is %02x" % client.CCrd_config();
447 if(sys.argv[1]=="flash"):
452 start=int(sys.argv[3],16);
454 stop=int(sys.argv[4],16);
457 if(sys.argv[1]=="lock"):
458 print "Status: %s" %client.status();
460 print "Status: %s" %client.status();
461 if(sys.argv[1]=="flashpage"):
464 target=int(sys.argv[2],16);
465 print "Writing a page of flash from 0xF000 in XDATA"
466 client.CCflashpage(target);
467 if(sys.argv[1]=="erasebuffer"):
468 print "Erasing flash buffer.";
469 client.CCeraseflashbuffer();
471 if(sys.argv[1]=="writedata"):
476 start=int(sys.argv[3],16);
478 stop=int(sys.argv[4],16);
482 for i in h._buf.keys():
483 if(i>=start and i<=stop):
484 client.CCpokedatabyte(i,h[i]);
487 #if(sys.argv[1]=="flashtest"):
488 # client.CCflashtest();
489 if(sys.argv[1]=="peekdata"):
492 start=int(sys.argv[2],16);
495 stop=int(sys.argv[3],16);
496 print "Peeking from %04x to %04x." % (start,stop);
498 print "%04x: %02x" % (start,client.CCpeekdatabyte(start));
500 if(sys.argv[1]=="peek"):
503 start=int(sys.argv[2],16);
506 stop=int(sys.argv[3],16);
507 print "Peeking from %04x to %04x." % (start,stop);
509 print "%04x: %02x" % (start,client.CCpeekirambyte(start));
511 if(sys.argv[1]=="verify"):
516 start=int(sys.argv[3],16);
518 stop=int(sys.argv[4],16);
521 for i in h._buf.keys():
522 if(i>=start and i<stop):
523 peek=client.CCpeekcodebyte(i)
525 print "ERROR at %04x, found %02x not %02x"%(i,peek,h[i]);
528 if(sys.argv[1]=="peekcode"):
531 start=int(sys.argv[2],16);
534 stop=int(sys.argv[3],16);
535 print "Peeking from %04x to %04x." % (start,stop);
537 print "%04x: %02x" % (start,client.CCpeekcodebyte(start));
539 if(sys.argv[1]=="pokedata"):
543 start=int(sys.argv[2],16);
545 val=int(sys.argv[3],16);
546 print "Poking %04x to become %02x." % (start,val);
547 client.CCpokedatabyte(start,val);