3 #GoodFET SPI Flash Client
11 from GoodFETNRF import GoodFETNRF;
12 from intelhex import IntelHex;
15 regnames=["CONFIG","EN_AA","EN_RXADDR","SETUP_AW","SETUP_RET",
16 "RF_CH","RF_SETUP","STATUS","OBSERVE_TX","RPD",
17 "RX_ADDR_P0","RX_ADDR_P1","RX_ADDR_P2","RX_ADDR_P3","RX_ADDR_P4","RX_ADDR_P5",
19 "RX_PW_P0","RX_PW_P1","RX_PW_P2","RX_PW_P3","RX_PW_P4","RX_PW_P5",
21 "?","?","?","DYNPD","FEATURE","AGC_CONFIG","?","?",
22 "?","?","?","?","?","?","?","?"];
24 def printpacket(packet):
29 if i>client.packetlen: break;
30 s="%s %02x" % (s,ord(foo));
34 print "Encoding %s" % client.RF_getenc();
35 print "Freq %10i MHz" % (client.RF_getfreq()/10**6);
36 print "Rate %10i kbps" % (client.RF_getrate()/1000);
37 print "PacketLen %02i bytes" % client.RF_getpacketlen();
38 #print "MacLen %2i bytes" % client.RF_getmaclen();
39 print "SMAC 0x%010x" % client.RF_getsmac();
40 print "TMAC 0x%010x" % client.RF_gettmac();
44 print "Usage: %s verb [objects]\n" % sys.argv[0];
45 print "%s info" % sys.argv[0];
46 print "%s test" % sys.argv[0];
47 print "%s regs" % sys.argv[0];
48 print "%s regbits" % sys.argv[0];
49 print "%s pyregs" % sys.argv[0];
51 print "%s sniff\n\tSniffs packets by current config." % sys.argv[0];
52 print "%s sniffob\n\tSniffs OpenBeacon traffic." % sys.argv[0];
53 print "%s snifftp\n\tSniffs Turning Point Clicker traffic." % sys.argv[0];
54 print "%s sniffsf\n\tSniffs SparkFun Dongle traffic." % sys.argv[0];
56 print "%s sniffprom [0xaa|0x55]\n\tSniffs promiscuously for a preamble of 0xAA or 0x55" % sys.argv[0];
57 print "%s autotune\n\tSearches for a valid destination address." % sys.argv[0];
59 print "%s sniffskybrake\n\tSniffs skybrake. [broken?]" % sys.argv[0];
60 print "%s sniffmskb\n\tSniffs MS KB. [broken?]" % sys.argv[0];
63 print "%s hosttp\n\tHosts Turning Point Clicker traffic." % sys.argv[0];
65 print "%s carrier [freq]\n\tHolds a carrier on [freq] Hz." % sys.argv[0];
68 #Initialize FET and set baud rate
74 if(sys.argv[1]=="info"):
77 if(sys.argv[1]=="test"):
78 print "Old registers:"
81 # Set PWR_UP=1 and PRIM_RX=0 in CONFIG.
83 #Delay of 1.5ms by round-trip.
88 for foo in [250*10**3,
91 client.RF_setrate(foo);
92 if(client.RF_getrate()!=foo):
93 print "ERROR Rate %i not supported. Got %i instead." % (foo,
97 client.poke(0x0A,0xDEADBEEF,5);
98 #print "SMAC set to %010x" % client.RF_getsmac();
99 if client.RF_getsmac()!=0xdeadbeef:
100 print "ERROR: Failed to set MAC address.";
101 print "Final registers:"
104 if(sys.argv[1]=="carrier"):
106 client.RF_setfreq(eval(sys.argv[2]));
109 print "\nHolding a carrier wave.";
112 if(sys.argv[1]=="regs"):
113 for r in range(0,0x20):
114 print "r[0x%02x]=0x%010x //%16s " % (r,client.peek(r),regnames[r]);
115 if(sys.argv[1]=="pyregs"):
116 for r in range(0,0x20):
117 print "client.set(0x%02x,0x%010x); #%16s " % (r,client.peek(r),regnames[r]);
119 if(sys.argv[1]=="peek"):
122 start=int(sys.argv[2],16);
125 stop=int(sys.argv[3],16);
126 print "Peeking from %02x to %02x." % (start,stop);
128 print "%02x: %010x" % (start,client.peek(start));
130 if(sys.argv[1]=="poke"):
134 start=int(sys.argv[2],16);
136 val=int(sys.argv[3],16);
137 print "Poking %02x to become %010x." % (start,val);
139 client.poke(start,val);
140 print "Poked to %04x" % client.peek(start);
142 if(sys.argv[1]=="sniffob"):
143 #Reversal of transmitter code from nRF_CMD.c of OpenBeacon
144 #TODO remove all poke() calls.
146 client.poke(0x00,0x00); #Stop nRF
147 client.poke(0x01,0x00); #Disable Shockburst
148 client.poke(0x02,0x01); #Set RX Pipe 0
150 client.RF_setfreq(2481 * 10**6);
151 client.poke(0x06,0x09); #2MBps, -18dBm in RF_SETUP
152 client.poke(0x07,0x78); #Reset status register
154 #OpenBeacon defines these in little endian as follows.
155 client.RF_setmaclen(5); # SETUP_AW for 5-byte addresses.
156 #0x01, 0x02, 0x03, 0x02, 0x01
157 client.RF_setsmac(0x0102030201);
158 #'O', 'C', 'A', 'E', 'B'
159 client.RF_settmac(0x424541434F);
161 #Set packet length of 16.
162 client.RF_setpacketlen(16);
164 #Power radio, prime for RX, one-byte checksum.
165 client.poke(0x00,0x70|0x03|0x08); #0x08 for one byte, 0x04 for two.
167 print "Listening as %010x on %i MHz" % (client.RF_getsmac(),
168 client.RF_getfreq()/10**6);
169 #Now we're ready to get packets.
174 packet=client.RF_rxpacket();
178 if(sys.argv[1]=="regbits"):
179 print "Scanning registers to determine which bits are valid."
180 regbits=range(0,0x30);
181 for r in range(0,0x30):
183 #Which bits can be set?
186 #Which bits can be clear?
188 zeroes=client.peek(r);
189 regbits[r]=(ones & (~zeroes));
190 for r in range(0,0x30):
192 print "r[0x%02x] masked %02x // %s" % (r,regbits[r], regnames[r]);
193 if(sys.argv[1]=="sniffprom"):
194 #Reversal of transmitter code from nRF_CMD.c of OpenBeacon
195 #TODO remove all poke() calls.
197 client.poke(0x00,0x00); #Stop nRF
198 client.poke(0x01,0x00); #Disable Shockburst
199 client.poke(0x02,0x01); #Set RX Pipe 0
201 #client.RF_setfreq(2481 * 10**6);
202 #client.poke(0x06,0x09); #2MBps, -18dBm in RF_SETUP
203 client.poke(0x07,0x78); #Reset status register
205 #OpenBeacon defines these in little endian as follows.
206 client.RF_setmaclen(2); # SETUP_AW for shortest
208 #It's better to have a known fragment, when one is available.
209 #client.RF_setsmac(0x00AA);
210 #client.RF_setsmac(0x0055);
212 #Should end in 55 or AA depending upon the packet.
215 tail=int(sys.argv[2],16);
217 print "Please specify a tail of 0xAA or 0x55.";
219 client.RF_setsmac(tail);
222 client.RF_setpacketlen(32);
224 #Power radio, prime for RX, no checksum
225 client.poke(0x00,0x70|0x03); #0x08 for checksum, 0x04 for two.
227 print "Listening as %010x on %i MHz" % (client.RF_getsmac(),
228 client.RF_getfreq()/10**6);
229 #Now we're ready to get packets.
234 packet=client.RF_rxpacket();
239 """This guesses addresses by searching through packets."""
243 def init(self,goodfet):
244 """Initializes a link to the GoodFET for autotuning."""
246 def packetaddr(self,packet):
247 """Returns a loaded packet address, including channel and rate."""
249 sync=self.client.RF_getsmac()&0xFF;
254 mac="%s%02x" % (mac,ord(packet[i]));
255 ch=self.client.peek(0x05);
256 rate=self.client.peek(0x06);
257 return "%02x,%s,%02x,%02x" % (
259 def handle(self,packet):
260 """Handles a packet."""
261 #printpacket(packet);
262 #self.packets.append(packet);
263 addr=self.packetaddr(packet);
265 #Increment the address count.
268 count=self.addresses[addr];
271 self.addresses[addr]=count+1;
272 rate=count*1.0/len(self.addresses);
273 if self.addresses[addr]>1 or rate>0.01:
274 print "'%s' looks valid\t%i\t%0.5f" % (
278 def retune(self,freqmod=0x52):
279 """Tunes to another channel or preamble looking for the next packet."""
280 count=self.tunecount+1;
281 self.tunecount=count;
283 #Swap the SYNC value most often.
287 self.client.RF_setsmac(sync);
293 #This swaps between 1Mbps and 2Mbps.
294 #TODO add support for 256kbps, if anyone uses it.
297 #print "Setting rate to 0x%02x" % rate;
300 self.client.poke(0x06,rate);
303 #Grab two packets to clear buffers.
304 #Should retune only after a few packets to reduce this delay.
305 packet=client.RF_rxpacket();
306 packet=client.RF_rxpacket();
310 if(sys.argv[1]=="autotune"):
311 #Reversal of transmitter code from nRF_CMD.c of OpenBeacon
312 #TODO remove all poke() calls.
314 guesser.init(client);
316 client.poke(0x00,0x00); #Stop nRF
317 client.poke(0x01,0x00); #Disable Shockburst
318 client.poke(0x02,0x01); #Set RX Pipe 0
320 #client.RF_setfreq(2481 * 10**6);
321 #client.poke(0x06,0x09); #2MBps, -18dBm in RF_SETUP
322 client.poke(0x07,0x78); #Reset status register
324 #OpenBeacon defines these in little endian as follows.
325 client.RF_setmaclen(2); # SETUP_AW for shortest
327 #This is determined by the MAC, which we don't yet know.
328 #AutoTuner() takes care of finding it.
329 #client.RF_setsmac(0x00AA);
330 #client.RF_setsmac(0x0055);
333 client.RF_setpacketlen(32);
335 #Power radio, prime for RX, no checksum
336 client.poke(0x00,0x70|0x03); #0x08 for checksum, 0x04 for two.
338 print "Autotuning as %010x on %i MHz" % (client.RF_getsmac(),
339 client.RF_getfreq()/10**6);
340 print "sync,mac,r5,r6";
341 #Now we're ready to get packets.
345 packet=client.RF_rxpacket();
346 guesser.handle(packet);
350 if(sys.argv[1]=="sniffmskb"):
352 #TODO remove all poke() calls.
354 client.poke(0x00,0x00); #Stop nRF
355 client.poke(0x01,0x00); #Disable Shockburst
356 client.poke(0x02,0x01); #Set RX Pipe 0
358 client.poke(0x06,0x09); #2MBps, -18dBm in RF_SETUP
359 client.poke(0x07,0x78); #Reset status register
361 #This is the address of a specific keyboard.
362 #Other keyboards will be different.
365 client.RF_setmaclen(2);
367 #Known pairs. The channel and the low address bytes must match.
368 #client.RF_setfreq((2400+0x13) * 10**6);
369 #client.RF_setsmac(0x0c00a3598cd);
371 client.RF_setfreq((2400+0x15) * 10**6);
372 client.RF_setsmac( 0x0c10446facd);
374 #Mac packet length, illegally 0-length address field.
375 client.RF_setpacketlen(32);
377 #Power radio, prime for RX, no checksum
378 client.poke(0x00,0x70|0x03); #0x08 for checksum, 0x04 for two.
380 print "Listening as %010x on %i MHz" % (client.RF_getsmac(),
381 client.RF_getfreq()/10**6);
382 #Now we're ready to get packets.
387 packet=client.RF_rxpacket();
393 if(sys.argv[1]=="sniffskybrake"):
394 #Reversal of transmitter code from nRF_CMD.c of OpenBeacon
395 #TODO remove all poke() calls.
397 client.poke(0x00,0x00); #Stop nRF
398 client.poke(0x01,0x00); #Disable Shockburst
399 client.poke(0x02,0x01); #Set RX Pipe 0
401 client.RF_setfreq(2439 * 10**6);
402 client.poke(0x06,0x00); #1MBps
403 client.poke(0x07,0x78); #Reset status register
405 #OpenBeacon defines these in little endian as follows.
406 client.RF_setmaclen(2); # SETUP_AW for 3-byte addresses.
407 #0x01, 0x02, 0x03, 0x02, 0x01
409 client.RF_setsmac(0x070700d2c4); #reversed
411 #client.RF_setsmac(0xd2c4);
412 #client.RF_setsmac(0);
414 #Mac packet length, illegally 0-length address field.
415 client.RF_setpacketlen(32);
417 #Power radio, prime for RX, one-byte checksum.
418 client.poke(0x00,0x70|0x03); #0x08 for one byte, 0x04 for two.
420 print "Listening as %010x on %i MHz" % (client.RF_getsmac(),
421 client.RF_getfreq()/10**6);
422 print "%i byte mac match." % client.RF_getmaclen();
423 #Now we're ready to get packets.
428 packet=client.RF_rxpacket();
432 if(sys.argv[1]=="sniffsf"):
433 #Reversal of transmitter code from nRF_CMD.c of OpenBeacon
434 #TODO remove all poke() calls.
436 client.poke(0x00,0x00); #Stop nRF
437 client.poke(0x01,0x00); #Disable Shockburst
438 client.poke(0x02,0x01); #Set RX Pipe 0
440 client.RF_setfreq(2402 * 10**6);
441 client.poke(0x06,0x07); #1Mbps
442 client.poke(0x07,0x78); #Reset status register
444 #OpenBeacon defines these in little endian as follows.
445 client.RF_setmaclen(5); # SETUP_AW for 5-byte addresses.
446 client.RF_setsmac(0xe7e7e7e7e7);
447 client.RF_settmac(0xe7e7e7e7e7);
449 #Set packet length of 16.
450 client.RF_setpacketlen(4);
452 #Power radio, prime for RX, one-byte checksum.
453 client.poke(0x00,0x70|0x03|0x08); #0x08 for one byte, 0x04 for two.
455 print "Listening as %010x on %i MHz" % (client.RF_getsmac(),
456 client.RF_getfreq()/10**6);
457 #Now we're ready to get packets.
462 packet=client.RF_rxpacket();
466 if(sys.argv[1]=="snifftp"):
467 client.poke(0x00,0x00); #Stop nRF
468 client.poke(0x01,0x00); #Disable Shockburst
469 client.poke(0x02,0x01); #Set RX Pipe 0
471 client.RF_setfreq((2400+0x29) * 10**6);
472 client.poke(0x06,0x00); #1Mbps
473 client.poke(0x07,0x78); #Reset status register
475 client.RF_setmaclen(3); # SETUP_AW for 3-byte addresses.
476 client.RF_setsmac(0x123456);
477 client.RF_setpacketlen(4);
479 #Power radio, prime for RX, two-byte checksum.
480 client.poke(0x00,0x70|0x03|0x04|0x08);
482 print "Listening as %010x on %i MHz" % (client.RF_getsmac(),
483 client.RF_getfreq()/10**6);
484 #Now we're ready to get packets.
489 packet=client.RF_rxpacket();
493 if(sys.argv[1]=="hosttp"):
494 client.poke(0x00,0x00); #Stop nRF
495 client.poke(0x01,0x00); #Disable Shockburst
496 client.poke(0x02,0x01); #Set RX Pipe 0
500 client.RF_setfreq((2400+chan) * 10**6);
501 client.poke(0x06,0x00); #1Mbps
502 client.poke(0x07,0x78); #Reset status register
504 client.RF_setmaclen(3); # SETUP_AW for 3-byte addresses.
505 client.RF_setsmac(0x123456);
506 client.RF_setpacketlen(4);
508 #Power radio, prime for RX, two-byte checksum.
509 client.poke(0x00,0x70|0x03|0x04|0x08);
511 print "Listening as %010x on %i MHz" % (client.RF_getsmac(),
512 client.RF_getfreq()/10**6);
513 #Now we're ready to get packets.
517 packet=client.RF_rxpacket();
518 mac=((ord(packet[0])<<16)+
522 print "%c from %06x" % (key,mac);
525 if(sys.argv[1]=="sniff"):
526 #client.poke(0x00,0x00); #Stop nRF
527 client.poke(0x07,0x78); #Reset status register
529 #Power radio, prime for RX, checksum.
530 client.poke(0x00,0x70|0x03|0x08);
532 print "Listening as %010x on %i MHz" % (client.RF_getsmac(),
533 client.RF_getfreq()/10**6);
534 #Now we're ready to get packets.
540 packet=client.RF_rxpacket();
543 if(sys.argv[1]=="explore"):
544 #client.poke(0x00,0x00); #Stop nRF
545 client.poke(0x07,0x78); #Reset status register
547 #Power radio, prime for RX, no checksum.
548 client.poke(0x00,0x70|0x03);
550 #Set packet length of 32.
551 #Without checksums, extra data will mix in.
552 client.RF_setpacketlen(32);
553 client.RF_setmaclen(3); # shortest address length
555 #Now we're ready to get packets.
556 for smac in [0x0102030201, 0]:
557 client.RF_setsmac(smac);
558 for chan in range(0,0x80):
559 client.RF_setfreq((2400+chan) * 10**6);
561 packet=client.RF_rxpacket();
563 print "Listening as %010x on %i MHz" % (client.RF_getsmac(),
564 client.RF_getfreq()/10**6);