1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
|
##
## This file is part of the libsigrokdecode project.
##
## Copyright (C) 2015 Petteri Aimonen <jpa@sigrok.mail.kapsi.fi>
##
## This program is free software; you can redistribute it and/or modify
## it under the terms of the GNU General Public License as published by
## the Free Software Foundation; either version 2 of the License, or
## (at your option) any later version.
##
## This program is distributed in the hope that it will be useful,
## but WITHOUT ANY WARRANTY; without even the implied warranty of
## MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
## GNU General Public License for more details.
##
## You should have received a copy of the GNU General Public License
## along with this program; if not, write to the Free Software
## Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
##
import sigrokdecode as srd
class Decoder(srd.Decoder):
api_version = 2
id = 'arm_tpiu'
name = 'ARM TPIU'
longname = 'ARM Trace Port Interface Unit'
desc = 'Filter TPIU formatted trace data into separate streams.'
license = 'gplv2+'
inputs = ['uart']
outputs = ['uart'] # Emulate uart output so that arm_itm/arm_etm can stack.
options = (
{'id': 'stream', 'desc': 'Stream index', 'default': 1},
{'id': 'sync_offset', 'desc': 'Initial sync offset', 'default': 0},
)
annotations = (
('stream', 'Current stream'),
('data', 'Stream data'),
)
annotation_rows = (
('stream', 'Current stream', (0,)),
('data', 'Stream data', (1,)),
)
def __init__(self, **kwargs):
self.buf = []
self.syncbuf = []
self.prevsample = 0
self.stream = 0
self.stream_ss = None
self.bytenum = 0
def start(self):
self.out_ann = self.register(srd.OUTPUT_ANN)
self.out_python = self.register(srd.OUTPUT_PYTHON)
def stream_changed(self, ss, stream):
if self.stream != stream:
if self.stream != 0:
self.put(self.stream_ss, ss, self.out_ann,
[0, ["Stream %d" % self.stream, "S%d" % self.stream]])
self.stream = stream
self.stream_ss = ss
def emit_byte(self, ss, es, byte):
if self.stream == self.options['stream']:
self.put(ss, es, self.out_ann, [1, ["0x%02x" % byte]])
self.put(ss, es, self.out_python, ['DATA', 0, (byte, [])])
def process_frame(self, buf):
# Byte 15 contains the lowest bits of bytes 0, 2, ... 14.
lowbits = buf[15][2]
for i in range(0, 15, 2):
# Odd bytes can be stream ID or data.
delayed_stream_change = None
lowbit = (lowbits >> (i // 2)) & 0x01
if buf[i][2] & 0x01 != 0:
if lowbit:
delayed_stream_change = buf[i][2] >> 1
else:
self.stream_changed(buf[i][0], buf[i][2] >> 1)
else:
byte = buf[i][2] | lowbit
self.emit_byte(buf[i][0], buf[i][1], byte)
# Even bytes are always data.
if i < 14:
self.emit_byte(buf[i+1][0], buf[i+1][1], buf[i+1][2])
# The stream change can be delayed to occur after the data byte.
if delayed_stream_change is not None:
self.stream_changed(buf[i+1][1], delayed_stream_change)
def decode(self, ss, es, data):
ptype, rxtx, pdata = data
if ptype != 'DATA':
return
# Reset packet if there is a long pause between bytes.
self.byte_len = es - ss
if ss - self.prevsample > self.byte_len:
self.buf = []
self.prevsample = es
self.buf.append((ss, es, pdata[0]))
self.bytenum += 1
# Allow skipping N first bytes of the data. By adjusting the sync
# value, one can get initial synchronization as soon as the trace
# starts.
if self.bytenum < self.options['sync_offset']:
self.buf = []
return
# Keep separate buffer for detection of sync packets.
# Sync packets override everything else, so that we can regain sync
# even if some packets are corrupted.
self.syncbuf = self.syncbuf[-3:] + [pdata[0]]
if self.syncbuf == [0xFF, 0xFF, 0xFF, 0x7F]:
self.buf = []
self.syncbuf = []
return
if len(self.buf) == 16:
self.process_frame(self.buf)
self.buf = []
|
