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."""
242 def packetaddr(self,packet):
245 s="%s%02x" % (s,ord(packet[i]));
247 def handle(self,packet):
248 #printpacket(packet);
249 #self.packets.append(packet);
250 addr=self.packetaddr(packet);
252 #Increment the address.
255 count=self.addresses[addr];
258 self.addresses[addr]=count+1;
259 rate=count*1.0/len(self.addresses);
260 if self.addresses[addr]>1:
261 print "'%s' looks valid, %0.5f" % (
265 if(sys.argv[1]=="autotune"):
266 #Reversal of transmitter code from nRF_CMD.c of OpenBeacon
267 #TODO remove all poke() calls.
268 guesser=AddressGuesser();
270 client.poke(0x00,0x00); #Stop nRF
271 client.poke(0x01,0x00); #Disable Shockburst
272 client.poke(0x02,0x01); #Set RX Pipe 0
274 #client.RF_setfreq(2481 * 10**6);
275 #client.poke(0x06,0x09); #2MBps, -18dBm in RF_SETUP
276 client.poke(0x07,0x78); #Reset status register
278 #OpenBeacon defines these in little endian as follows.
279 client.RF_setmaclen(2); # SETUP_AW for shortest
281 #It's better to have a known fragment, when one is available.
282 #client.RF_setsmac(0x00AA);
283 #client.RF_setsmac(0x0055);
285 #Should end in 55 or AA depending upon the packet.
288 tail=int(sys.argv[2],16);
290 print "Please specify a tail of 0xAA or 0x55.";
292 client.RF_setsmac(tail);
295 client.RF_setpacketlen(32);
297 #Power radio, prime for RX, no checksum
298 client.poke(0x00,0x70|0x03); #0x08 for checksum, 0x04 for two.
300 print "Listening as %010x on %i MHz" % (client.RF_getsmac(),
301 client.RF_getfreq()/10**6);
302 #Now we're ready to get packets.
306 packet=client.RF_rxpacket();
307 guesser.handle(packet);
310 if(sys.argv[1]=="sniffmskb"):
312 #TODO remove all poke() calls.
314 client.poke(0x00,0x00); #Stop nRF
315 client.poke(0x01,0x00); #Disable Shockburst
316 client.poke(0x02,0x01); #Set RX Pipe 0
318 client.poke(0x06,0x09); #2MBps, -18dBm in RF_SETUP
319 client.poke(0x07,0x78); #Reset status register
321 #This is the address of a specific keyboard.
322 #Other keyboards will be different.
325 client.RF_setmaclen(2);
327 #Known pairs. The channel and the low address bytes must match.
328 #client.RF_setfreq((2400+0x13) * 10**6);
329 #client.RF_setsmac(0x0c00a3598cd);
331 client.RF_setfreq((2400+0x15) * 10**6);
332 client.RF_setsmac( 0x0c10446facd);
334 #Mac packet length, illegally 0-length address field.
335 client.RF_setpacketlen(32);
337 #Power radio, prime for RX, no checksum
338 client.poke(0x00,0x70|0x03); #0x08 for checksum, 0x04 for two.
340 print "Listening as %010x on %i MHz" % (client.RF_getsmac(),
341 client.RF_getfreq()/10**6);
342 #Now we're ready to get packets.
347 packet=client.RF_rxpacket();
353 if(sys.argv[1]=="sniffskybrake"):
354 #Reversal of transmitter code from nRF_CMD.c of OpenBeacon
355 #TODO remove all poke() calls.
357 client.poke(0x00,0x00); #Stop nRF
358 client.poke(0x01,0x00); #Disable Shockburst
359 client.poke(0x02,0x01); #Set RX Pipe 0
361 client.RF_setfreq(2439 * 10**6);
362 client.poke(0x06,0x00); #1MBps
363 client.poke(0x07,0x78); #Reset status register
365 #OpenBeacon defines these in little endian as follows.
366 client.RF_setmaclen(2); # SETUP_AW for 3-byte addresses.
367 #0x01, 0x02, 0x03, 0x02, 0x01
369 client.RF_setsmac(0x070700d2c4); #reversed
371 #client.RF_setsmac(0xd2c4);
372 #client.RF_setsmac(0);
374 #Mac packet length, illegally 0-length address field.
375 client.RF_setpacketlen(32);
377 #Power radio, prime for RX, one-byte checksum.
378 client.poke(0x00,0x70|0x03); #0x08 for one byte, 0x04 for two.
380 print "Listening as %010x on %i MHz" % (client.RF_getsmac(),
381 client.RF_getfreq()/10**6);
382 print "%i byte mac match." % client.RF_getmaclen();
383 #Now we're ready to get packets.
388 packet=client.RF_rxpacket();
392 if(sys.argv[1]=="sniffsf"):
393 #Reversal of transmitter code from nRF_CMD.c of OpenBeacon
394 #TODO remove all poke() calls.
396 client.poke(0x00,0x00); #Stop nRF
397 client.poke(0x01,0x00); #Disable Shockburst
398 client.poke(0x02,0x01); #Set RX Pipe 0
400 client.RF_setfreq(2402 * 10**6);
401 client.poke(0x06,0x07); #1Mbps
402 client.poke(0x07,0x78); #Reset status register
404 #OpenBeacon defines these in little endian as follows.
405 client.RF_setmaclen(5); # SETUP_AW for 5-byte addresses.
406 client.RF_setsmac(0xe7e7e7e7e7);
407 client.RF_settmac(0xe7e7e7e7e7);
409 #Set packet length of 16.
410 client.RF_setpacketlen(4);
412 #Power radio, prime for RX, one-byte checksum.
413 client.poke(0x00,0x70|0x03|0x08); #0x08 for one byte, 0x04 for two.
415 print "Listening as %010x on %i MHz" % (client.RF_getsmac(),
416 client.RF_getfreq()/10**6);
417 #Now we're ready to get packets.
422 packet=client.RF_rxpacket();
426 if(sys.argv[1]=="snifftp"):
427 client.poke(0x00,0x00); #Stop nRF
428 client.poke(0x01,0x00); #Disable Shockburst
429 client.poke(0x02,0x01); #Set RX Pipe 0
431 client.RF_setfreq((2400+0x29) * 10**6);
432 client.poke(0x06,0x00); #1Mbps
433 client.poke(0x07,0x78); #Reset status register
435 client.RF_setmaclen(3); # SETUP_AW for 3-byte addresses.
436 client.RF_setsmac(0x123456);
437 client.RF_setpacketlen(4);
439 #Power radio, prime for RX, two-byte checksum.
440 client.poke(0x00,0x70|0x03|0x04|0x08);
442 print "Listening as %010x on %i MHz" % (client.RF_getsmac(),
443 client.RF_getfreq()/10**6);
444 #Now we're ready to get packets.
449 packet=client.RF_rxpacket();
453 if(sys.argv[1]=="hosttp"):
454 client.poke(0x00,0x00); #Stop nRF
455 client.poke(0x01,0x00); #Disable Shockburst
456 client.poke(0x02,0x01); #Set RX Pipe 0
460 client.RF_setfreq((2400+chan) * 10**6);
461 client.poke(0x06,0x00); #1Mbps
462 client.poke(0x07,0x78); #Reset status register
464 client.RF_setmaclen(3); # SETUP_AW for 3-byte addresses.
465 client.RF_setsmac(0x123456);
466 client.RF_setpacketlen(4);
468 #Power radio, prime for RX, two-byte checksum.
469 client.poke(0x00,0x70|0x03|0x04|0x08);
471 print "Listening as %010x on %i MHz" % (client.RF_getsmac(),
472 client.RF_getfreq()/10**6);
473 #Now we're ready to get packets.
477 packet=client.RF_rxpacket();
478 mac=((ord(packet[0])<<16)+
482 print "%c from %06x" % (key,mac);
485 if(sys.argv[1]=="sniff"):
486 #client.poke(0x00,0x00); #Stop nRF
487 client.poke(0x07,0x78); #Reset status register
489 #Power radio, prime for RX, checksum.
490 client.poke(0x00,0x70|0x03|0x08);
492 print "Listening as %010x on %i MHz" % (client.RF_getsmac(),
493 client.RF_getfreq()/10**6);
494 #Now we're ready to get packets.
500 packet=client.RF_rxpacket();
503 if(sys.argv[1]=="explore"):
504 #client.poke(0x00,0x00); #Stop nRF
505 client.poke(0x07,0x78); #Reset status register
507 #Power radio, prime for RX, no checksum.
508 client.poke(0x00,0x70|0x03);
510 #Set packet length of 32.
511 #Without checksums, extra data will mix in.
512 client.RF_setpacketlen(32);
513 client.RF_setmaclen(3); # shortest address length
515 #Now we're ready to get packets.
516 for smac in [0x0102030201, 0]:
517 client.RF_setsmac(smac);
518 for chan in range(0,0x80):
519 client.RF_setfreq((2400+chan) * 10**6);
521 packet=client.RF_rxpacket();
523 print "Listening as %010x on %i MHz" % (client.RF_getsmac(),
524 client.RF_getfreq()/10**6);