X-Git-Url: http://git.rot13.org/?p=goodfet;a=blobdiff_plain;f=client%2Fgoodfet.cc;h=a7a049499f49aaee735c5a34d9f023767357aeb5;hp=668265035e40c0427e4469a4db135a748fc77637;hb=d0498df7bc06959a19fe1ef2c4fc066dd8d68c92;hpb=5d28f76d0b8e8fa540ffb5409ba5e9408cede34a diff --git a/client/goodfet.cc b/client/goodfet.cc index 6682650..a7a0494 100755 --- a/client/goodfet.cc +++ b/client/goodfet.cc @@ -6,19 +6,116 @@ # This code is being rewritten and refactored. You've been warned! import sys; -import binascii; +import binascii, time; from GoodFETCC import GoodFETCC; +from GoodFETConsole import GoodFETConsole; from intelhex import IntelHex; +def printpacket(packet): + s=""; + i=0; + for foo in packet: + i=i+1; + s="%s %02x" % (s,foo); + print "# %s" %s; + +simplepacketcount=0; +def handlesimplicitipacket(packet): + s=""; + i=0; + global simplepacketcount; + simplepacketcount=simplepacketcount+1; + + len=packet[0]; + if len<12: return; + + dst=[packet[1], + packet[2], + packet[3], + packet[4]]; + src=[packet[5], + packet[6], + packet[7], + packet[8]]; + port=packet[9]; + info=packet[10]; + seq=packet[11]; + #payload begins at byte 10. + + if packet[len+2]&0x80==0: + print "# Dropped broken packet."; + elif port==0x20: + #data packet + counter=packet[11]; + button=packet[12]; + x=packet[13]; + y=packet[14]; + z=packet[15]; + print "%09i %03i %4i %4i %4i" % (simplepacketcount,button,x,y,z); + sys.stdout.flush(); + elif port==0x02: + #Link request. Gotta send a proper reply to get data. + tid=packet[13]; + #14 ff ff ff ff 3c b7 e3 98 + #02 03 c9 + #01 97 + #ef be ad de 3d 00 02 + reply=[0x10, + src[0], src[1], src[2], src[3], + 0x78,0x56,0x34,0x10, #my address. + port, 0x21, seq, + 0x81, tid, #reply, tid + + 0x20,0x00,0xad,0xde, #Join token + 0x00]; #no security + printpacket(reply); + print "#FIXME FAST: repeatedly broadcasting ACK to catch LINK on the next attempt."; + for foo in range(1,50): + client.RF_txpacket(reply); + + pass; + elif port==0x03: + #print "Join request."; + if packet[12]!=1: + print "Not a join request. WTF?"; + return; + tid=packet[13]; + reply=[0x12, #reply is one byte shorter + src[0], src[1], src[2], src[3], + 0x78,0x56,0x34,0x10, #my address. + port, 0x21, seq, + 0x81, tid, #reply, tid + + 0xef,0xbe,0xad,0xde, #Join token + 0x00]; #no security + printpacket(reply); + print "#FIXME FAST: repeatedly broadcasting ACK to catch JOIN on the next attempt."; + for foo in range(1,50): + client.RF_txpacket(reply); + #printpacket(reply); + + elif port==0x04: + print "Security request."; + elif port==0x05: + print "Frequency request."; + elif port==0x06: + print "Management request."; + else: + print "Unknown Port %02x" %port; + if(len(sys.argv)==1): print "Usage: %s verb [objects]\n" % sys.argv[0]; + print "%s erase" % sys.argv[0]; + print "%s flash $foo.hex" % sys.argv[0]; print "%s test" % sys.argv[0]; + print "%s term" % sys.argv[0]; print "%s info" % sys.argv[0]; + print "%s halt" % sys.argv[0]; + print "%s regs" % sys.argv[0]; print "%s dumpcode $foo.hex [0x$start 0x$stop]" % sys.argv[0]; print "%s dumpdata $foo.hex [0x$start 0x$stop]" % sys.argv[0]; - print "%s erase" % sys.argv[0]; print "%s writedata $foo.hex [0x$start 0x$stop]" % sys.argv[0]; print "%s verify $foo.hex [0x$start 0x$stop]" % sys.argv[0]; print "%s peekdata 0x$start [0x$stop]" % sys.argv[0]; @@ -26,9 +123,16 @@ if(len(sys.argv)==1): print "%s peek 0x$iram" % sys.argv[0]; print "%s poke 0x$iram 0x$val" % sys.argv[0]; print "%s peekcode 0x$start [0x$stop]" % sys.argv[0]; + print "\n" + print "%s rssi [freq]\n\tGraphs signal strength on [freq] Hz." % sys.argv[0]; + print "%s carrier [freq]\n\tHolds a carrier on [freq] Hz." % sys.argv[0]; + print "%s reflex [freq]\n\tJams on [freq] Hz." % sys.argv[0]; + print "%s sniffsimpliciti [us|eu|lf]\n\tSniffs SimpliciTI packets." % sys.argv[0]; + sys.exit(); #Initailize FET and set baud rate +#client=GoodFET.GoodFETCC.GoodFETCC(); client=GoodFETCC(); client.serInit() @@ -36,19 +140,132 @@ client.serInit() client.setup(); client.start(); -if(sys.argv[1]=="explore"): - print "Exploring undefined commands." - print "Status: %s" %client.CCstatusstr(); + + +if(sys.argv[1]=="carrier"): + if len(sys.argv)>2: + client.RF_setfreq(eval(sys.argv[2])); + client.RF_carrier(); + while(1): + time.sleep(1); + +if(sys.argv[1]=="reflex"): + client.CC1110_crystal(); + client.RF_idle(); + + client.config_simpliciti(); + + threshold=100; + if len(sys.argv)>2: + client.RF_setfreq(eval(sys.argv[2])); + print "Listening on %f MHz." % (client.RF_getfreq()/10**6); + print "Jamming if RSSI>=%i" % threshold; + + client.pokebyte(0xFE00,threshold,"xdata"); #Write threshold to shellcode. + client.shellcodefile("reflex.ihx"); + rssi=0; + while 1: + while(0==client.ishalted()): + rssi=0; + rssi=client.peek8(0xFE00,"xdata"); + print "Activated jamming with RSSI of %i, going again for another packet." % rssi; + #client.CCdebuginstr([0x02, 0xf0, 0x00]); #ljmp 0xF000 + client.resume(); + + RFST=0xDFE1 + client.CC_RFST_CAL(); #SCAL + time.sleep(1); - cmd=0x04; #read status - for foo in range(0,0x5): - client.CCcmd([(0x0F<<3)|(0x00)|0x03,0x09<<3]); - print "Status %02x: %s" % (foo,client.CCstatusstr()); - for foo in range(0,3): - print "PC: %04x" % client.CCgetPC(); + maxrssi=0; + while 1: + client.CC_RFST_RX(); #SRX + rssi=client.RF_getrssi(); + client.CC_RFST_IDLE(); #idle + time.sleep(0.01); + string=""; + for foo in range(0,rssi>>2): + string=("%s."%string); + print "%02x %04i %04i %s" % (rssi,rssi, maxrssi, string); + if rssi>maxrssi: + maxrssi=(rssi); + if rssi>threshold: + #print "Triggered jamming for 1s."; + client.RF_carrier(); + time.sleep(1); + print "JAMMING JAMMING JAMMING JAMMING"; +if(sys.argv[1]=="rssi"): + client.CC1110_crystal(); + client.RF_idle(); + + client.config_simpliciti(); + + if len(sys.argv)>2: + client.RF_setfreq(eval(sys.argv[2])); + print "Listening on %f MHz." % (client.RF_getfreq()/10.0**6); + #FIXME, ugly + RFST=0xDFE1 + client.CC_RFST_CAL(); + time.sleep(1); + + while 1: + client.CC_RFST_RX(); + rssi=client.RF_getrssi(); + client.CC_RFST_IDLE(); #idle + time.sleep(0.01); + string=""; + for foo in range(0,rssi>>2): + string=("%s."%string); + print "%02x %04i %s" % (rssi,rssi, string); + +if(sys.argv[1]=="sniffsimpliciti"): + #TODO remove all poke() calls. + region="us"; + if len(sys.argv)>2: + region=sys.argv[2]; + + client.CC1110_crystal(); + client.RF_idle(); + + client.config_simpliciti(region); + + print "Listening as %x on %f MHz" % (client.RF_getsmac(), + client.RF_getfreq()/10.0**6); + #Now we're ready to get packets. + while 1: + packet=None; + while packet==None: + packet=client.RF_rxpacket(); + printpacket(packet); + sys.stdout.flush(); + +if(sys.argv[1]=="simpliciti"): + #TODO remove all poke() calls. + region="us"; + if len(sys.argv)>2: + region=sys.argv[2]; + + client.CC1110_crystal(); + client.RF_idle(); + + client.config_simpliciti(region); + + print "# Listening as %x on %f MHz" % (client.RF_getsmac(), + client.RF_getfreq()/10.0**6); + #Now we're ready to get packets. + while 1: + packet=None; + while packet==None: + packet=client.RF_rxpacket(); + handlesimplicitipacket(packet); + sys.stdout.flush(); + + + +if(sys.argv[1]=="term"): + GoodFETConsole(client).run(); if(sys.argv[1]=="test"): - client.CCtest(); + client.test(); if(sys.argv[1]=="deadtest"): for i in range(1,10): print "IDENT as %s" % client.CCidentstr(); @@ -89,13 +306,30 @@ if(sys.argv[1]=="dumpdata"): i+=1; h.write_hex_file(f); if(sys.argv[1]=="status"): - print "Status: %s" %client.CCstatusstr(); + print "Status: %s" %client.status(); +if(sys.argv[1]=="halt"): + print "Halting CPU." + client.halt(); if(sys.argv[1]=="info"): - print "%s" % client.CCidentstr(); + print "Ident %s" % client.CCidentstr(); + + try: + print "Freq %10.3f MHz" % (client.RF_getfreq()/10**6); + print "RSSI %02x" % client.RF_getrssi(); + except: + print "Freq, RSSI, etc unknown. Install SmartRF7."; + #print "Rate %10i kbps" % (client.RF_getrate()/1000); + #print "PacketLen %02i bytes" % client.RF_getpacketlen(); + #print "SMAC 0x%010x" % client.RF_getsmac(); + #print "TMAC 0x%010x" % client.RF_gettmac(); + +if(sys.argv[1]=="regs"): + client.CMDrs(); + if(sys.argv[1]=="erase"): - print "Status: %s" % client.CCstatusstr(); + print "Status: %s" % client.status(); client.CCchiperase(); - print "Status: %s" %client.CCstatusstr(); + print "Status: %s" %client.status(); if(sys.argv[1]=="peekinfo"): print "Select info flash." @@ -146,39 +380,11 @@ if(sys.argv[1]=="flash"): if(len(sys.argv)>4): stop=int(sys.argv[4],16); - h = IntelHex(f); - page = 0x0000; - pagelen = client.CCpagesize(); #2048; #2kB pages in 32-bit words - - print "page=%04x, pagelen=%04x" % (page,pagelen); - - bcount = 0; - - #Wipe the RAM buffer for the next flash page. - client.CCeraseflashbuffer(); - for i in h._buf.keys(): - while(i>=page+pagelen): - if bcount>0: - client.CCflashpage(page); - #client.CCeraseflashbuffer(); - bcount=0; - print "Flashed page at %06x" % page - page+=pagelen; - - #Place byte into buffer. - client.CCpokedatabyte(0xF000+i-page, - h[i]); - bcount+=1; - if(i%0x100==0): - print "Buffering %04x toward %06x" % (i,page); - #last page - client.CCflashpage(page); - print "Flashed final page at %06x" % page; - + client.flash(f); if(sys.argv[1]=="lock"): - print "Status: %s" %client.CCstatusstr(); + print "Status: %s" %client.status(); client.CClockchip(); - print "Status: %s" %client.CCstatusstr(); + print "Status: %s" %client.status(); if(sys.argv[1]=="flashpage"): target=0; if(len(sys.argv)>2):