X-Git-Url: https://sigrok.org/gitweb/?p=libsigrokdecode.git;a=blobdiff_plain;f=decoders%2Fsrd_usb.py;h=6cf8c2d77a48193fc5cfca08586051099b70b3df;hp=128b337e50b83ee8c724ce5e3c9daa4ae0b0eeb5;hb=bbe99ad5311855f2c1e12195ba8632ca8524b654;hpb=9611dc5f8b88f0dc43fbb00a91d1222ee720d2b6 diff --git a/decoders/srd_usb.py b/decoders/srd_usb.py index 128b337..6cf8c2d 100644 --- a/decoders/srd_usb.py +++ b/decoders/srd_usb.py @@ -40,51 +40,45 @@ # http://www.usb.org/developers/docs/ # -import sigrok - -class Sample(): - def __init__(self, data): - self.data = data - def probe(self, probe): - s = ord(self.data[probe / 8]) & (1 << (probe % 8)) - return True if s else False - -def sampleiter(data, unitsize): - for i in range(0, len(data), unitsize): - yield(Sample(data[i:i+unitsize])) +import sigrokdecode as srd # States SE0, J, K, SE1 = 0, 1, 2, 3 + +# ... syms = { - (False, False): SE0, - (True, False): J, - (False, True): K, - (True, True): SE1, + (0, 0): SE0, + (1, 0): J, + (0, 1): K, + (1, 1): SE1, +} + +# ... +pids = { + '10000111': 'OUT', # Tokens + '10010110': 'IN', + '10100101': 'SOF', + '10110100': 'SETUP', + '11000011': 'DATA0', # Data + '11010010': 'DATA1', + '01001011': 'ACK', # Handshake + '01011010': 'NAK', + '01111000': 'STALL', + '01101001': 'NYET', } def bitstr_to_num(bitstr): - if not bitstr: return 0 + if not bitstr: + return 0 l = list(bitstr) l.reverse() return int(''.join(l), 2) def packet_decode(packet): - pids = { - '10000111':'OUT', # Tokens - '10010110':'IN', - '10100101':'SOF', - '10110100':'SETUP', - '11000011':'DATA0', # Data - '11010010':'DATA1', - '01001011':'ACK', # Handshake - '01011010':'NAK', - '01111000':'STALL', - '01101001':'NYET', - } - sync = packet[:8] pid = packet[8:16] pid = pids.get(pid, pid) + # Remove CRC. if pid in ('OUT', 'IN', 'SOF', 'SETUP'): data = packet[16:-5] @@ -93,57 +87,71 @@ def packet_decode(packet): else: dev = bitstr_to_num(data[:7]) ep = bitstr_to_num(data[7:]) - data = "DEV %d EP %d" % (dev, ep) + data = 'DEV %d EP %d' % (dev, ep) elif pid in ('DATA0', 'DATA1'): data = packet[16:-16] - tmp = "" + tmp = '' while data: - tmp += "%02X " % bitstr_to_num(data[:8]) + tmp += '%02x ' % bitstr_to_num(data[:8]) data = data[8:] data = tmp else: data = packet[16:] - if sync != "00000001": - return "SYNC INVALID!" + if sync != '00000001': + return 'SYNC INVALID!' return pid + ' ' + data -class Decoder(): +class Decoder(srd.Decoder): + id = 'usb' name = 'USB' + longname = 'Universal Serial Bus' desc = 'Universal Serial Bus' - longname = '...longname...' longdesc = '...longdesc...' author = 'Gareth McMullin' email = 'gareth@blacksphere.co.nz' license = 'gplv2+' inputs = ['logic'] outputs = ['usb'] - # Probe names with a set of defaults - probes = {'dp':0, 'dm':1} + probes = [ + {'id': 'dp', 'name': 'D+', 'desc': 'USB D+ signal'}, + {'id': 'dm', 'name': 'D-', 'desc': 'USB D- signal'}, + ] options = {} + annotations = [ + ['TODO', 'TODO'] + ] def __init__(self): - self.probes = Decoder.probes.copy() + pass def start(self, metadata): - self.unitsize = metadata['unitsize'] self.rate = metadata['samplerate'] + + # self.out_proto = self.add(srd.OUTPUT_PROTO, 'usb') + self.out_ann = self.add(srd.OUTPUT_ANN, 'usb') + if self.rate < 48000000: - raise Exception("Sample rate not sufficient for USB decoding") + raise Exception('Sample rate not sufficient for USB decoding') + # Initialise decoder state. self.sym = J self.scount = 0 self.packet = '' - def decode(self, data): - for sample in sampleiter(data['data'], self.unitsize): + def decode(self, ss, es, data): + + # FIXME + # for (samplenum, (dp, dm, x, y, z, a)) in data: + for (samplenum, (dm, dp)) in data: self.scount += 1 - sym = syms[sample.probe(self.probes['dp']), - sample.probe(self.probes['dm'])] + sym = syms[dp, dm] + + # ... if sym == self.sym: continue @@ -155,19 +163,19 @@ class Decoder(): continue # How many bits since the last transition? - if self.packet or self.sym != J: - bitcount = (self.scount - 1) * 12000000 / self.rate + if self.packet != '' or self.sym != J: + bitcount = int((self.scount - 1) * 12000000 / self.rate) else: bitcount = 0 if self.sym == SE0: if bitcount == 1: # End-Of-Packet (EOP) - sigrok.put({"type":"usb", "data":self.packet, - "display":packet_decode(self.packet)}) + self.put(0, 0, self.out_ann, + [0, [packet_decode(self.packet), self.packet]]) else: # Longer than EOP, assume reset. - sigrok.put({"type":"usb", "display":"RESET"}) + self.put(0, 0, self.out_ann, [0, ['RESET']]) self.scount = 0 self.sym = sym self.packet = '' @@ -175,11 +183,12 @@ class Decoder(): # Add bits to the packet string. self.packet += '1' * bitcount + # Handle bit stuffing. if bitcount < 6 and sym != SE0: self.packet += '0' elif bitcount > 6: - sigrok.put({"type":"usb", "display":"BIT STUFF ERROR"}) + self.put(0, 0, self.out_ann, [0, ['BIT STUFF ERROR']]) self.scount = 0 self.sym = sym