]>
Commit | Line | Data |
---|---|---|
1 | ## | |
2 | ## This file is part of the libsigrokdecode project. | |
3 | ## | |
4 | ## Copyright (C) 2016 Robert Bosch Car Multimedia GmbH | |
5 | ## Authors: Oleksij Rempel | |
6 | ## <fixed-term.Oleksij.Rempel@de.bosch.com> | |
7 | ## <linux@rempel-privat.de> | |
8 | ## | |
9 | ## This program is free software; you can redistribute it and/or modify | |
10 | ## it under the terms of the GNU General Public License as published by | |
11 | ## the Free Software Foundation; either version 2 of the License, or | |
12 | ## (at your option) any later version. | |
13 | ## | |
14 | ## This program is distributed in the hope that it will be useful, | |
15 | ## but WITHOUT ANY WARRANTY; without even the implied warranty of | |
16 | ## MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
17 | ## GNU General Public License for more details. | |
18 | ## | |
19 | ## You should have received a copy of the GNU General Public License | |
20 | ## along with this program; if not, see <http://www.gnu.org/licenses/>. | |
21 | ## | |
22 | ||
23 | import sigrokdecode as srd | |
24 | ||
25 | class Decoder(srd.Decoder): | |
26 | api_version = 3 | |
27 | id = 'ssi32' | |
28 | name = 'SSI32' | |
29 | longname = 'Synchronous Serial Interface (32bit)' | |
30 | desc = 'Synchronous Serial Interface (32bit) protocol.' | |
31 | license = 'gplv2+' | |
32 | inputs = ['spi'] | |
33 | outputs = ['ssi32'] | |
34 | options = ( | |
35 | {'id': 'msgsize', 'desc': 'Message size', 'default': 64}, | |
36 | ) | |
37 | annotations = ( | |
38 | ('ctrl-tx', 'CTRL TX'), | |
39 | ('ack-tx', 'ACK TX'), | |
40 | ('ctrl-rx', 'CTRL RX'), | |
41 | ('ack-rx', 'ACK RX'), | |
42 | ) | |
43 | annotation_rows = ( | |
44 | ('tx', 'TX', (0, 1)), | |
45 | ('rx', 'RX', (2, 3)), | |
46 | ) | |
47 | ||
48 | def __init__(self): | |
49 | self.ss_cmd, self.es_cmd = 0, 0 | |
50 | self.mosi_bytes = [] | |
51 | self.miso_bytes = [] | |
52 | self.es_array = [] | |
53 | self.rx_size = 0 | |
54 | self.tx_size = 0 | |
55 | ||
56 | def start(self): | |
57 | self.out_ann = self.register(srd.OUTPUT_ANN) | |
58 | ||
59 | def putx(self, data): | |
60 | self.put(self.ss_cmd, self.es_cmd, self.out_ann, data) | |
61 | ||
62 | def reset(self): | |
63 | self.mosi_bytes = [] | |
64 | self.miso_bytes = [] | |
65 | self.es_array = [] | |
66 | ||
67 | def handle_ack(self): | |
68 | # Only first byte should have ACK data, other 3 bytes are reserved. | |
69 | self.es_cmd = self.es_array[0] | |
70 | self.putx([1, ['> ACK:0x%02x' % (self.mosi_bytes[0])]]) | |
71 | self.putx([3, ['< ACK:0x%02x' % (self.miso_bytes[0])]]) | |
72 | ||
73 | def handle_ctrl(self): | |
74 | mosi = miso = '' | |
75 | self.tx_size = self.mosi_bytes[2] | |
76 | self.rx_size = self.miso_bytes[2] | |
77 | ||
78 | if self.tx_size > 0: | |
79 | mosi = ', DATA:0x' + ''.join(format(x, '02x') for x in self.mosi_bytes[4:self.tx_size + 4]) | |
80 | if self.rx_size > 0: | |
81 | miso = ', DATA:0x' + ''.join(format(x, '02x') for x in self.miso_bytes[4:self.rx_size + 4]) | |
82 | ||
83 | self.es_cmd = self.es_array[self.tx_size + 3] | |
84 | self.putx([0, ['> CTRL:0x%02x, LUN:0x%02x, SIZE:0x%02x, CRC:0x%02x%s' | |
85 | % (self.mosi_bytes[0], self.mosi_bytes[1], | |
86 | self.mosi_bytes[2], self.mosi_bytes[3], mosi)]]) | |
87 | ||
88 | self.es_cmd = self.es_array[self.rx_size + 3] | |
89 | self.putx([2, ['< CTRL:0x%02x, LUN:0x%02x, SIZE:0x%02x, CRC:0x%02x%s' | |
90 | % (self.miso_bytes[0], self.miso_bytes[1], | |
91 | self.miso_bytes[2], self.miso_bytes[3], miso)]]) | |
92 | ||
93 | def decode(self, ss, es, data): | |
94 | ptype = data[0] | |
95 | if ptype == 'CS-CHANGE': | |
96 | self.reset() | |
97 | return | |
98 | ||
99 | # Don't care about anything else. | |
100 | if ptype != 'DATA': | |
101 | return | |
102 | mosi, miso = data[1:] | |
103 | ||
104 | self.ss, self.es = ss, es | |
105 | ||
106 | if len(self.mosi_bytes) == 0: | |
107 | self.ss_cmd = ss | |
108 | self.mosi_bytes.append(mosi) | |
109 | self.miso_bytes.append(miso) | |
110 | self.es_array.append(es) | |
111 | ||
112 | if self.mosi_bytes[0] & 0x80: | |
113 | if len(self.mosi_bytes) < 4: | |
114 | return | |
115 | ||
116 | self.handle_ack() | |
117 | self.reset() | |
118 | else: | |
119 | if len(self.mosi_bytes) < self.options['msgsize']: | |
120 | return | |
121 | ||
122 | self.handle_ctrl() | |
123 | self.reset() |