X-Git-Url: http://git.rot13.org/?p=goodfet;a=blobdiff_plain;f=client%2Fgoodfet.nrf;h=a25bc3fad226572c0fc69f915c8348fea030df2c;hp=54f816e0a44c1c0937a0ede415e14a0aa908e93f;hb=241123b26167c8fa9af80bd510aac6050dbdcc30;hpb=733f21c20c5bd8db5a79c54f816072fd18f43aa2 diff --git a/client/goodfet.nrf b/client/goodfet.nrf index 54f816e..a25bc3f 100755 --- a/client/goodfet.nrf +++ b/client/goodfet.nrf @@ -11,6 +11,16 @@ import time; from GoodFETNRF import GoodFETNRF; from intelhex import IntelHex; + +regnames=["CONFIG","EN_AA","EN_RXADDR","SETUP_AW","SETUP_RET", + "RF_CH","RF_SETUP","STATUS","OBSERVE_TX","RPD", + "RX_ADDR_P0","RX_ADDR_P1","RX_ADDR_P2","RX_ADDR_P3","RX_ADDR_P4","RX_ADDR_P5", + "TX_ADDR", + "RX_PW_P0","RX_PW_P1","RX_PW_P2","RX_PW_P3","RX_PW_P4","RX_PW_P5", + "FIFO_STATUS","?", + "?","?","?","DYNPD","FEATURE","AGC_CONFIG","?","?", + "?","?","?","?","?","?","?","?"]; + def printpacket(packet): s=""; i=0; @@ -18,21 +28,40 @@ def printpacket(packet): i=i+1; if i>client.packetlen: break; s="%s %02x" % (s,ord(foo)); - print "%s" %s; + print "%s" % s; def printconfig(): - print "SMAC 0x%010x" % client.RF_getsmac(); - print "TMAC 0x%010x" % client.RF_gettmac(); + print "Encoding %s" % client.RF_getenc(); print "Freq %10i MHz" % (client.RF_getfreq()/10**6); + print "Rate %10i kbps" % (client.RF_getrate()/1000); print "PacketLen %02i bytes" % client.RF_getpacketlen(); - print "MacLen %2i bytes" % client.RF_getmaclen(); + #print "MacLen %2i bytes" % client.RF_getmaclen(); + print "SMAC 0x%010x" % client.RF_getsmac(); + print "TMAC 0x%010x" % client.RF_gettmac(); + if(len(sys.argv)==1): print "Usage: %s verb [objects]\n" % sys.argv[0]; print "%s info" % sys.argv[0]; print "%s test" % sys.argv[0]; print "%s regs" % sys.argv[0]; + print "%s regbits" % sys.argv[0]; + print "%s pyregs" % sys.argv[0]; + print ""; + print "%s sniff\n\tSniffs packets by current config." % sys.argv[0]; print "%s sniffob\n\tSniffs OpenBeacon traffic." % sys.argv[0]; + print "%s snifftp\n\tSniffs Turning Point Clicker traffic." % sys.argv[0]; + print "%s sniffsf\n\tSniffs SparkFun Dongle traffic." % sys.argv[0]; + print ""; + print "%s sniffprom [0xaa|0x55]\n\tSniffs promiscuously for a preamble of 0xAA or 0x55" % sys.argv[0]; + print "%s autotune\n\tSearches for a valid destination address." % sys.argv[0]; + print ""; + print "%s sniffskybrake\n\tSniffs skybrake. [broken?]" % sys.argv[0]; + print "%s sniffmskb\n\tSniffs MS KB. [broken?]" % sys.argv[0]; + + + print "%s hosttp\n\tHosts Turning Point Clicker traffic." % sys.argv[0]; + print "%s carrier [freq]\n\tHolds a carrier on [freq] Hz." % sys.argv[0]; sys.exit(); @@ -46,21 +75,32 @@ if(sys.argv[1]=="info"): printconfig(); if(sys.argv[1]=="test"): + print "Old registers:" + printconfig(); + # Set PWR_UP=1 and PRIM_RX=0 in CONFIG. client.poke(0x00,2); #Delay of 1.5ms by round-trip. - # Set CONT_WAVE, PLL_LOCK, and 0dBm in RF_SETUP - client.poke(0x06,8+10+4+2); - client.RF_setfreq(2480 * 10**6); - #Print registers, just for fun. - printconfig(); + print "\n\n"; + + #Try all data rates + for foo in [250*10**3, + 1*10**6, + 2*10**6]: + client.RF_setrate(foo); + if(client.RF_getrate()!=foo): + print "ERROR Rate %i not supported. Got %i instead." % (foo, + client.RF_getrate()); + print "\n\n"; client.poke(0x0A,0xDEADBEEF,5); #print "SMAC set to %010x" % client.RF_getsmac(); if client.RF_getsmac()!=0xdeadbeef: print "ERROR: Failed to set MAC address."; - + print "Final registers:" + printconfig(); + if(sys.argv[1]=="carrier"): if len(sys.argv)>2: client.RF_setfreq(eval(sys.argv[2])); @@ -71,7 +111,33 @@ if(sys.argv[1]=="carrier"): time.sleep(1); if(sys.argv[1]=="regs"): for r in range(0,0x20): - print "r[0x%02x]=0x%010x" % (r,client.peek(r)); + print "r[0x%02x]=0x%010x //%16s " % (r,client.peek(r),regnames[r]); +if(sys.argv[1]=="pyregs"): + for r in range(0,0x20): + print "client.set(0x%02x,0x%010x); #%16s " % (r,client.peek(r),regnames[r]); + +if(sys.argv[1]=="peek"): + start=0x0000; + if(len(sys.argv)>2): + start=int(sys.argv[2],16); + stop=start; + if(len(sys.argv)>3): + stop=int(sys.argv[3],16); + print "Peeking from %02x to %02x." % (start,stop); + while start<=stop: + print "%02x: %010x" % (start,client.peek(start)); + start=start+1; +if(sys.argv[1]=="poke"): + start=0x0000; + val=0x00; + if(len(sys.argv)>2): + start=int(sys.argv[2],16); + if(len(sys.argv)>3): + val=int(sys.argv[3],16); + print "Poking %02x to become %010x." % (start,val); + + client.poke(start,val); + print "Poked to %04x" % client.peek(start); if(sys.argv[1]=="sniffob"): #Reversal of transmitter code from nRF_CMD.c of OpenBeacon @@ -80,12 +146,13 @@ if(sys.argv[1]=="sniffob"): client.poke(0x00,0x00); #Stop nRF client.poke(0x01,0x00); #Disable Shockburst client.poke(0x02,0x01); #Set RX Pipe 0 - client.RF_setmaclen(5); # SETUP_AW for 5-byte addresses. + client.RF_setfreq(2481 * 10**6); client.poke(0x06,0x09); #2MBps, -18dBm in RF_SETUP client.poke(0x07,0x78); #Reset status register #OpenBeacon defines these in little endian as follows. + client.RF_setmaclen(5); # SETUP_AW for 5-byte addresses. #0x01, 0x02, 0x03, 0x02, 0x01 client.RF_setsmac(0x0102030201); #'O', 'C', 'A', 'E', 'B' @@ -94,6 +161,329 @@ if(sys.argv[1]=="sniffob"): #Set packet length of 16. client.RF_setpacketlen(16); + #Power radio, prime for RX, one-byte checksum. + client.poke(0x00,0x70|0x03|0x08); #0x08 for one byte, 0x04 for two. + + print "Listening as %010x on %i MHz" % (client.RF_getsmac(), + client.RF_getfreq()/10**6); + #Now we're ready to get packets. + while 1: + packet=None; + while packet==None: + #time.sleep(0.1); + packet=client.RF_rxpacket(); + printpacket(packet); + sys.stdout.flush(); + +if(sys.argv[1]=="regbits"): + print "Scanning registers to determine which bits are valid." + regbits=range(0,0x30); + for r in range(0,0x30): + old=client.peek(r); + #Which bits can be set? + client.poke(r,0xFF); + ones=client.peek(r); + #Which bits can be clear? + client.poke(r,0x00); + zeroes=client.peek(r); + regbits[r]=(ones & (~zeroes)); + for r in range(0,0x30): + if regbits[r]!=0: + print "r[0x%02x] masked %02x // %s" % (r,regbits[r], regnames[r]); +if(sys.argv[1]=="sniffprom"): + #Reversal of transmitter code from nRF_CMD.c of OpenBeacon + #TODO remove all poke() calls. + + client.poke(0x00,0x00); #Stop nRF + client.poke(0x01,0x00); #Disable Shockburst + client.poke(0x02,0x01); #Set RX Pipe 0 + + #client.RF_setfreq(2481 * 10**6); + #client.poke(0x06,0x09); #2MBps, -18dBm in RF_SETUP + client.poke(0x07,0x78); #Reset status register + + #OpenBeacon defines these in little endian as follows. + client.RF_setmaclen(2); # SETUP_AW for shortest + + #It's better to have a known fragment, when one is available. + #client.RF_setsmac(0x00AA); + #client.RF_setsmac(0x0055); + + #Should end in 55 or AA depending upon the packet. + tail=0x55 + if(len(sys.argv)>2): + tail=int(sys.argv[2],16); + else: + print "Please specify a tail of 0xAA or 0x55."; + sys.exit(1); + client.RF_setsmac(tail); + + #Longest length. + client.RF_setpacketlen(32); + + #Power radio, prime for RX, no checksum + client.poke(0x00,0x70|0x03); #0x08 for checksum, 0x04 for two. + + print "Listening as %010x on %i MHz" % (client.RF_getsmac(), + client.RF_getfreq()/10**6); + #Now we're ready to get packets. + while 1: + packet=None; + while packet==None: + #time.sleep(0.1); + packet=client.RF_rxpacket(); + printpacket(packet); + sys.stdout.flush(); + +class AddressGuesser(): + """This guesses addresses by searching through packets.""" + #packets=[]; + addresses={}; + def packetaddr(self,packet): + s=""; + for i in range(0,5): + s="%s%02x" % (s,ord(packet[i])); + return s; + def handle(self,packet): + #printpacket(packet); + #self.packets.append(packet); + addr=self.packetaddr(packet); + + #Increment the address. + count=0; + try: + count=self.addresses[addr]; + except: + pass; + self.addresses[addr]=count+1; + if self.addresses[addr]>5: + print "'%s' looks like a valid address." % addr; + return; + +if(sys.argv[1]=="autotune"): + #Reversal of transmitter code from nRF_CMD.c of OpenBeacon + #TODO remove all poke() calls. + guesser=AddressGuesser(); + + client.poke(0x00,0x00); #Stop nRF + client.poke(0x01,0x00); #Disable Shockburst + client.poke(0x02,0x01); #Set RX Pipe 0 + + #client.RF_setfreq(2481 * 10**6); + #client.poke(0x06,0x09); #2MBps, -18dBm in RF_SETUP + client.poke(0x07,0x78); #Reset status register + + #OpenBeacon defines these in little endian as follows. + client.RF_setmaclen(2); # SETUP_AW for shortest + + #It's better to have a known fragment, when one is available. + #client.RF_setsmac(0x00AA); + #client.RF_setsmac(0x0055); + + #Should end in 55 or AA depending upon the packet. + tail=0x55 + if(len(sys.argv)>2): + tail=int(sys.argv[2],16); + else: + print "Please specify a tail of 0xAA or 0x55."; + sys.exit(1); + client.RF_setsmac(tail); + + #Longest length. + client.RF_setpacketlen(32); + + #Power radio, prime for RX, no checksum + client.poke(0x00,0x70|0x03); #0x08 for checksum, 0x04 for two. + + print "Listening as %010x on %i MHz" % (client.RF_getsmac(), + client.RF_getfreq()/10**6); + #Now we're ready to get packets. + while 1: + packet=None; + while packet==None: + packet=client.RF_rxpacket(); + guesser.handle(packet); + sys.stdout.flush(); + +if(sys.argv[1]=="sniffmskb"): + #MSWK 3000 v2.0 + #TODO remove all poke() calls. + + client.poke(0x00,0x00); #Stop nRF + client.poke(0x01,0x00); #Disable Shockburst + client.poke(0x02,0x01); #Set RX Pipe 0 + + client.poke(0x06,0x09); #2MBps, -18dBm in RF_SETUP + client.poke(0x07,0x78); #Reset status register + + #This is the address of a specific keyboard. + #Other keyboards will be different. + + + client.RF_setmaclen(2); + + #Known pairs. The channel and the low address bytes must match. + #client.RF_setfreq((2400+0x13) * 10**6); + #client.RF_setsmac(0x0c00a3598cd); + + client.RF_setfreq((2400+0x15) * 10**6); + client.RF_setsmac( 0x0c10446facd); + + #Mac packet length, illegally 0-length address field. + client.RF_setpacketlen(32); + + #Power radio, prime for RX, no checksum + client.poke(0x00,0x70|0x03); #0x08 for checksum, 0x04 for two. + + print "Listening as %010x on %i MHz" % (client.RF_getsmac(), + client.RF_getfreq()/10**6); + #Now we're ready to get packets. + while 1: + packet=None; + while packet==None: + #time.sleep(0.1); + packet=client.RF_rxpacket(); + printpacket(packet); + sys.stdout.flush(); + + + +if(sys.argv[1]=="sniffskybrake"): + #Reversal of transmitter code from nRF_CMD.c of OpenBeacon + #TODO remove all poke() calls. + + client.poke(0x00,0x00); #Stop nRF + client.poke(0x01,0x00); #Disable Shockburst + client.poke(0x02,0x01); #Set RX Pipe 0 + + client.RF_setfreq(2439 * 10**6); + client.poke(0x06,0x00); #1MBps + client.poke(0x07,0x78); #Reset status register + + #OpenBeacon defines these in little endian as follows. + client.RF_setmaclen(2); # SETUP_AW for 3-byte addresses. + #0x01, 0x02, 0x03, 0x02, 0x01 + + client.RF_setsmac(0x070700d2c4); #reversed + + #client.RF_setsmac(0xd2c4); + #client.RF_setsmac(0); + + #Mac packet length, illegally 0-length address field. + client.RF_setpacketlen(32); + + #Power radio, prime for RX, one-byte checksum. + client.poke(0x00,0x70|0x03); #0x08 for one byte, 0x04 for two. + + print "Listening as %010x on %i MHz" % (client.RF_getsmac(), + client.RF_getfreq()/10**6); + print "%i byte mac match." % client.RF_getmaclen(); + #Now we're ready to get packets. + while 1: + packet=None; + while packet==None: + #time.sleep(0.1); + packet=client.RF_rxpacket(); + printpacket(packet); + sys.stdout.flush(); + +if(sys.argv[1]=="sniffsf"): + #Reversal of transmitter code from nRF_CMD.c of OpenBeacon + #TODO remove all poke() calls. + + client.poke(0x00,0x00); #Stop nRF + client.poke(0x01,0x00); #Disable Shockburst + client.poke(0x02,0x01); #Set RX Pipe 0 + + client.RF_setfreq(2402 * 10**6); + client.poke(0x06,0x07); #1Mbps + client.poke(0x07,0x78); #Reset status register + + #OpenBeacon defines these in little endian as follows. + client.RF_setmaclen(5); # SETUP_AW for 5-byte addresses. + client.RF_setsmac(0xe7e7e7e7e7); + client.RF_settmac(0xe7e7e7e7e7); + + #Set packet length of 16. + client.RF_setpacketlen(4); + + #Power radio, prime for RX, one-byte checksum. + client.poke(0x00,0x70|0x03|0x08); #0x08 for one byte, 0x04 for two. + + print "Listening as %010x on %i MHz" % (client.RF_getsmac(), + client.RF_getfreq()/10**6); + #Now we're ready to get packets. + while 1: + packet=None; + while packet==None: + #time.sleep(0.1); + packet=client.RF_rxpacket(); + printpacket(packet); + sys.stdout.flush(); + +if(sys.argv[1]=="snifftp"): + client.poke(0x00,0x00); #Stop nRF + client.poke(0x01,0x00); #Disable Shockburst + client.poke(0x02,0x01); #Set RX Pipe 0 + + client.RF_setfreq((2400+0x29) * 10**6); + client.poke(0x06,0x00); #1Mbps + client.poke(0x07,0x78); #Reset status register + + client.RF_setmaclen(3); # SETUP_AW for 3-byte addresses. + client.RF_setsmac(0x123456); + client.RF_setpacketlen(4); + + #Power radio, prime for RX, two-byte checksum. + client.poke(0x00,0x70|0x03|0x04|0x08); + + print "Listening as %010x on %i MHz" % (client.RF_getsmac(), + client.RF_getfreq()/10**6); + #Now we're ready to get packets. + while 1: + packet=None; + while packet==None: + #time.sleep(0.1); + packet=client.RF_rxpacket(); + printpacket(packet); + sys.stdout.flush(); + +if(sys.argv[1]=="hosttp"): + client.poke(0x00,0x00); #Stop nRF + client.poke(0x01,0x00); #Disable Shockburst + client.poke(0x02,0x01); #Set RX Pipe 0 + + chan=0x29; + + client.RF_setfreq((2400+chan) * 10**6); + client.poke(0x06,0x00); #1Mbps + client.poke(0x07,0x78); #Reset status register + + client.RF_setmaclen(3); # SETUP_AW for 3-byte addresses. + client.RF_setsmac(0x123456); + client.RF_setpacketlen(4); + + #Power radio, prime for RX, two-byte checksum. + client.poke(0x00,0x70|0x03|0x04|0x08); + + print "Listening as %010x on %i MHz" % (client.RF_getsmac(), + client.RF_getfreq()/10**6); + #Now we're ready to get packets. + while 1: + packet=None; + while packet==None: + packet=client.RF_rxpacket(); + mac=((ord(packet[0])<<16)+ + (ord(packet[1])<<8)+ + ord(packet[2])); + key=packet[3]; + print "%c from %06x" % (key,mac); + sys.stdout.flush(); + +if(sys.argv[1]=="sniff"): + #client.poke(0x00,0x00); #Stop nRF + client.poke(0x07,0x78); #Reset status register + #Power radio, prime for RX, checksum. client.poke(0x00,0x70|0x03|0x08); @@ -108,3 +498,27 @@ if(sys.argv[1]=="sniffob"): packet=client.RF_rxpacket(); printpacket(packet); sys.stdout.flush(); +if(sys.argv[1]=="explore"): + #client.poke(0x00,0x00); #Stop nRF + client.poke(0x07,0x78); #Reset status register + + #Power radio, prime for RX, no checksum. + client.poke(0x00,0x70|0x03); + + #Set packet length of 32. + #Without checksums, extra data will mix in. + client.RF_setpacketlen(32); + client.RF_setmaclen(3); # shortest address length + + #Now we're ready to get packets. + for smac in [0x0102030201, 0]: + client.RF_setsmac(smac); + for chan in range(0,0x80): + client.RF_setfreq((2400+chan) * 10**6); + time.sleep(1); + packet=client.RF_rxpacket(); + if packet!=None: + print "Listening as %010x on %i MHz" % (client.RF_getsmac(), + client.RF_getfreq()/10**6); + printpacket(packet); + sys.stdout.flush();