X-Git-Url: http://git.rot13.org/?p=goodfet;a=blobdiff_plain;f=client%2Fgoodfet.ccspi;h=99dbec213bc207aca4b2fbac424ecccf57a3d7ba;hp=63fc5e0e4bd42871e57333f7d116890966df0aeb;hb=4e119f07426373a75db57b798e65a485bfc39322;hpb=0c53a410a2d82927261d39e74cd98ecc6b6eebf1 diff --git a/client/goodfet.ccspi b/client/goodfet.ccspi index 63fc5e0..99dbec2 100755 --- a/client/goodfet.ccspi +++ b/client/goodfet.ccspi @@ -12,14 +12,6 @@ import array, time; from GoodFETCCSPI import GoodFETCCSPI; -def printpacket(packet): - s=""; - i=0; - for foo in packet: - s="%s %02x" % (s,ord(foo)); - print "#%s" % s; - - if(len(sys.argv)==1): print "Usage: %s verb [objects]\n" % sys.argv[0]; print "%s info" % sys.argv[0]; @@ -27,9 +19,16 @@ if(len(sys.argv)==1): print "%s test" % sys.argv[0]; print "%s peek 0x$start [0x$stop]" % sys.argv[0]; print "%s poke 0x$adr 0x$val" % sys.argv[0]; + print "%s txtest" % sys.argv[0]; print "\n%s rssi" % sys.argv[0]; - print "%s sniff" % sys.argv[0]; + print "%s sniff [chan]" % sys.argv[0]; + print "%s bsniff [chan]" % sys.argv[0]; + print "%s sniffdissect" % sys.argv[0]; + + + print; + print "%s txtoscount [-i|-r] TinyOS BlinkToLED" % sys.argv[0]; sys.exit(); @@ -37,12 +36,27 @@ if(len(sys.argv)==1): client=GoodFETCCSPI(); client.serInit() - client.setup(); #Dummy read. #Might read as all ones if chip has a startup delay. +if(sys.argv[1]=="carrier"): + if len(sys.argv)>2: + client.RF_setfreq(eval(sys.argv[2])); + while 1: + client.RF_carrier(); + while(1): + time.sleep(1); + +if(sys.argv[1]=="modulated_spectrum"): + if len(sys.argv)>2: + client.RF_setfreq(eval(sys.argv[2])); + while 1: + client.RF_modulated_spectrum(); + while(1): + time.sleep(1); + if(sys.argv[1]=="info"): print "Found %s" % client.identstr(); print "Freq: %05f MHz" % (client.RF_getfreq()/(10**6)); @@ -58,7 +72,11 @@ if(sys.argv[1]=="test"): print "%02x %02x" % (ord(data[1]), ord(data[2])); if(sys.argv[1]=="rssi"): if len(sys.argv)>2: - client.RF_setfreq(eval(sys.argv[2])); + freq=eval(sys.argv[2]); + if freq>100: + client.RF_setfreq(freq); + else: + client.RF_setchan(freq); print "Listening on %f MHz." % (client.RF_getfreq()/10.0**6); client.strobe(0x02); #Calibrate @@ -74,45 +92,182 @@ if(sys.argv[1]=="rssi"): for foo in range(0,rssi>>2): string=("%s."%string); print "%02x %04i %s" % (rssi,rssi, string); -if(sys.argv[1]=="sniff"): +if(sys.argv[1]=="sniff" or sys.argv[1]=="sniffdissect"): #Promiscuous mode. client.RF_promiscuity(1); + client.RF_autocrc(0); if len(sys.argv)>2: freq=eval(sys.argv[2]); if freq>100: client.RF_setfreq(freq); else: - print "Channels not yet supported." + client.RF_setchan(freq); client.CC_RFST_RX(); 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(); + if sys.argv[1]=="sniffdissect": + client.printdissect(packet); + else: + client.printpacket(packet); + sys.stdout.flush(); +if(sys.argv[1]=="bsniff"): + #Just broadcast. + client.RF_promiscuity(0); + client.RF_setsmac(0xFFFFFFFF); + client.RF_autocrc(1); + if len(sys.argv)>2: + freq=eval(sys.argv[2]); + if freq>100: + client.RF_setfreq(freq); + else: + client.RF_setchan(freq); + client.CC_RFST_RX(); + 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(); - printpacket(packet); + client.printpacket(packet); sys.stdout.flush(); + if(sys.argv[1]=="txtest"): if len(sys.argv)>2: freq=eval(sys.argv[2]); if freq>100: client.RF_setfreq(freq); else: - print "Channels not yet supported." - print "Transmitting as %010x on %i MHz" % ( + client.RF_setchan(freq); + print "Transmitting DEADBEEF as %010x on %i MHz" % ( client.RF_getsmac(), client.RF_getfreq()/10**6); while 1: client.RF_txpacket([0x0f, 0x01, 0x08, 0x82, 0xff, 0xff, 0xff, 0xff, - 0x4d, 0x7d, 0x09, 0x00, - 0x1f, 0x00, 0xc0]); - print client.status(); - print; + 0xde, 0xad, 0xbe, 0xef, + 0xba, 0xbe, 0xc0]); +if(sys.argv[1]=="txtoscount"): + ''' + Clone of what TinyOS's RadioCountToLeds demo code does. Specify a + channel a TinyOS mote programmed with RadioCountToLeds is on, and + this will act as the second device. + ''' + if (len(sys.argv)<=3): + print "Provide -r to work via replays or -i to work via incrementing itself."; + sys.exit(1); + if (sys.argv[3]=="-r"): + client.RF_promiscuity(1); + client.RF_autocrc(1); + if len(sys.argv)>2: + freq=eval(sys.argv[2]); + if freq>100: + client.RF_setfreq(freq); + else: + client.RF_setchan(freq); + if (sys.argv[3]=="-r"): + client.CC_RFST_RX(); + print "Listening as %010x on %i MHz" % (client.RF_getsmac(), client.RF_getfreq()/10**6); + print "Transmitting like the TinyOS CountToRadio program on %i MHz" % (client.RF_getfreq()/10**6); + if (sys.argv[3]=="-i"): + i = 0; + countpkt = [0x0f, 0x41, 0x88, 0xFF, 0x22, 0x00, 0xff, 0xff, 0x01, 0x00, 0x3f, 0x06, 0x00, 0xFF]; + while 1: + if (sys.argv[3]=="-r"): #give -r to do via replays from the other device + packet=None; + while packet==None: + packet=client.RF_rxpacket(); + pkt = packet[:14]; + client.RF_txpacket(pkt); + elif (sys.argv[3]=="-i"): #give -i to have it increment and send + #Use this code for it to actually do increments itself: + pkt = countpkt[:]; + pkt[3] = i; + pkt[13] = i+1; + client.RF_txpacket(pkt); + if i >= 31: i = 0; + else: i += 1; + time.sleep(0.5); + +if(sys.argv[1]=="txpiptest" or sys.argv[1]=="txpipscapy"): + if len(sys.argv)>2: + freq=eval(sys.argv[2]); + if freq>100: + client.RF_setfreq(freq); + else: + client.RF_setchan(freq); + print "Transmitting on as %010x on %i MHz" % ( + client.RF_getsmac(), + client.RF_getfreq()/10**6); + + client.RF_setsync(0xFFFF); + + while 1: + if(sys.argv[1]=="txpiptest"): + client.RF_txpacket([ + 0x7f, + #Real header, must begin with SFD. + 0x00, 0x00, 0x00, + 0x00, 0xA7, + + #Length + 0x1f, 0x01, 0x08, 0x82, + 0xDF, 0xff, 0xff, 0xff, + 0xde, 0xad, 0xbe, 0xef, + 0xba, 0xbe, 0xc0, + + #Preamble + 0x00, 0x00, 0x00, + #SFD + 0x00, 0xA7, #CC2420 SFD + #Packet In Packet + 0x0f, 0x01, 0x08, 0x82, + 0xff, 0xff, 0xff, 0xff, + 0xde, 0xad, 0xbe, 0xef, + 0xba, 0xbe, 0xc0, + + 0xff, 0xff, 0xff, 0xff, + 0xff, 0xff, 0xff, 0xff, + 0xff, 0xff, 0xff, 0xff, + 0xff, 0xff, 0xff, 0xff, + 0xff, 0xff, 0xff, 0xff, + 0xff, 0xff, 0xff, 0xff, + 0xff, 0xff, 0xff, 0xff, + ]); + elif(sys.argv[1]=="txpipscapy"): + try: + from scapy.all import Dot15d4, Dot15d4FCS, Dot15d4Data, Raw + import struct + except ImportError: + print "To use packet building, Scapy must be installed and have the dot15d4 extension present." + print "try: hg clone http://hg.secdev.org/scapy-com"; + print " sudo ./setup.py install"; + #Overall method is to build from the inner packet outwards in the pkt string + # Make inner packet + scapyinner = Dot15d4FCS(seqnum=130)/Dot15d4Data()/Raw('\xde\xad\xbe\xef'); + #pkt = str(scapyinner)[:-2] + '\xba\xbe\xc0'; + pkt = str(scapyinner); #build inner pkt to bytes, adding FCS automatically + #pkt = '\x0f'+pkt + pkt = struct.pack('b', len(pkt)) + pkt #prepend with its length + pkt = "\x00\x00\x00\x00\xA7" + pkt #add preamble and SFD to inner packet + # Make outer (wrapping) packet + scapyouter = Dot15d4(seqnum=130)/Dot15d4Data(dest_panid=0xffdf)/Raw('\xde\xad\xbe\xef\xba\xbe\xc0') #TODO why need these last 3 bytes? + pkt = str(scapyouter) + pkt + pkt = struct.pack('b', len(pkt)) + pkt #prepend with its length + pkt = '\x00\x00\x00\x00\xA7' + pkt + ('\xff'*28) #start with preamble/SFD and add 0xff fill at end + pkt = struct.pack('b', len(pkt)) + pkt #prepend with its length (originally used \x7f) + client.printpacket(pkt) + client.RF_autocrc(1); + client.RF_txpacket(pkt) + if(sys.argv[1]=="peek"): start=0x0000;