from random import randrange
from GoodFETMCPCAN import GoodFETMCPCAN;
from intelhex import IntelHex;
+import Queue
class GoodFETMCPCANCommunication:
# SNIFF
##########################
- def sniff(self,freq,duration,description, verbose=True, comment=None, filename=None, standardid=None, debug=False, faster=False, parsed=True):
+ def sniff(self,freq,duration,description, verbose=True, comment=None, filename=None, standardid=None, debug=False, faster=False, parsed=True, data = None):
#reset eveything on the chip
self.client.serInit()
packet=self.client.fastrxpacket();
else:
packet=self.client.rxpacket();
-
+
+ #add the data to list if the pointer was included
+ if(data != None and packet != None):
+ #data.append(self.client.packet2parsedstr(packet))
+ packetParsed = self.client.packet2parsed(packet)
+ packetParsed["time"] =time.time()
+ data.put(packetParsed)
if(debug == True):
#check packet status
MCPstatusReg = self.client.MCPrxstatus();
if( verbose==True):
#if we want to print a parsed message
if( parsed == True):
-# packetParsed = self.client.packet2parsed(packet)
-# sId = packetParsed.get('sID')
-# msg = "sID: %04d" %sId
-# if( packetParsed.get('eID')):
-# msg += " eID: %d" %packetParsed.get('eID')
-# msg += " rtr: %d"%packetParsed['rtr']
-# length = packetParsed['length']
-# msg += " length: %d"%length
-# msg += " data:"
-# for i in range(0,length):
-# dbidx = 'db%d'%i
-# msg +=" %03d"% ord(packetParsed[dbidx])
- msg = self.client.packet2parsedstr(packet)
+ packetParsed = self.client.packet2parsed(packet)
+ sId = packetParsed.get('sID')
+ msg = "sID: %04d" %sId
+ if( packetParsed.get('eID')):
+ msg += " eID: %d" %packetParsed.get('eID')
+ msg += " rtr: %d"%packetParsed['rtr']
+ length = packetParsed['length']
+ msg += " length: %d"%length
+ msg += " data:"
+ for i in range(0,length):
+ dbidx = 'db%d'%i
+ msg +=" %03d"% ord(packetParsed[dbidx])
+ #msg = self.client.packet2parsedstr(packet)
print msg
# if we want to print just the message as it is read off the chip
else:
if (verbose == True):
print "Filtering for SID %d (0x%02xh) with filter #%d"%(ID, ID, filter);
-
+ self.client.MCPreqstatNormal();
# this will sweep through the given ids to request a packet and then sniff on that
# id for a given amount duration. This will be repeated the number of attempts time
#at the moment this is set to switch to the next id once a message is identified
- def rtrSweep(self,freq,lowID,highID, attempts = 2,duration = 1, verbose = True):
+ def rtrSweep(self,freq,lowID,highID, attempts = 1,duration = 1, verbose = True):
+ #set up file
+ now = datetime.datetime.now()
+ datestr = now.strftime("%Y%m%d")
+ path = self.DATALOCATION+datestr+"_rtr.csv"
+ filename = path
+ outfile = open(filename,'a');
+ dataWriter = csv.writer(outfile,delimiter=',');
+ dataWriter.writerow(['# Time Error Bytes 1-13']);
+ dataWriter.writerow(['#' + "rtr sweep from %d to %d"%(lowID,highID)])
print "started"
- self.client.serInit()
- self.spitSetup(freq)
+ #self.client.serInit()
+ #self.spitSetup(freq)
for i in range(lowID,highID+1, 1):
+ self.client.serInit()
self.spitSetup(freq)
standardid = [i, i, i, i]
#set filters
self.addFilter(standardid, verbose = True)
- self.client.MCPreqstatNormal();
+
#### split SID into different areas
SIDlow = (standardid[0] & 0x07) << 5; # get SID bits 2:0, rotate them to bits 7:5
SIDhigh = (standardid[0] >> 3) & 0xFF; # get SID bits 10:3, rotate them to bits 7:0
#create RTR packet
packet = [SIDhigh, SIDlow, 0x00,0x00,0x40]
+ dataWriter.writerow(["#requested id %d"%i])
#self.client.poke8(0x2C,0x00); #clear the CANINTF register; we care about bits 0 and 1 (RXnIF flags) which indicate a message is being held
+ #clear buffer
packet1 = self.client.rxpacket();
packet2 = self.client.rxpacket();
+ #send in rtr request
self.client.txpacket(packet)
## listen for 2 packets. one should be the rtr we requested the other should be
## a new packet response
- packet1=self.client.rxpacket();
- packet2=self.client.rxpacket();
- if( packet1 != None and packet2 != None):
- print "packets recieved :\n "
- print self.client.packet2parsedstr(packet1);
- print self.client.packet2parsedstr(packet2);
- continue
- elif( packet1 != None):
- print self.client.packet2parsedstr(packet1)
- elif( packet2 != None):
- print self.client.packet2parsedstr(packet2)
+ starttime = time.time()
+ while ((time.time() - starttime) < duration):
+ packet = self.client.rxpacket()
+ if( packet == None):
+ continue
+ row = []
+ row.append("%f"%time.time()) #timestamp
+ row.append(0) #error flag (not checkign)
+ row.append("rtrRequest_%d"%i) #comment
+ row.append(duration) #sniff time
+ row.append(1) # filtering boolean
+ for byte in packet:
+ row.append("%02x"%ord(byte));
+ dataWriter.writerow(row)
+ print self.client.packet2parsedstr(packet)
+# packet1=self.client.rxpacket();
+# packet2=self.client.rxpacket();
+# if( packet1 != None and packet2 != None):
+# print "packets recieved :\n "
+# print self.client.packet2parsedstr(packet1);
+# print self.client.packet2parsedstr(packet2);
+# continue
+# elif( packet1 != None):
+# print self.client.packet2parsedstr(packet1)
+# elif( packet2 != None):
+# print self.client.packet2parsedstr(packet2)
trial= 2;
# for each trial
while( trial <= attempts):
# this time we will sniff for the given amount of time to see if there is a
# time till the packets come in
while( (time.time()-starttime) < duration):
- packet1=self.client.rxpacket();
- packet2=self.client.rxpacket();
-
- if( packet1 != None and packet2 != None):
- print "packets recieved :\n "
- print self.client.packet2parsedstr(packet1);
- print self.client.packet2parsedstr(packet2);
- #break
- elif( packet1 != None):
- print "just packet1"
- print self.client.packet2parsedstr(packet1)
- elif( packet2 != None):
- print "just packet2"
- print self.client.packet2parsedstr(packet2)
+ packet=self.client.rxpacket();
+ row = []
+ row.append("%f"%time.time()) #timestamp
+ row.append(0) #error flag (not checking)
+ row.append("rtrRequest_%d"%i) #comment
+ row.append(duration) #sniff time
+ row.append(1) # filtering boolean
+ for byte in packet:
+ row.append("%02x"%ord(byte));
+ dataWriter.writerow(row)
+ print self.client.packet2parsedstr(packet)
+# packet2=self.client.rxpacket();
+#
+# if( packet1 != None and packet2 != None):
+# print "packets recieved :\n "
+# print self.client.packet2parsedstr(packet1);
+# print self.client.packet2parsedstr(packet2);
+# #break
+# elif( packet1 != None):
+# print "just packet1"
+# print self.client.packet2parsedstr(packet1)
+# elif( packet2 != None):
+# print "just packet2"
+# print self.client.packet2parsedstr(packet2)
trial += 1
print "sweep complete"
+ outfile.close()
def spitSetup(self,freq):
self.reset();
self.spitSetup(freq);
spit(self,freq, standardid, repeat, duration = None, debug = False, packet = None)
- def spit(self,freq, standardid, repeat, duration = None, debug = False, packet = None):
+ def spit(self,freq, standardid, repeat,writes, period = None, debug = False, packet = None):
#### split SID into different regs
print "Transmitting packet: "
- print self.client.packet2str(packet)
+ #print self.client.packet2str(packet)
self.client.txpacket(packet);
if repeat:
print "\nNow looping on transmit. "
- if duration!= None:
- starttime = time.time();
- while((time.time()-starttime < duration)):
+ if period != None:
+ for i in range(0,writes):
self.client.MCPrts(TXB0=True);
- print "MSG printed"
+ tic = time.time()
+ time.sleep(period/1000) # pause for period ms before sending again
+ print time.time()-tic
+ #starttime = time.time();
+ #while((time.time()-starttime < duration)):
+ # self.client.MCPrts(TXB0=True);
+ # print "MSG printed"
else:
- while(1):
+ for i in range(0,writes):
self.client.MCPrts(TXB0=True);
print "messages injected"
projects / goodfet / blobdiff