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();
238 class AddressGuesser():
239 """This guesses addresses by searching through packets."""
243 def init(self,goodfet):
245 def packetaddr(self,packet):
248 s="%s%02x" % (s,ord(packet[i]));
250 def handle(self,packet):
251 #printpacket(packet);
252 #self.packets.append(packet);
253 addr=self.packetaddr(packet);
255 #Increment the address count.
258 count=self.addresses[addr];
261 self.addresses[addr]=count+1;
262 rate=count*1.0/len(self.addresses);
263 if self.addresses[addr]>1 or rate>0.01:
264 print "'%s' looks valid\t%i\t%0.5f" % (
268 if(sys.argv[1]=="autotune"):
269 #Reversal of transmitter code from nRF_CMD.c of OpenBeacon
270 #TODO remove all poke() calls.
271 guesser=AddressGuesser();
273 client.poke(0x00,0x00); #Stop nRF
274 client.poke(0x01,0x00); #Disable Shockburst
275 client.poke(0x02,0x01); #Set RX Pipe 0
277 #client.RF_setfreq(2481 * 10**6);
278 #client.poke(0x06,0x09); #2MBps, -18dBm in RF_SETUP
279 client.poke(0x07,0x78); #Reset status register
281 #OpenBeacon defines these in little endian as follows.
282 client.RF_setmaclen(2); # SETUP_AW for shortest
284 #It's better to have a known fragment, when one is available.
285 #client.RF_setsmac(0x00AA);
286 #client.RF_setsmac(0x0055);
288 #Should end in 55 or AA depending upon the packet.
291 tail=int(sys.argv[2],16);
293 print "Please specify a tail of 0xAA or 0x55.";
295 client.RF_setsmac(tail);
298 client.RF_setpacketlen(32);
300 #Power radio, prime for RX, no checksum
301 client.poke(0x00,0x70|0x03); #0x08 for checksum, 0x04 for two.
303 print "Listening as %010x on %i MHz" % (client.RF_getsmac(),
304 client.RF_getfreq()/10**6);
305 #Now we're ready to get packets.
309 packet=client.RF_rxpacket();
310 guesser.handle(packet);
313 if(sys.argv[1]=="sniffmskb"):
315 #TODO remove all poke() calls.
317 client.poke(0x00,0x00); #Stop nRF
318 client.poke(0x01,0x00); #Disable Shockburst
319 client.poke(0x02,0x01); #Set RX Pipe 0
321 client.poke(0x06,0x09); #2MBps, -18dBm in RF_SETUP
322 client.poke(0x07,0x78); #Reset status register
324 #This is the address of a specific keyboard.
325 #Other keyboards will be different.
328 client.RF_setmaclen(2);
330 #Known pairs. The channel and the low address bytes must match.
331 #client.RF_setfreq((2400+0x13) * 10**6);
332 #client.RF_setsmac(0x0c00a3598cd);
334 client.RF_setfreq((2400+0x15) * 10**6);
335 client.RF_setsmac( 0x0c10446facd);
337 #Mac packet length, illegally 0-length address field.
338 client.RF_setpacketlen(32);
340 #Power radio, prime for RX, no checksum
341 client.poke(0x00,0x70|0x03); #0x08 for checksum, 0x04 for two.
343 print "Listening as %010x on %i MHz" % (client.RF_getsmac(),
344 client.RF_getfreq()/10**6);
345 #Now we're ready to get packets.
350 packet=client.RF_rxpacket();
356 if(sys.argv[1]=="sniffskybrake"):
357 #Reversal of transmitter code from nRF_CMD.c of OpenBeacon
358 #TODO remove all poke() calls.
360 client.poke(0x00,0x00); #Stop nRF
361 client.poke(0x01,0x00); #Disable Shockburst
362 client.poke(0x02,0x01); #Set RX Pipe 0
364 client.RF_setfreq(2439 * 10**6);
365 client.poke(0x06,0x00); #1MBps
366 client.poke(0x07,0x78); #Reset status register
368 #OpenBeacon defines these in little endian as follows.
369 client.RF_setmaclen(2); # SETUP_AW for 3-byte addresses.
370 #0x01, 0x02, 0x03, 0x02, 0x01
372 client.RF_setsmac(0x070700d2c4); #reversed
374 #client.RF_setsmac(0xd2c4);
375 #client.RF_setsmac(0);
377 #Mac packet length, illegally 0-length address field.
378 client.RF_setpacketlen(32);
380 #Power radio, prime for RX, one-byte checksum.
381 client.poke(0x00,0x70|0x03); #0x08 for one byte, 0x04 for two.
383 print "Listening as %010x on %i MHz" % (client.RF_getsmac(),
384 client.RF_getfreq()/10**6);
385 print "%i byte mac match." % client.RF_getmaclen();
386 #Now we're ready to get packets.
391 packet=client.RF_rxpacket();
395 if(sys.argv[1]=="sniffsf"):
396 #Reversal of transmitter code from nRF_CMD.c of OpenBeacon
397 #TODO remove all poke() calls.
399 client.poke(0x00,0x00); #Stop nRF
400 client.poke(0x01,0x00); #Disable Shockburst
401 client.poke(0x02,0x01); #Set RX Pipe 0
403 client.RF_setfreq(2402 * 10**6);
404 client.poke(0x06,0x07); #1Mbps
405 client.poke(0x07,0x78); #Reset status register
407 #OpenBeacon defines these in little endian as follows.
408 client.RF_setmaclen(5); # SETUP_AW for 5-byte addresses.
409 client.RF_setsmac(0xe7e7e7e7e7);
410 client.RF_settmac(0xe7e7e7e7e7);
412 #Set packet length of 16.
413 client.RF_setpacketlen(4);
415 #Power radio, prime for RX, one-byte checksum.
416 client.poke(0x00,0x70|0x03|0x08); #0x08 for one byte, 0x04 for two.
418 print "Listening as %010x on %i MHz" % (client.RF_getsmac(),
419 client.RF_getfreq()/10**6);
420 #Now we're ready to get packets.
425 packet=client.RF_rxpacket();
429 if(sys.argv[1]=="snifftp"):
430 client.poke(0x00,0x00); #Stop nRF
431 client.poke(0x01,0x00); #Disable Shockburst
432 client.poke(0x02,0x01); #Set RX Pipe 0
434 client.RF_setfreq((2400+0x29) * 10**6);
435 client.poke(0x06,0x00); #1Mbps
436 client.poke(0x07,0x78); #Reset status register
438 client.RF_setmaclen(3); # SETUP_AW for 3-byte addresses.
439 client.RF_setsmac(0x123456);
440 client.RF_setpacketlen(4);
442 #Power radio, prime for RX, two-byte checksum.
443 client.poke(0x00,0x70|0x03|0x04|0x08);
445 print "Listening as %010x on %i MHz" % (client.RF_getsmac(),
446 client.RF_getfreq()/10**6);
447 #Now we're ready to get packets.
452 packet=client.RF_rxpacket();
456 if(sys.argv[1]=="hosttp"):
457 client.poke(0x00,0x00); #Stop nRF
458 client.poke(0x01,0x00); #Disable Shockburst
459 client.poke(0x02,0x01); #Set RX Pipe 0
463 client.RF_setfreq((2400+chan) * 10**6);
464 client.poke(0x06,0x00); #1Mbps
465 client.poke(0x07,0x78); #Reset status register
467 client.RF_setmaclen(3); # SETUP_AW for 3-byte addresses.
468 client.RF_setsmac(0x123456);
469 client.RF_setpacketlen(4);
471 #Power radio, prime for RX, two-byte checksum.
472 client.poke(0x00,0x70|0x03|0x04|0x08);
474 print "Listening as %010x on %i MHz" % (client.RF_getsmac(),
475 client.RF_getfreq()/10**6);
476 #Now we're ready to get packets.
480 packet=client.RF_rxpacket();
481 mac=((ord(packet[0])<<16)+
485 print "%c from %06x" % (key,mac);
488 if(sys.argv[1]=="sniff"):
489 #client.poke(0x00,0x00); #Stop nRF
490 client.poke(0x07,0x78); #Reset status register
492 #Power radio, prime for RX, checksum.
493 client.poke(0x00,0x70|0x03|0x08);
495 print "Listening as %010x on %i MHz" % (client.RF_getsmac(),
496 client.RF_getfreq()/10**6);
497 #Now we're ready to get packets.
503 packet=client.RF_rxpacket();
506 if(sys.argv[1]=="explore"):
507 #client.poke(0x00,0x00); #Stop nRF
508 client.poke(0x07,0x78); #Reset status register
510 #Power radio, prime for RX, no checksum.
511 client.poke(0x00,0x70|0x03);
513 #Set packet length of 32.
514 #Without checksums, extra data will mix in.
515 client.RF_setpacketlen(32);
516 client.RF_setmaclen(3); # shortest address length
518 #Now we're ready to get packets.
519 for smac in [0x0102030201, 0]:
520 client.RF_setsmac(smac);
521 for chan in range(0,0x80):
522 client.RF_setfreq((2400+chan) * 10**6);
524 packet=client.RF_rxpacket();
526 print "Listening as %010x on %i MHz" % (client.RF_getsmac(),
527 client.RF_getfreq()/10**6);