]>
Commit | Line | Data |
---|---|---|
1 | ## | |
2 | ## This file is part of the libsigrokdecode project. | |
3 | ## | |
4 | ## Copyright (C) 2011 Gareth McMullin <gareth@blacksphere.co.nz> | |
5 | ## Copyright (C) 2012-2014 Uwe Hermann <uwe@hermann-uwe.de> | |
6 | ## | |
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. | |
11 | ## | |
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. | |
16 | ## | |
17 | ## You should have received a copy of the GNU General Public License | |
18 | ## along with this program; if not, see <http://www.gnu.org/licenses/>. | |
19 | ## | |
20 | ||
21 | import sigrokdecode as srd | |
22 | from collections import namedtuple | |
23 | ||
24 | Data = namedtuple('Data', ['ss', 'es', 'val']) | |
25 | ||
26 | ''' | |
27 | OUTPUT_PYTHON format: | |
28 | ||
29 | Packet: | |
30 | [<ptype>, <data1>, <data2>] | |
31 | ||
32 | <ptype>: | |
33 | - 'DATA': <data1> contains the MOSI data, <data2> contains the MISO data. | |
34 | The data is _usually_ 8 bits (but can also be fewer or more bits). | |
35 | Both data items are Python numbers (not strings), or None if the respective | |
36 | channel was not supplied. | |
37 | - 'BITS': <data1>/<data2> contain a list of bit values in this MOSI/MISO data | |
38 | item, and for each of those also their respective start-/endsample numbers. | |
39 | - 'CS-CHANGE': <data1> is the old CS# pin value, <data2> is the new value. | |
40 | Both data items are Python numbers (0/1), not strings. At the beginning of | |
41 | the decoding a packet is generated with <data1> = None and <data2> being the | |
42 | initial state of the CS# pin or None if the chip select pin is not supplied. | |
43 | - 'TRANSFER': <data1>/<data2> contain a list of Data() namedtuples for each | |
44 | byte transferred during this block of CS# asserted time. Each Data() has | |
45 | fields ss, es, and val. | |
46 | ||
47 | Examples: | |
48 | ['CS-CHANGE', None, 1] | |
49 | ['CS-CHANGE', 1, 0] | |
50 | ['DATA', 0xff, 0x3a] | |
51 | ['BITS', [[1, 80, 82], [1, 83, 84], [1, 85, 86], [1, 87, 88], | |
52 | [1, 89, 90], [1, 91, 92], [1, 93, 94], [1, 95, 96]], | |
53 | [[0, 80, 82], [1, 83, 84], [0, 85, 86], [1, 87, 88], | |
54 | [1, 89, 90], [1, 91, 92], [0, 93, 94], [0, 95, 96]]] | |
55 | ['DATA', 0x65, 0x00] | |
56 | ['DATA', 0xa8, None] | |
57 | ['DATA', None, 0x55] | |
58 | ['CS-CHANGE', 0, 1] | |
59 | ['TRANSFER', [Data(ss=80, es=96, val=0xff), ...], | |
60 | [Data(ss=80, es=96, val=0x3a), ...]] | |
61 | ''' | |
62 | ||
63 | # Key: (CPOL, CPHA). Value: SPI mode. | |
64 | # Clock polarity (CPOL) = 0/1: Clock is low/high when inactive. | |
65 | # Clock phase (CPHA) = 0/1: Data is valid on the leading/trailing clock edge. | |
66 | spi_mode = { | |
67 | (0, 0): 0, # Mode 0 | |
68 | (0, 1): 1, # Mode 1 | |
69 | (1, 0): 2, # Mode 2 | |
70 | (1, 1): 3, # Mode 3 | |
71 | } | |
72 | ||
73 | class SamplerateError(Exception): | |
74 | pass | |
75 | ||
76 | class ChannelError(Exception): | |
77 | pass | |
78 | ||
79 | class Decoder(srd.Decoder): | |
80 | api_version = 2 | |
81 | id = 'spi' | |
82 | name = 'SPI' | |
83 | longname = 'Serial Peripheral Interface' | |
84 | desc = 'Full-duplex, synchronous, serial bus.' | |
85 | license = 'gplv2+' | |
86 | inputs = ['logic'] | |
87 | outputs = ['spi'] | |
88 | channels = ( | |
89 | {'id': 'clk', 'name': 'CLK', 'desc': 'Clock'}, | |
90 | ) | |
91 | optional_channels = ( | |
92 | {'id': 'miso', 'name': 'MISO', 'desc': 'Master in, slave out'}, | |
93 | {'id': 'mosi', 'name': 'MOSI', 'desc': 'Master out, slave in'}, | |
94 | {'id': 'cs', 'name': 'CS#', 'desc': 'Chip-select'}, | |
95 | ) | |
96 | options = ( | |
97 | {'id': 'cs_polarity', 'desc': 'CS# polarity', 'default': 'active-low', | |
98 | 'values': ('active-low', 'active-high')}, | |
99 | {'id': 'cpol', 'desc': 'Clock polarity', 'default': 0, | |
100 | 'values': (0, 1)}, | |
101 | {'id': 'cpha', 'desc': 'Clock phase', 'default': 0, | |
102 | 'values': (0, 1)}, | |
103 | {'id': 'bitorder', 'desc': 'Bit order', | |
104 | 'default': 'msb-first', 'values': ('msb-first', 'lsb-first')}, | |
105 | {'id': 'wordsize', 'desc': 'Word size', 'default': 8}, | |
106 | ) | |
107 | annotations = ( | |
108 | ('miso-data', 'MISO data'), | |
109 | ('mosi-data', 'MOSI data'), | |
110 | ('miso-bits', 'MISO bits'), | |
111 | ('mosi-bits', 'MOSI bits'), | |
112 | ('warnings', 'Human-readable warnings'), | |
113 | ) | |
114 | annotation_rows = ( | |
115 | ('miso-data', 'MISO data', (0,)), | |
116 | ('miso-bits', 'MISO bits', (2,)), | |
117 | ('mosi-data', 'MOSI data', (1,)), | |
118 | ('mosi-bits', 'MOSI bits', (3,)), | |
119 | ('other', 'Other', (4,)), | |
120 | ) | |
121 | binary = ( | |
122 | ('miso', 'MISO'), | |
123 | ('mosi', 'MOSI'), | |
124 | ) | |
125 | ||
126 | def __init__(self): | |
127 | self.samplerate = None | |
128 | self.oldclk = 1 | |
129 | self.bitcount = 0 | |
130 | self.misodata = self.mosidata = 0 | |
131 | self.misobits = [] | |
132 | self.mosibits = [] | |
133 | self.misobytes = [] | |
134 | self.mosibytes = [] | |
135 | self.ss_block = -1 | |
136 | self.samplenum = -1 | |
137 | self.ss_transfer = -1 | |
138 | self.cs_was_deasserted = False | |
139 | self.oldcs = None | |
140 | self.oldpins = None | |
141 | self.have_cs = self.have_miso = self.have_mosi = None | |
142 | self.no_cs_notification = False | |
143 | ||
144 | def metadata(self, key, value): | |
145 | if key == srd.SRD_CONF_SAMPLERATE: | |
146 | self.samplerate = value | |
147 | ||
148 | def start(self): | |
149 | self.out_python = self.register(srd.OUTPUT_PYTHON) | |
150 | self.out_ann = self.register(srd.OUTPUT_ANN) | |
151 | self.out_binary = self.register(srd.OUTPUT_BINARY) | |
152 | self.out_bitrate = self.register(srd.OUTPUT_META, | |
153 | meta=(int, 'Bitrate', 'Bitrate during transfers')) | |
154 | self.bw = (self.options['wordsize'] + 7) // 8 | |
155 | ||
156 | def putw(self, data): | |
157 | self.put(self.ss_block, self.samplenum, self.out_ann, data) | |
158 | ||
159 | def putdata(self): | |
160 | # Pass MISO and MOSI bits and then data to the next PD up the stack. | |
161 | so = self.misodata if self.have_miso else None | |
162 | si = self.mosidata if self.have_mosi else None | |
163 | so_bits = self.misobits if self.have_miso else None | |
164 | si_bits = self.mosibits if self.have_mosi else None | |
165 | ||
166 | if self.have_miso: | |
167 | ss, es = self.misobits[-1][1], self.misobits[0][2] | |
168 | bdata = so.to_bytes(self.bw, byteorder='big') | |
169 | self.put(ss, es, self.out_binary, [0, bdata]) | |
170 | if self.have_mosi: | |
171 | ss, es = self.mosibits[-1][1], self.mosibits[0][2] | |
172 | bdata = si.to_bytes(self.bw, byteorder='big') | |
173 | self.put(ss, es, self.out_binary, [1, bdata]) | |
174 | ||
175 | self.put(ss, es, self.out_python, ['BITS', si_bits, so_bits]) | |
176 | self.put(ss, es, self.out_python, ['DATA', si, so]) | |
177 | ||
178 | if self.have_miso: | |
179 | self.misobytes.append(Data(ss=ss, es=es, val=so)) | |
180 | if self.have_mosi: | |
181 | self.mosibytes.append(Data(ss=ss, es=es, val=si)) | |
182 | ||
183 | # Bit annotations. | |
184 | if self.have_miso: | |
185 | for bit in self.misobits: | |
186 | self.put(bit[1], bit[2], self.out_ann, [2, ['%d' % bit[0]]]) | |
187 | if self.have_mosi: | |
188 | for bit in self.mosibits: | |
189 | self.put(bit[1], bit[2], self.out_ann, [3, ['%d' % bit[0]]]) | |
190 | ||
191 | # Dataword annotations. | |
192 | if self.have_miso: | |
193 | self.put(ss, es, self.out_ann, [0, ['%02X' % self.misodata]]) | |
194 | if self.have_mosi: | |
195 | self.put(ss, es, self.out_ann, [1, ['%02X' % self.mosidata]]) | |
196 | ||
197 | def reset_decoder_state(self): | |
198 | self.misodata = 0 if self.have_miso else None | |
199 | self.mosidata = 0 if self.have_mosi else None | |
200 | self.misobits = [] if self.have_miso else None | |
201 | self.mosibits = [] if self.have_mosi else None | |
202 | self.bitcount = 0 | |
203 | ||
204 | def cs_asserted(self, cs): | |
205 | active_low = (self.options['cs_polarity'] == 'active-low') | |
206 | return (cs == 0) if active_low else (cs == 1) | |
207 | ||
208 | def handle_bit(self, miso, mosi, clk, cs): | |
209 | # If this is the first bit of a dataword, save its sample number. | |
210 | if self.bitcount == 0: | |
211 | self.ss_block = self.samplenum | |
212 | self.cs_was_deasserted = \ | |
213 | not self.cs_asserted(cs) if self.have_cs else False | |
214 | ||
215 | ws = self.options['wordsize'] | |
216 | ||
217 | # Receive MISO bit into our shift register. | |
218 | if self.have_miso: | |
219 | if self.options['bitorder'] == 'msb-first': | |
220 | self.misodata |= miso << (ws - 1 - self.bitcount) | |
221 | else: | |
222 | self.misodata |= miso << self.bitcount | |
223 | ||
224 | # Receive MOSI bit into our shift register. | |
225 | if self.have_mosi: | |
226 | if self.options['bitorder'] == 'msb-first': | |
227 | self.mosidata |= mosi << (ws - 1 - self.bitcount) | |
228 | else: | |
229 | self.mosidata |= mosi << self.bitcount | |
230 | ||
231 | # Guesstimate the endsample for this bit (can be overridden below). | |
232 | es = self.samplenum | |
233 | if self.bitcount > 0: | |
234 | if self.have_miso: | |
235 | es += self.samplenum - self.misobits[0][1] | |
236 | elif self.have_mosi: | |
237 | es += self.samplenum - self.mosibits[0][1] | |
238 | ||
239 | if self.have_miso: | |
240 | self.misobits.insert(0, [miso, self.samplenum, es]) | |
241 | if self.have_mosi: | |
242 | self.mosibits.insert(0, [mosi, self.samplenum, es]) | |
243 | ||
244 | if self.bitcount > 0 and self.have_miso: | |
245 | self.misobits[1][2] = self.samplenum | |
246 | if self.bitcount > 0 and self.have_mosi: | |
247 | self.mosibits[1][2] = self.samplenum | |
248 | ||
249 | self.bitcount += 1 | |
250 | ||
251 | # Continue to receive if not enough bits were received, yet. | |
252 | if self.bitcount != ws: | |
253 | return | |
254 | ||
255 | self.putdata() | |
256 | ||
257 | # Meta bitrate. | |
258 | elapsed = 1 / float(self.samplerate) | |
259 | elapsed *= (self.samplenum - self.ss_block + 1) | |
260 | bitrate = int(1 / elapsed * self.options['wordsize']) | |
261 | self.put(self.ss_block, self.samplenum, self.out_bitrate, bitrate) | |
262 | ||
263 | if self.have_cs and self.cs_was_deasserted: | |
264 | self.putw([4, ['CS# was deasserted during this data word!']]) | |
265 | ||
266 | self.reset_decoder_state() | |
267 | ||
268 | def find_clk_edge(self, miso, mosi, clk, cs): | |
269 | if self.have_cs and self.oldcs != cs: | |
270 | # Send all CS# pin value changes. | |
271 | self.put(self.samplenum, self.samplenum, self.out_python, | |
272 | ['CS-CHANGE', self.oldcs, cs]) | |
273 | self.oldcs = cs | |
274 | ||
275 | if self.cs_asserted(cs): | |
276 | self.ss_transfer = self.samplenum | |
277 | self.misobytes = [] | |
278 | self.mosibytes = [] | |
279 | else: | |
280 | self.put(self.ss_transfer, self.samplenum, self.out_python, | |
281 | ['TRANSFER', self.mosibytes, self.misobytes]) | |
282 | ||
283 | # Reset decoder state when CS# changes (and the CS# pin is used). | |
284 | self.reset_decoder_state() | |
285 | ||
286 | # We only care about samples if CS# is asserted. | |
287 | if self.have_cs and not self.cs_asserted(cs): | |
288 | return | |
289 | ||
290 | # Ignore sample if the clock pin hasn't changed. | |
291 | if clk == self.oldclk: | |
292 | return | |
293 | ||
294 | self.oldclk = clk | |
295 | ||
296 | # Sample data on rising/falling clock edge (depends on mode). | |
297 | mode = spi_mode[self.options['cpol'], self.options['cpha']] | |
298 | if mode == 0 and clk == 0: # Sample on rising clock edge | |
299 | return | |
300 | elif mode == 1 and clk == 1: # Sample on falling clock edge | |
301 | return | |
302 | elif mode == 2 and clk == 1: # Sample on falling clock edge | |
303 | return | |
304 | elif mode == 3 and clk == 0: # Sample on rising clock edge | |
305 | return | |
306 | ||
307 | # Found the correct clock edge, now get the SPI bit(s). | |
308 | self.handle_bit(miso, mosi, clk, cs) | |
309 | ||
310 | def decode(self, ss, es, data): | |
311 | if not self.samplerate: | |
312 | raise SamplerateError('Cannot decode without samplerate.') | |
313 | # Either MISO or MOSI can be omitted (but not both). CS# is optional. | |
314 | for (self.samplenum, pins) in data: | |
315 | ||
316 | # Ignore identical samples early on (for performance reasons). | |
317 | if self.oldpins == pins: | |
318 | continue | |
319 | self.oldpins, (clk, miso, mosi, cs) = pins, pins | |
320 | self.have_miso = (miso in (0, 1)) | |
321 | self.have_mosi = (mosi in (0, 1)) | |
322 | self.have_cs = (cs in (0, 1)) | |
323 | ||
324 | # Either MISO or MOSI (but not both) can be omitted. | |
325 | if not (self.have_miso or self.have_mosi): | |
326 | raise ChannelError('Either MISO or MOSI (or both) pins required.') | |
327 | ||
328 | # Tell stacked decoders that we don't have a CS# signal. | |
329 | if not self.no_cs_notification and not self.have_cs: | |
330 | self.put(0, 0, self.out_python, ['CS-CHANGE', None, None]) | |
331 | self.no_cs_notification = True | |
332 | ||
333 | self.find_clk_edge(miso, mosi, clk, cs) |