2 ## This file is part of the libsigrokdecode project.
4 ## Copyright (C) 2011 Gareth McMullin <gareth@blacksphere.co.nz>
5 ## Copyright (C) 2012-2014 Uwe Hermann <uwe@hermann-uwe.de>
7 ## This program is free software; you can redistribute it and/or modify
8 ## it under the terms of the GNU General Public License as published by
9 ## the Free Software Foundation; either version 2 of the License, or
10 ## (at your option) any later version.
12 ## This program is distributed in the hope that it will be useful,
13 ## but WITHOUT ANY WARRANTY; without even the implied warranty of
14 ## MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 ## GNU General Public License for more details.
17 ## You should have received a copy of the GNU General Public License
18 ## along with this program; if not, write to the Free Software
19 ## Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
22 import sigrokdecode as srd
38 - 'FRAMENUM', <framenum>
39 - 'DATABYTE', <databyte>
40 - 'HUBADDR', <hubaddr>
46 - 'PACKET', [<pcategory>, <pname>, <pinfo>]
48 <pcategory>, <pname>, <pinfo>:
49 - 'TOKEN', 'OUT', [<sync>, <pid>, <addr>, <ep>, <crc5>, <eop>]
50 - 'TOKEN', 'IN', [<sync>, <pid>, <addr>, <ep>, <crc5>, <eop>]
51 - 'TOKEN', 'SOF', [<sync>, <pid>, <framenum>, <crc5>, <eop>]
52 - 'TOKEN', 'SETUP', [<sync>, <pid>, <addr>, <ep>, <crc5>, <eop>]
53 - 'DATA', 'DATA0', [<sync>, <pid>, <databytes>, <crc16>, <eop>]
54 - 'DATA', 'DATA1', [<sync>, <pid>, <databytes>, <crc16>, <eop>]
55 - 'DATA', 'DATA2', [<sync>, <pid>, <databytes>, <crc16>, <eop>]
56 - 'DATA', 'MDATA', [<sync>, <pid>, <databytes>, <crc16>, <eop>]
57 - 'HANDSHAKE', 'ACK', [<sync>, <pid>, <eop>]
58 - 'HANDSHAKE', 'NAK', [<sync>, <pid>, <eop>]
59 - 'HANDSHAKE', 'STALL', [<sync>, <pid>, <eop>]
60 - 'HANDSHAKE', 'NYET', [<sync>, <pid>, <eop>]
61 - 'SPECIAL', 'PRE', [<sync>, <pid>, <addr>, <ep>, <crc5>, <eop>]
62 - 'SPECIAL', 'ERR', [<sync>, <pid>, <eop>]
64 [<sync>, <pid>, <hubaddr>, <sc>, <port>, <s>, <e/u>, <et>, <crc5>, <eop>]
65 - 'SPECIAL', 'PING', [<sync>, <pid>, <addr>, <ep>, <crc5>, <eop>]
66 - 'SPECIAL', 'Reserved', None
68 <sync>: SYNC field bitstring, normally '00000001' (8 chars).
69 <pid>: Packet ID bitstring, e.g. '11000011' for DATA0 (8 chars).
70 <addr>: Address field number, 0-127 (7 bits).
71 <ep>: Endpoint number, 0-15 (4 bits).
72 <crc5>: CRC-5 number (5 bits).
73 <crc16>: CRC-16 number (16 bits).
74 <eop>: End of packet marker. List of symbols, usually ['SE0', 'SE0', 'J'].
75 <framenum>: USB (micro)frame number, 0-2047 (11 bits).
76 <databyte>: A single data byte, e.g. 0x55.
77 <databytes>: List of data bytes, e.g. [0x55, 0xaa, 0x99] (0 - 1024 bytes).
87 # The first 4 bits are the 'packet type' field, the last 4 bits are the
88 # 'check field' (each bit in the check field must be the inverse of the resp.
89 # bit in the 'packet type' field; if not, that's a 'PID error').
90 # For the 4-bit strings, the left-most '1' or '0' is the LSB, i.e. it's sent
94 '10000111': ['OUT', 'Address & EP number in host-to-function transaction'],
95 '10010110': ['IN', 'Address & EP number in function-to-host transaction'],
96 '10100101': ['SOF', 'Start-Of-Frame marker & frame number'],
97 '10110100': ['SETUP', 'Address & EP number in host-to-function transaction for SETUP to a control pipe'],
100 # Note: DATA2 and MDATA are HS-only.
101 '11000011': ['DATA0', 'Data packet PID even'],
102 '11010010': ['DATA1', 'Data packet PID odd'],
103 '11100001': ['DATA2', 'Data packet PID HS, high bandwidth isosynchronous transaction in a microframe'],
104 '11110000': ['MDATA', 'Data packet PID HS for split and high-bandwidth isosynchronous transactions'],
107 '01001011': ['ACK', 'Receiver accepts error-free packet'],
108 '01011010': ['NAK', 'Receiver cannot accept or transmitter cannot send'],
109 '01111000': ['STALL', 'EP halted or control pipe request unsupported'],
110 '01101001': ['NYET', 'No response yet from receiver'],
113 '00111100': ['PRE', 'Host-issued preamble; enables downstream bus traffic to low-speed devices'],
114 '00111100': ['ERR', 'Split transaction error handshake'],
115 '00011110': ['SPLIT', 'HS split transaction token'],
116 '00101101': ['PING', 'HS flow control probe for a bulk/control EP'],
117 '00001111': ['Reserved', 'Reserved PID'],
120 def get_category(pidname):
121 if pidname in ('OUT', 'IN', 'SOF', 'SETUP'):
123 elif pidname in ('DATA0', 'DATA1', 'DATA2', 'MDATA'):
125 elif pidname in ('ACK', 'NAK', 'STALL', 'NYET'):
130 def ann_index(pidname):
131 l = ['OUT', 'IN', 'SOF', 'SETUP', 'DATA0', 'DATA1', 'DATA2', 'MDATA',
132 'ACK', 'NAK', 'STALL', 'NYET', 'PRE', 'ERR', 'SPLIT', 'PING',
136 return l.index(pidname) + 11
138 def bitstr_to_num(bitstr):
143 return int(''.join(l), 2)
145 def reverse_number(num, count):
146 out = list(count * '0')
147 for i in range(0, count):
150 return int(''.join(out), 2)
152 def calc_crc5(bitstr):
157 if int(bit) != (crc5 >> 5):
161 return reverse_number(crc5, 5)
163 def calc_crc16(bitstr):
168 if int(bit) != (crc16 >> 16):
172 return reverse_number(crc16, 16)
174 class Decoder(srd.Decoder):
178 longname = 'Universal Serial Bus (LS/FS) packet'
179 desc = 'USB (low-speed and full-speed) packet protocol.'
181 inputs = ['usb_signalling']
182 outputs = ['usb_packet']
184 {'id': 'signalling', 'desc': 'Signalling',
185 'default': 'full-speed', 'values': ('full-speed', 'low-speed')},
189 ('sync-err', 'SYNC (error)'),
191 ('framenum', 'FRAMENUM'),
195 ('crc5-err', 'CRC5 (error)'),
197 ('crc16-ok', 'CRC16'),
198 ('crc16-err', 'CRC16 (error)'),
199 ('packet-out', 'Packet: OUT'),
200 ('packet-in', 'Packet: IN'),
201 ('packet-sof', 'Packet: SOF'),
202 ('packet-setup', 'Packet: SETUP'),
203 ('packet-data0', 'Packet: DATA0'),
204 ('packet-data1', 'Packet: DATA1'),
205 ('packet-data2', 'Packet: DATA2'),
206 ('packet-mdata', 'Packet: MDATA'),
207 ('packet-ack', 'Packet: ACK'),
208 ('packet-nak', 'Packet: NAK'),
209 ('packet-stall', 'Packet: STALL'),
210 ('packet-nyet', 'Packet: NYET'),
211 ('packet-pre', 'Packet: PRE'),
212 ('packet-err', 'Packet: ERR'),
213 ('packet-split', 'Packet: SPLIT'),
214 ('packet-ping', 'Packet: PING'),
215 ('packet-reserved', 'Packet: Reserved'),
216 ('packet-invalid', 'Packet: Invalid'),
219 ('fields', 'Packet fields', tuple(range(10 + 1))),
220 ('packet', 'Packets', tuple(range(11, 28 + 1))),
226 self.packet_summary = ''
227 self.ss = self.es = None
228 self.ss_packet = self.es_packet = None
229 self.state = 'WAIT FOR SOP'
231 def putpb(self, data):
232 self.put(self.ss, self.es, self.out_python, data)
234 def putb(self, data):
235 self.put(self.ss, self.es, self.out_ann, data)
237 def putpp(self, data):
238 self.put(self.ss_packet, self.es_packet, self.out_python, data)
240 def putp(self, data):
241 self.put(self.ss_packet, self.es_packet, self.out_ann, data)
244 self.out_python = self.register(srd.OUTPUT_PYTHON)
245 self.out_ann = self.register(srd.OUTPUT_ANN)
247 def handle_packet(self):
249 for (bit, ss, es) in self.bits:
253 self.putp([28, ['Invalid packet (shorter than 8 bits)']])
257 sync = packet[:7 + 1]
258 self.ss, self.es = self.bits[0][1], self.bits[7][2]
259 # The SYNC pattern for low-speed/full-speed is KJKJKJKK (00000001).
260 if sync != '00000001':
261 self.putpb(['SYNC ERROR', sync])
262 self.putb([1, ['SYNC ERROR: %s' % sync, 'SYNC ERR: %s' % sync,
263 'SYNC ERR', 'SE', 'S']])
265 self.putpb(['SYNC', sync])
266 self.putb([0, ['SYNC: %s' % sync, 'SYNC', 'S']])
267 self.packet.append(sync)
270 self.putp([28, ['Invalid packet (shorter than 16 bits)']])
274 pid = packet[8:15 + 1]
275 pidname = pids.get(pid, ('UNKNOWN', 'Unknown PID'))[0]
276 self.ss, self.es = self.bits[8][1], self.bits[15][2]
277 self.putpb(['PID', pidname])
278 self.putb([2, ['PID: %s' % pidname, pidname, pidname[0]]])
279 self.packet.append(pid)
280 self.packet_summary += pidname
282 if pidname in ('OUT', 'IN', 'SOF', 'SETUP', 'PRE', 'PING'):
284 self.putp([28, ['Invalid packet (shorter than 32 bits)']])
288 # Bits[16:26]: Framenum
289 framenum = bitstr_to_num(packet[16:26 + 1])
290 self.ss, self.es = self.bits[16][1], self.bits[26][2]
291 self.putpb(['FRAMENUM', framenum])
292 self.putb([3, ['Frame: %d' % framenum, 'Frame', 'Fr', 'F']])
293 self.packet.append(framenum)
294 self.packet_summary += ' %d' % framenum
297 addr = bitstr_to_num(packet[16:22 + 1])
298 self.ss, self.es = self.bits[16][1], self.bits[22][2]
299 self.putpb(['ADDR', addr])
300 self.putb([4, ['Address: %d' % addr, 'Addr: %d' % addr,
302 self.packet.append(addr)
303 self.packet_summary += ' ADDR %d' % addr
306 ep = bitstr_to_num(packet[23:26 + 1])
307 self.ss, self.es = self.bits[23][1], self.bits[26][2]
308 self.putpb(['EP', ep])
309 self.putb([5, ['Endpoint: %d' % ep, 'EP: %d' % ep, 'EP', 'E']])
310 self.packet.append(ep)
311 self.packet_summary += ' EP %d' % ep
314 crc5 = bitstr_to_num(packet[27:31 + 1])
315 crc5_calc = calc_crc5(packet[16:27])
316 self.ss, self.es = self.bits[27][1], self.bits[31][2]
317 if crc5 == crc5_calc:
318 self.putpb(['CRC5', crc5])
319 self.putb([6, ['CRC5: 0x%02X' % crc5, 'CRC5', 'C']])
321 self.putpb(['CRC5 ERROR', crc5])
322 self.putb([7, ['CRC5 ERROR: 0x%02X' % crc5, 'CRC5 ERR', 'CE', 'C']])
323 self.packet.append(crc5)
324 elif pidname in ('DATA0', 'DATA1', 'DATA2', 'MDATA'):
325 # Bits[16:packetlen-16]: Data
326 data = packet[16:-16]
327 # TODO: len(data) must be a multiple of 8.
329 self.packet_summary += ' ['
330 for i in range(0, len(data), 8):
331 db = bitstr_to_num(data[i:i + 8])
332 self.ss, self.es = self.bits[16 + i][1], self.bits[23 + i][2]
333 self.putpb(['DATABYTE', db])
334 self.putb([8, ['Databyte: %02X' % db, 'Data: %02X' % db,
335 'DB: %02X' % db, '%02X' % db]])
337 self.packet_summary += ' %02X' % db
338 self.packet_summary += ' ]'
340 # Convenience Python output (no annotation) for all bytes together.
341 self.ss, self.es = self.bits[16][1], self.bits[-16][2]
342 self.putpb(['DATABYTES', databytes])
343 self.packet.append(databytes)
345 # Bits[packetlen-16:packetlen]: CRC16
346 crc16 = bitstr_to_num(packet[-16:])
347 crc16_calc = calc_crc16(packet[16:-16])
348 self.ss, self.es = self.bits[-16][1], self.bits[-1][2]
349 if crc16 == crc16_calc:
350 self.putpb(['CRC16', crc16])
351 self.putb([9, ['CRC16: 0x%04X' % crc16, 'CRC16', 'C']])
353 self.putpb(['CRC16 ERROR', crc16])
354 self.putb([10, ['CRC16 ERROR: 0x%04X' % crc16, 'CRC16 ERR', 'CE', 'C']])
355 self.packet.append(crc16)
356 elif pidname in ('ACK', 'NAK', 'STALL', 'NYET', 'ERR'):
357 pass # Nothing to do, these only have SYNC+PID+EOP fields.
359 pass # TODO: Handle 'SPLIT' and possibly 'Reserved' packets.
361 # Output a (summary of) the whole packet.
362 pcategory, pname, pinfo = get_category(pidname), pidname, self.packet
363 self.putpp(['PACKET', [pcategory, pname, pinfo]])
364 self.putp([ann_index(pidname), ['%s' % self.packet_summary]])
366 self.packet, self.packet_summary = [], ''
368 def decode(self, ss, es, data):
369 (ptype, pdata) = data
371 # We only care about certain packet types for now.
372 if ptype not in ('SOP', 'BIT', 'EOP'):
376 if self.state == 'WAIT FOR SOP':
380 self.state = 'GET BIT'
381 elif self.state == 'GET BIT':
383 self.bits.append([pdata, ss, es])
387 self.packet, self.packet_summary = [], ''
388 self.bits, self.state = [], 'WAIT FOR SOP'