X-Git-Url: http://git.rot13.org/?p=goodfet;a=blobdiff_plain;f=client%2FGoodFETMCPCAN.py;h=304b747ef161627c48d68896027380dff68bb6f6;hp=189ef56c35409e6ccd7d2a1d2720222842037382;hb=ed70ab984559f85637b5d3ef88493e5cde92d9d5;hpb=b2c8966bf1865ffd10329668fd32ca72fccf75ae diff --git a/client/GoodFETMCPCAN.py b/client/GoodFETMCPCAN.py index 189ef56..304b747 100644 --- a/client/GoodFETMCPCAN.py +++ b/client/GoodFETMCPCAN.py @@ -292,50 +292,54 @@ class GoodFETMCPCAN(GoodFETSPI): ## This code could be drastica - def packet2parsedstr(self,data): + def packet2parsed(self,data): dp1 = ord(data[0]) dp2 = ord(data[1]) dp5 = ord(data[4]) - #converts the CAN message to a string - msg=""; - - - + packet = {} #get the ide bit. allows us to check to see if we have an extended #frame - ide = (dp2 & 0x0f)>>3 + packet['ide'] = (dp2 & 0x0f)>>3 #we have an extended frame - if( ide != 0): + if( packet['ide'] != 0): #get lower nibble, last 2 bits eId = dp2 & 0x03 eId = eId<<8 | ord(data[2]) eId = eId<<8 | ord(data[3]) rtr = dp5>>6 & 0x01 - eIDmsg = " eID: %06d" %(eId) - rtrmsg = " rtr: %d" % (rtr) + packet['eID'] = " eID: %06d" %(eId) + packet['rtr'] = " rtr: %d" % (rtr) else: - rtr = dp2>>4 & 0x01 - eIDmsg = "" - rtrmsg = " rtr: %d"%(rtr) + packet['rtr'] = dp2>>4 & 0x01 + # Create the standard ID. from the message - sID = dp1<<3 | dp2>>5 - length = dp5 & 0x0f + packet['sID'] = dp1<<3 | dp2>>5 + packet['length'] = dp5 & 0x0f #generate the data section - dbmsg = "" - for i in range(0,length): + for i in range(0,packet['length']): idx = 5 + i - dbmsg += " %03d"%ord(data[idx]) - - msg = "sID: %04d"%sID - msg += eIDmsg + rtrmsg - msg += " length: %d"%(length) - msg += dbmsg + dbidx = 'db%d'%i + packet[dbidx] = ord(data[idx]) + return packet - return msg + def packet2parsedstr(self,data): + packet = self.packet2parsed(data) + msg = "sID: %04d" %packet['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 def peek8(self,adr):