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 " use \'?\' for list of commands";
121 print "%s info" % sys.argv[0];
122 print "%s infotest" % sys.argv[0];
123 print "%s radioinfo [help] [REGISTER_NAME]" % sys.argv[0];
124 print "%s specfuncreg [SPECIAL_REGISTER_NAME]" % sys.argv[0];
125 print "%s halt" % sys.argv[0];
126 print "%s regs" % sys.argv[0];
127 print "%s dumpcode $foo.hex [0x$start 0x$stop]" % sys.argv[0];
128 print "%s dumpdata $foo.hex [0x$start 0x$stop]" % sys.argv[0];
129 print "%s writedata $foo.hex [0x$start 0x$stop]" % sys.argv[0];
130 print "%s verify $foo.hex [0x$start 0x$stop]" % sys.argv[0];
131 print "%s peekdata 0x$start [0x$stop]" % sys.argv[0];
132 print "%s pokedata 0x$adr 0x$val" % sys.argv[0];
133 print "%s peek 0x$iram" % sys.argv[0];
134 print "%s poke 0x$iram 0x$val" % sys.argv[0];
135 print "%s peekcode 0x$start [0x$stop]" % sys.argv[0];
137 print "%s rssi [freq]\n\tGraphs signal strength on [freq] Hz." % sys.argv[0];
138 print "%s carrier [freq]\n\tHolds a carrier on [freq] Hz." % sys.argv[0];
139 print "%s reflex [freq]\n\tJams on [freq] Hz." % sys.argv[0];
140 print "%s sniffsimpliciti [us|eu|lf]\n\tSniffs SimpliciTI packets." % sys.argv[0];
141 print "%s sniffdash7 [lf]\n\tSniffs Dash7. (untested)" % sys.argv[0];
142 print "%s snifficlicker [us]\n\tSniffs iClicker." % sys.argv[0];
144 print "%s simpliciti [us|eu|lf]\n\tSimpliciti access point for Chronos watch." % sys.argv[0];
145 print "%s iclicker [us|eu|lf]\n\tSniffs iClicker packets as ASCII." % sys.argv[0];
149 #Initailize FET and set baud rate
150 #client=GoodFET.GoodFETCC.GoodFETCC();
160 client.pokebyte(0xc7,0x08);
162 if(sys.argv[1]=="carrier"):
164 client.RF_setfreq(eval(sys.argv[2]));
169 if(sys.argv[1]=="reflex"):
170 client.CC1110_crystal();
173 client.config_simpliciti();
177 client.RF_setfreq(eval(sys.argv[2]));
178 print "Listening on %f MHz." % (client.RF_getfreq()/10**6);
179 print "Jamming if RSSI>=%i" % threshold;
181 client.pokebyte(0xFE00,threshold,"xdata"); #Write threshold to shellcode.
182 client.shellcodefile("reflex.ihx");
185 while(0==client.ishalted()):
187 rssi=client.peek8(0xFE00,"xdata");
188 print "Activated jamming with RSSI of %i, going again for another packet." % rssi;
192 if(sys.argv[1]=="rssi"):
193 client.CC1110_crystal();
196 client.config_simpliciti();
199 client.RF_setfreq(eval(sys.argv[2]));
200 print "Listening on %f MHz." % (client.RF_getfreq()/10.0**6);
204 client.CC_RFST_CAL();
209 rssi=client.RF_getrssi();
210 client.CC_RFST_IDLE(); #idle
213 for foo in range(0,rssi>>2):
214 string=("%s."%string);
215 print "%02x %04i %s" % (rssi,rssi, string);
217 if(sys.argv[1]=="sniff"):
218 client.CC1110_crystal();
221 #client.config_simpliciti(region);
223 print "Listening as %x on %f MHz" % (client.RF_getsmac(),
224 client.RF_getfreq()/10.0**6);
225 #Now we're ready to get packets.
229 packet=client.RF_rxpacket();
233 if(sys.argv[1]=="sniffsimpliciti"):
238 client.CC1110_crystal();
241 client.config_simpliciti(region);
243 print "Listening as %x on %f MHz" % (client.RF_getsmac(),
244 client.RF_getfreq()/10.0**6);
245 #Now we're ready to get packets.
249 packet=client.RF_rxpacket();
252 if(sys.argv[1]=="sniffook"):
257 client.CC1110_crystal();
260 client.config_ook(region);
262 print "Listening for OOK on %f MHz" % (client.RF_getfreq()/10.0**6);
263 #Now we're ready to get packets.
267 packet=client.RF_rxpacket();
270 if(sys.argv[1]=="sniffdash7"):
275 client.CC1110_crystal();
278 client.config_dash7(region);
280 print "Listening as %x on %f MHz" % (client.RF_getsmac(),
281 client.RF_getfreq()/10.0**6);
282 #Now we're ready to get packets.
286 packet=client.RF_rxpacket();
289 if(sys.argv[1]=="snifficlicker"):
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();
308 if(sys.argv[1]=="iclicker"):
309 buttons=[0, 'A', 'j', 3, 4, 'B',
310 6, 7, 8, 9, 'E', 0xB, 0xC,
316 client.CC1110_crystal();
319 client.config_iclicker(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();
329 button=((packet[5]&1)<<3) | (packet[6]>>5);
330 print "Button %c" % buttons[button];
333 if(sys.argv[1]=="simpliciti"):
338 client.CC1110_crystal();
341 client.config_simpliciti(region);
343 print "# Listening as %x on %f MHz" % (client.RF_getsmac(),
344 client.RF_getfreq()/10.0**6);
345 #Now we're ready to get packets.
349 packet=client.RF_rxpacket();
350 handlesimplicitipacket(packet);
355 if(sys.argv[1]=="term"):
356 GoodFETConsole(client).run();
357 if(sys.argv[1]=="test"):
359 if(sys.argv[1]=="deadtest"):
360 for i in range(1,10):
361 print "IDENT as %s" % client.CCidentstr();
362 if(sys.argv[1]=="dumpcode"):
367 start=int(sys.argv[3],16);
369 stop=int(sys.argv[4],16);
371 print "Dumping code from %04x to %04x as %s." % (start,stop,f);
375 h[i]=client.CCpeekcodebyte(i);
377 print "Dumped %04x."%i;
380 if(sys.argv[1]=="dumpdata"):
385 start=int(sys.argv[3],16);
387 stop=int(sys.argv[4],16);
389 print "Dumping data from %04x to %04x as %s." % (start,stop,f);
393 h[i]=client.CCpeekdatabyte(i);
395 print "Dumped %04x."%i;
398 if(sys.argv[1]=="status"):
399 print "Status: %s" %client.status();
400 if(sys.argv[1]=="halt"):
404 if(sys.argv[1]=="infotest"):
407 print "Ident %s" % client.CCidentstr();
408 if(sys.argv[1]=="info"):
409 print "Ident %s" % client.CCidentstr();
412 print "Freq %10.3f MHz" % (client.RF_getfreq()/10**6);
413 print "RSSI %02x" % client.RF_getrssi();
415 print "Freq, RSSI, etc unknown. Install SmartRF7.";
416 #print "Rate %10i kbps" % (client.RF_getrate()/1000);
417 #print "PacketLen %02i bytes" % client.RF_getpacketlen();
418 #print "SMAC 0x%010x" % client.RF_getsmac();
419 #print "TMAC 0x%010x" % client.RF_gettmac();
421 if(sys.argv[1]=="radioinfo"):
422 if (len(sys.argv) - 2) > 0:
423 client.CMDrs(sys.argv[2:]);
427 if(sys.argv[1]=="regs"):
430 if(sys.argv[1]=="erase"):
431 print "Status: %s" % client.status();
432 client.CCchiperase();
433 print "Status: %s" %client.status();
435 if(sys.argv[1]=="peekinfo"):
436 print "Select info flash."
437 client.CCwr_config(1);
438 print "Config is %02x" % client.CCrd_config();
442 start=int(sys.argv[2],16);
445 stop=int(sys.argv[3],16);
446 print "Peeking from %04x to %04x." % (start,stop);
448 print "%04x: %02x" % (start,client.CCpeekcodebyte(start));
450 if(sys.argv[1]=="poke"):
451 client.CCpokeirambyte(int(sys.argv[2],16),
452 int(sys.argv[3],16));
453 if(sys.argv[1]=="randtest"):
455 client.CCpokeirambyte(0xBD,0x01); #RNDH=0x01
456 client.CCpokeirambyte(0xB4,0x04); #ADCCON1=0x04
457 client.CCpokeirambyte(0xBD,0x01); #RNDH=0x01
458 client.CCpokeirambyte(0xB4,0x04); #ADCCON1=0x04
461 for foo in range(1,10):
462 print "%02x" % client.CCpeekirambyte(0xBD); #RNDH
463 client.CCpokeirambyte(0xB4,0x04); #ADCCON1=0x04
464 client.CCreleasecpu();
466 print "%02x" % client.CCpeekdatabyte(0xDF61); #CHIP ID
467 if(sys.argv[1]=="adctest"):
468 # ADCTest 0xDF3A 0xDF3B
469 print "ADC TEST %02x%02x" % (
470 client.CCpeekdatabyte(0xDF3A),
471 client.CCpeekdatabyte(0xDF3B));
472 if(sys.argv[1]=="config"):
473 print "Config is %02x" % client.CCrd_config();
475 if(sys.argv[1]=="specfuncreg" or sys.argv[1]=="sfr"):
476 if len(sys.argv) > 2:
477 client.getSPR(sys.argv[2:]);
481 if(sys.argv[1]=="flash"):
486 start=int(sys.argv[3],16);
488 stop=int(sys.argv[4],16);
491 if(sys.argv[1]=="lock"):
492 print "Status: %s" %client.status();
494 print "Status: %s" %client.status();
495 if(sys.argv[1]=="flashpage"):
498 target=int(sys.argv[2],16);
499 print "Writing a page of flash from 0xF000 in XDATA"
500 client.CCflashpage(target);
501 if(sys.argv[1]=="erasebuffer"):
502 print "Erasing flash buffer.";
503 client.CCeraseflashbuffer();
505 if(sys.argv[1]=="writedata"):
510 start=int(sys.argv[3],16);
512 stop=int(sys.argv[4],16);
516 for i in h._buf.keys():
517 if(i>=start and i<=stop):
518 client.CCpokedatabyte(i,h[i]);
521 #if(sys.argv[1]=="flashtest"):
522 # client.CCflashtest();
523 if(sys.argv[1]=="peekdata"):
526 start=int(sys.argv[2],16);
529 stop=int(sys.argv[3],16);
530 print "Peeking from %04x to %04x." % (start,stop);
532 print "%04x: %02x" % (start,client.CCpeekdatabyte(start));
534 if(sys.argv[1]=="peek"):
537 start=int(sys.argv[2],16);
540 stop=int(sys.argv[3],16);
541 print "Peeking from %04x to %04x." % (start,stop);
543 print "%04x: %02x" % (start,client.CCpeekirambyte(start));
545 if(sys.argv[1]=="verify"):
550 start=int(sys.argv[3],16);
552 stop=int(sys.argv[4],16);
555 for i in h._buf.keys():
556 if(i>=start and i<stop):
557 peek=client.CCpeekcodebyte(i)
559 print "ERROR at %04x, found %02x not %02x"%(i,peek,h[i]);
562 if(sys.argv[1]=="peekcode"):
565 start=int(sys.argv[2],16);
568 stop=int(sys.argv[3],16);
569 print "Peeking from %04x to %04x." % (start,stop);
571 print "%04x: %02x" % (start,client.CCpeekcodebyte(start));
573 if(sys.argv[1]=="pokedata"):
577 start=int(sys.argv[2],16);
579 val=int(sys.argv[3],16);
580 print "Poking %04x to become %02x." % (start,val);
581 client.CCpokedatabyte(start,val);