decoders/uart/pd.py

   1 ##
   2 ## This file is part of the libsigrokdecode project.
   3 ##
   4 ## Copyright (C) 2011-2014 Uwe Hermann <uwe@hermann-uwe.de>
   5 ##
   6 ## This program is free software; you can redistribute it and/or modify
   7 ## it under the terms of the GNU General Public License as published by
   8 ## the Free Software Foundation; either version 2 of the License, or
   9 ## (at your option) any later version.
  10 ##
  11 ## This program is distributed in the hope that it will be useful,
  12 ## but WITHOUT ANY WARRANTY; without even the implied warranty of
  13 ## MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14 ## GNU General Public License for more details.
  15 ##
  16 ## You should have received a copy of the GNU General Public License
  17 ## along with this program; if not, write to the Free Software
  18 ## Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301 USA
  19 ##
  20
  21 import sigrokdecode as srd
  22 from math import floor, ceil
  23
  24 '''
  25 OUTPUT_PYTHON format:
  26
  27 Packet:
  28 [<ptype>, <rxtx>, <pdata>]
  29
  30 This is the list of <ptype>s and their respective <pdata> values:
  31  - 'STARTBIT': The data is the (integer) value of the start bit (0/1).
  32  - 'DATA': This is always a tuple containing two items:
  33    - 1st item: the (integer) value of the UART data. Valid values
  34      range from 0 to 512 (as the data can be up to 9 bits in size).
  35    - 2nd item: the list of individual data bits and their ss/es numbers.
  36  - 'PARITYBIT': The data is the (integer) value of the parity bit (0/1).
  37  - 'STOPBIT': The data is the (integer) value of the stop bit (0 or 1).
  38  - 'INVALID STARTBIT': The data is the (integer) value of the start bit (0/1).
  39  - 'INVALID STOPBIT': The data is the (integer) value of the stop bit (0/1).
  40  - 'PARITY ERROR': The data is a tuple with two entries. The first one is
  41    the expected parity value, the second is the actual parity value.
  42  - TODO: Frame error?
  43
  44 The <rxtx> field is 0 for RX packets, 1 for TX packets.
  45 '''
  46
  47 # Used for differentiating between the two data directions.
  48 RX = 0
  49 TX = 1
  50
  51 # Given a parity type to check (odd, even, zero, one), the value of the
  52 # parity bit, the value of the data, and the length of the data (5-9 bits,
  53 # usually 8 bits) return True if the parity is correct, False otherwise.
  54 # 'none' is _not_ allowed as value for 'parity_type'.
  55 def parity_ok(parity_type, parity_bit, data, num_data_bits):
  56
  57     # Handle easy cases first (parity bit is always 1 or 0).
  58     if parity_type == 'zero':
  59         return parity_bit == 0
  60     elif parity_type == 'one':
  61         return parity_bit == 1
  62
  63     # Count number of 1 (high) bits in the data (and the parity bit itself!).
  64     ones = bin(data).count('1') + parity_bit
  65
  66     # Check for odd/even parity.
  67     if parity_type == 'odd':
  68         return (ones % 2) == 1
  69     elif parity_type == 'even':
  70         return (ones % 2) == 0
  71
  72 class SamplerateError(Exception):
  73     pass
  74
  75 class ChannelError(Exception):
  76     pass
  77
  78 class Decoder(srd.Decoder):
  79     api_version = 2
  80     id = 'uart'
  81     name = 'UART'
  82     longname = 'Universal Asynchronous Receiver/Transmitter'
  83     desc = 'Asynchronous, serial bus.'
  84     license = 'gplv2+'
  85     inputs = ['logic']
  86     outputs = ['uart']
  87     optional_channels = (
  88         # Allow specifying only one of the signals, e.g. if only one data
  89         # direction exists (or is relevant).
  90         {'id': 'rx', 'name': 'RX', 'desc': 'UART receive line'},
  91         {'id': 'tx', 'name': 'TX', 'desc': 'UART transmit line'},
  92     )
  93     options = (
  94         {'id': 'baudrate', 'desc': 'Baud rate', 'default': 115200},
  95         {'id': 'num_data_bits', 'desc': 'Data bits', 'default': 8,
  96             'values': (5, 6, 7, 8, 9)},
  97         {'id': 'parity_type', 'desc': 'Parity type', 'default': 'none',
  98             'values': ('none', 'odd', 'even', 'zero', 'one')},
  99         {'id': 'parity_check', 'desc': 'Check parity?', 'default': 'yes',
 100             'values': ('yes', 'no')},
 101         {'id': 'num_stop_bits', 'desc': 'Stop bits', 'default': 1.0,
 102             'values': (0.0, 0.5, 1.0, 1.5)},
 103         {'id': 'bit_order', 'desc': 'Bit order', 'default': 'lsb-first',
 104             'values': ('lsb-first', 'msb-first')},
 105         {'id': 'format', 'desc': 'Data format', 'default': 'ascii',
 106             'values': ('ascii', 'dec', 'hex', 'oct', 'bin')},
 107         {'id': 'invert_rx', 'desc': 'Invert RX?', 'default': 'no',
 108             'values': ('yes', 'no')},
 109         {'id': 'invert_tx', 'desc': 'Invert TX?', 'default': 'no',
 110             'values': ('yes', 'no')},
 111     )
 112     annotations = (
 113         ('rx-data', 'RX data'),
 114         ('tx-data', 'TX data'),
 115         ('rx-start', 'RX start bits'),
 116         ('tx-start', 'TX start bits'),
 117         ('rx-parity-ok', 'RX parity OK bits'),
 118         ('tx-parity-ok', 'TX parity OK bits'),
 119         ('rx-parity-err', 'RX parity error bits'),
 120         ('tx-parity-err', 'TX parity error bits'),
 121         ('rx-stop', 'RX stop bits'),
 122         ('tx-stop', 'TX stop bits'),
 123         ('rx-warnings', 'RX warnings'),
 124         ('tx-warnings', 'TX warnings'),
 125         ('rx-data-bits', 'RX data bits'),
 126         ('tx-data-bits', 'TX data bits'),
 127     )
 128     annotation_rows = (
 129         ('rx-data', 'RX', (0, 2, 4, 6, 8)),
 130         ('rx-data-bits', 'RX bits', (12,)),
 131         ('rx-warnings', 'RX warnings', (10,)),
 132         ('tx-data', 'TX', (1, 3, 5, 7, 9)),
 133         ('tx-data-bits', 'TX bits', (13,)),
 134         ('tx-warnings', 'TX warnings', (11,)),
 135     )
 136     binary = (
 137         ('rx', 'RX dump'),
 138         ('tx', 'TX dump'),
 139         ('rxtx', 'RX/TX dump'),
 140     )
 141
 142     def putx(self, rxtx, data):
 143         s, halfbit = self.startsample[rxtx], self.bit_width / 2.0
 144         self.put(s - floor(halfbit), self.samplenum + ceil(halfbit), self.out_ann, data)
 145
 146     def putpx(self, rxtx, data):
 147         s, halfbit = self.startsample[rxtx], self.bit_width / 2.0
 148         self.put(s - floor(halfbit), self.samplenum + ceil(halfbit), self.out_python, data)
 149
 150     def putg(self, data):
 151         s, halfbit = self.samplenum, self.bit_width / 2.0
 152         self.put(s - floor(halfbit), s + ceil(halfbit), self.out_ann, data)
 153
 154     def putp(self, data):
 155         s, halfbit = self.samplenum, self.bit_width / 2.0
 156         self.put(s - floor(halfbit), s + ceil(halfbit), self.out_python, data)
 157
 158     def putbin(self, rxtx, data):
 159         s, halfbit = self.startsample[rxtx], self.bit_width / 2.0
 160         self.put(s - floor(halfbit), self.samplenum + ceil(halfbit), self.out_bin, data)
 161
 162     def __init__(self, **kwargs):
 163         self.samplerate = None
 164         self.samplenum = 0
 165         self.frame_start = [-1, -1]
 166         self.startbit = [-1, -1]
 167         self.cur_data_bit = [0, 0]
 168         self.databyte = [0, 0]
 169         self.paritybit = [-1, -1]
 170         self.stopbit1 = [-1, -1]
 171         self.startsample = [-1, -1]
 172         self.state = ['WAIT FOR START BIT', 'WAIT FOR START BIT']
 173         self.oldbit = [1, 1]
 174         self.oldpins = [1, 1]
 175         self.databits = [[], []]
 176
 177     def start(self):
 178         self.out_python = self.register(srd.OUTPUT_PYTHON)
 179         self.out_bin = self.register(srd.OUTPUT_BINARY)
 180         self.out_ann = self.register(srd.OUTPUT_ANN)
 181
 182     def metadata(self, key, value):
 183         if key == srd.SRD_CONF_SAMPLERATE:
 184             self.samplerate = value
 185             # The width of one UART bit in number of samples.
 186             self.bit_width = float(self.samplerate) / float(self.options['baudrate'])
 187
 188     # Return true if we reached the middle of the desired bit, false otherwise.
 189     def reached_bit(self, rxtx, bitnum):
 190         # bitpos is the samplenumber which is in the middle of the
 191         # specified UART bit (0 = start bit, 1..x = data, x+1 = parity bit
 192         # (if used) or the first stop bit, and so on).
 193         # The samples within bit are 0, 1, ..., (bit_width - 1), therefore
 194         # index of the middle sample within bit window is (bit_width - 1) / 2.
 195         bitpos = self.frame_start[rxtx] + (self.bit_width - 1) / 2.0
 196         bitpos += bitnum * self.bit_width
 197         if self.samplenum >= bitpos:
 198             return True
 199         return False
 200
 201     def reached_bit_last(self, rxtx, bitnum):
 202         bitpos = self.frame_start[rxtx] + ((bitnum + 1) * self.bit_width)
 203         if self.samplenum >= bitpos:
 204             return True
 205         return False
 206
 207     def wait_for_start_bit(self, rxtx, old_signal, signal):
 208         # The start bit is always 0 (low). As the idle UART (and the stop bit)
 209         # level is 1 (high), the beginning of a start bit is a falling edge.
 210         if not (old_signal == 1 and signal == 0):
 211             return
 212
 213         # Save the sample number where the start bit begins.
 214         self.frame_start[rxtx] = self.samplenum
 215
 216         self.state[rxtx] = 'GET START BIT'
 217
 218     def get_start_bit(self, rxtx, signal):
 219         # Skip samples until we're in the middle of the start bit.
 220         if not self.reached_bit(rxtx, 0):
 221             return
 222
 223         self.startbit[rxtx] = signal
 224
 225         # The startbit must be 0. If not, we report an error.
 226         if self.startbit[rxtx] != 0:
 227             self.putp(['INVALID STARTBIT', rxtx, self.startbit[rxtx]])
 228             self.putg([rxtx + 10, ['Frame error', 'Frame err', 'FE']])
 229             # TODO: Abort? Ignore rest of the frame?
 230
 231         self.cur_data_bit[rxtx] = 0
 232         self.databyte[rxtx] = 0
 233         self.startsample[rxtx] = -1
 234
 235         self.state[rxtx] = 'GET DATA BITS'
 236
 237         self.putp(['STARTBIT', rxtx, self.startbit[rxtx]])
 238         self.putg([rxtx + 2, ['Start bit', 'Start', 'S']])
 239
 240     def get_data_bits(self, rxtx, signal):
 241         # Skip samples until we're in the middle of the desired data bit.
 242         if not self.reached_bit(rxtx, self.cur_data_bit[rxtx] + 1):
 243             return
 244
 245         # Save the sample number of the middle of the first data bit.
 246         if self.startsample[rxtx] == -1:
 247             self.startsample[rxtx] = self.samplenum
 248
 249         # Get the next data bit in LSB-first or MSB-first fashion.
 250         if self.options['bit_order'] == 'lsb-first':
 251             self.databyte[rxtx] >>= 1
 252             self.databyte[rxtx] |= \
 253                 (signal << (self.options['num_data_bits'] - 1))
 254         else:
 255             self.databyte[rxtx] <<= 1
 256             self.databyte[rxtx] |= (signal << 0)
 257
 258         self.putg([rxtx + 12, ['%d' % signal]])
 259
 260         # Store individual data bits and their start/end samplenumbers.
 261         s, halfbit = self.samplenum, int(self.bit_width / 2)
 262         self.databits[rxtx].append([signal, s - halfbit, s + halfbit])
 263
 264         # Return here, unless we already received all data bits.
 265         if self.cur_data_bit[rxtx] < self.options['num_data_bits'] - 1:
 266             self.cur_data_bit[rxtx] += 1
 267             return
 268
 269         self.state[rxtx] = 'GET PARITY BIT'
 270
 271         self.putpx(rxtx, ['DATA', rxtx,
 272             (self.databyte[rxtx], self.databits[rxtx])])
 273
 274         b, f = self.databyte[rxtx], self.options['format']
 275         if f == 'ascii':
 276             c = chr(b) if b in range(30, 126 + 1) else '[%02X]' % b
 277             self.putx(rxtx, [rxtx, [c]])
 278         elif f == 'dec':
 279             self.putx(rxtx, [rxtx, [str(b)]])
 280         elif f == 'hex':
 281             self.putx(rxtx, [rxtx, [hex(b)[2:].zfill(2).upper()]])
 282         elif f == 'oct':
 283             self.putx(rxtx, [rxtx, [oct(b)[2:].zfill(3)]])
 284         elif f == 'bin':
 285             self.putx(rxtx, [rxtx, [bin(b)[2:].zfill(8)]])
 286
 287         self.putbin(rxtx, (rxtx, bytes([b])))
 288         self.putbin(rxtx, (2, bytes([b])))
 289
 290         self.databits = [[], []]
 291
 292     def get_parity_bit(self, rxtx, signal):
 293         # If no parity is used/configured, skip to the next state immediately.
 294         if self.options['parity_type'] == 'none':
 295             self.state[rxtx] = 'GET STOP BITS'
 296             return
 297
 298         # Skip samples until we're in the middle of the parity bit.
 299         if not self.reached_bit(rxtx, self.options['num_data_bits'] + 1):
 300             return
 301
 302         self.paritybit[rxtx] = signal
 303
 304         self.state[rxtx] = 'GET STOP BITS'
 305
 306         if parity_ok(self.options['parity_type'], self.paritybit[rxtx],
 307                      self.databyte[rxtx], self.options['num_data_bits']):
 308             self.putp(['PARITYBIT', rxtx, self.paritybit[rxtx]])
 309             self.putg([rxtx + 4, ['Parity bit', 'Parity', 'P']])
 310         else:
 311             # TODO: Return expected/actual parity values.
 312             self.putp(['PARITY ERROR', rxtx, (0, 1)]) # FIXME: Dummy tuple...
 313             self.putg([rxtx + 6, ['Parity error', 'Parity err', 'PE']])
 314
 315     # TODO: Currently only supports 1 stop bit.
 316     def get_stop_bits(self, rxtx, signal):
 317         # Skip samples until we're in the middle of the stop bit(s).
 318         skip_parity = 0 if self.options['parity_type'] == 'none' else 1
 319         b = self.options['num_data_bits'] + 1 + skip_parity
 320         if not self.reached_bit(rxtx, b):
 321             return
 322
 323         self.stopbit1[rxtx] = signal
 324
 325         # Stop bits must be 1. If not, we report an error.
 326         if self.stopbit1[rxtx] != 1:
 327             self.putp(['INVALID STOPBIT', rxtx, self.stopbit1[rxtx]])
 328             self.putg([rxtx + 10, ['Frame error', 'Frame err', 'FE']])
 329             # TODO: Abort? Ignore the frame? Other?
 330
 331         self.state[rxtx] = 'WAIT FOR START BIT'
 332
 333         self.putp(['STOPBIT', rxtx, self.stopbit1[rxtx]])
 334         self.putg([rxtx + 4, ['Stop bit', 'Stop', 'T']])
 335
 336     def decode(self, ss, es, data):
 337         if not self.samplerate:
 338             raise SamplerateError('Cannot decode without samplerate.')
 339         for (self.samplenum, pins) in data:
 340
 341             # Note: Ignoring identical samples here for performance reasons
 342             # is not possible for this PD, at least not in the current state.
 343             # if self.oldpins == pins:
 344             #     continue
 345             self.oldpins, (rx, tx) = pins, pins
 346
 347             if self.options['invert_rx'] == 'yes':
 348                 rx = not rx
 349             if self.options['invert_tx'] == 'yes':
 350                 tx = not tx
 351
 352             # Either RX or TX (but not both) can be omitted.
 353             has_pin = [rx in (0, 1), tx in (0, 1)]
 354             if has_pin == [False, False]:
 355                 raise ChannelError('Either TX or RX (or both) pins required.')
 356
 357             # State machine.
 358             for rxtx in (RX, TX):
 359                 # Don't try to handle RX (or TX) if not supplied.
 360                 if not has_pin[rxtx]:
 361                     continue
 362
 363                 signal = rx if (rxtx == RX) else tx
 364
 365                 if self.state[rxtx] == 'WAIT FOR START BIT':
 366                     self.wait_for_start_bit(rxtx, self.oldbit[rxtx], signal)
 367                 elif self.state[rxtx] == 'GET START BIT':
 368                     self.get_start_bit(rxtx, signal)
 369                 elif self.state[rxtx] == 'GET DATA BITS':
 370                     self.get_data_bits(rxtx, signal)
 371                 elif self.state[rxtx] == 'GET PARITY BIT':
 372                     self.get_parity_bit(rxtx, signal)
 373                 elif self.state[rxtx] == 'GET STOP BITS':
 374                     self.get_stop_bits(rxtx, signal)
 375
 376                 # Save current RX/TX values for the next round.
 377                 self.oldbit[rxtx] = signal