X-Git-Url: https://sigrok.org/gitweb/?p=libsigrokdecode.git;a=blobdiff_plain;f=decoders%2Fsrd_usb.py;h=387fd06768c50ff8fc8936cb4092de21fadf092d;hp=128b337e50b83ee8c724ce5e3c9daa4ae0b0eeb5;hb=eb7082c98efad727d88e3ebeadcd496fa948475b;hpb=9611dc5f8b88f0dc43fbb00a91d1222ee720d2b6 diff --git a/decoders/srd_usb.py b/decoders/srd_usb.py index 128b337..387fd06 100644 --- a/decoders/srd_usb.py +++ b/decoders/srd_usb.py @@ -40,51 +40,42 @@ # 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, } 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', + '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,24 +84,25 @@ 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' desc = 'Universal Serial Bus' longname = '...longname...' @@ -120,30 +112,35 @@ class Decoder(): 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 = {} 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, timeoffset, duration, data): + out = [] + + # FIXME + for (samplenum, (dp, dm, x, y, z, a)) 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 @@ -156,18 +153,18 @@ class Decoder(): # How many bits since the last transition? if self.packet or self.sym != J: - bitcount = (self.scount - 1) * 12000000 / self.rate + 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)}) + out += [{'type': 'usb', 'data': self.packet, + 'display': packet_decode(self.packet)}] else: # Longer than EOP, assume reset. - sigrok.put({"type":"usb", "display":"RESET"}) + out += [{'type': 'usb', 'display': 'RESET'}] self.scount = 0 self.sym = sym self.packet = '' @@ -179,8 +176,12 @@ class Decoder(): if bitcount < 6 and sym != SE0: self.packet += '0' elif bitcount > 6: - sigrok.put({"type":"usb", "display":"BIT STUFF ERROR"}) + out += [{'type': 'usb', 'display': 'BIT STUFF ERROR'}] self.scount = 0 self.sym = sym + if out != []: + # self.put(0, 0, self.out_proto, out_proto) + self.put(0, 0, self.out_ann, out) +