1 | // SPDX-License-Identifier: GPL-2.0 |
2 | /* |
3 | * File for any parts of the Coresight decoding that don't require |
4 | * OpenCSD. |
5 | */ |
6 | |
7 | #include <errno.h> |
8 | #include <inttypes.h> |
9 | |
10 | #include "cs-etm.h" |
11 | |
12 | static const char * const [] = { |
13 | [CS_HEADER_VERSION] = " Header version %llx\n" , |
14 | [CS_PMU_TYPE_CPUS] = " PMU type/num cpus %llx\n" , |
15 | [CS_ETM_SNAPSHOT] = " Snapshot %llx\n" , |
16 | }; |
17 | |
18 | static const char * const cs_etm_priv_fmts[] = { |
19 | [CS_ETM_MAGIC] = " Magic number %llx\n" , |
20 | [CS_ETM_CPU] = " CPU %lld\n" , |
21 | [CS_ETM_NR_TRC_PARAMS] = " NR_TRC_PARAMS %llx\n" , |
22 | [CS_ETM_ETMCR] = " ETMCR %llx\n" , |
23 | [CS_ETM_ETMTRACEIDR] = " ETMTRACEIDR %llx\n" , |
24 | [CS_ETM_ETMCCER] = " ETMCCER %llx\n" , |
25 | [CS_ETM_ETMIDR] = " ETMIDR %llx\n" , |
26 | }; |
27 | |
28 | static const char * const cs_etmv4_priv_fmts[] = { |
29 | [CS_ETM_MAGIC] = " Magic number %llx\n" , |
30 | [CS_ETM_CPU] = " CPU %lld\n" , |
31 | [CS_ETM_NR_TRC_PARAMS] = " NR_TRC_PARAMS %llx\n" , |
32 | [CS_ETMV4_TRCCONFIGR] = " TRCCONFIGR %llx\n" , |
33 | [CS_ETMV4_TRCTRACEIDR] = " TRCTRACEIDR %llx\n" , |
34 | [CS_ETMV4_TRCIDR0] = " TRCIDR0 %llx\n" , |
35 | [CS_ETMV4_TRCIDR1] = " TRCIDR1 %llx\n" , |
36 | [CS_ETMV4_TRCIDR2] = " TRCIDR2 %llx\n" , |
37 | [CS_ETMV4_TRCIDR8] = " TRCIDR8 %llx\n" , |
38 | [CS_ETMV4_TRCAUTHSTATUS] = " TRCAUTHSTATUS %llx\n" , |
39 | [CS_ETMV4_TS_SOURCE] = " TS_SOURCE %lld\n" , |
40 | }; |
41 | |
42 | static const char * const cs_ete_priv_fmts[] = { |
43 | [CS_ETM_MAGIC] = " Magic number %llx\n" , |
44 | [CS_ETM_CPU] = " CPU %lld\n" , |
45 | [CS_ETM_NR_TRC_PARAMS] = " NR_TRC_PARAMS %llx\n" , |
46 | [CS_ETE_TRCCONFIGR] = " TRCCONFIGR %llx\n" , |
47 | [CS_ETE_TRCTRACEIDR] = " TRCTRACEIDR %llx\n" , |
48 | [CS_ETE_TRCIDR0] = " TRCIDR0 %llx\n" , |
49 | [CS_ETE_TRCIDR1] = " TRCIDR1 %llx\n" , |
50 | [CS_ETE_TRCIDR2] = " TRCIDR2 %llx\n" , |
51 | [CS_ETE_TRCIDR8] = " TRCIDR8 %llx\n" , |
52 | [CS_ETE_TRCAUTHSTATUS] = " TRCAUTHSTATUS %llx\n" , |
53 | [CS_ETE_TRCDEVARCH] = " TRCDEVARCH %llx\n" , |
54 | [CS_ETE_TS_SOURCE] = " TS_SOURCE %lld\n" , |
55 | }; |
56 | |
57 | static const char * const param_unk_fmt = |
58 | " Unknown parameter [%d] %" PRIx64"\n" ; |
59 | static const char * const magic_unk_fmt = |
60 | " Magic number Unknown %" PRIx64"\n" ; |
61 | |
62 | static int cs_etm__print_cpu_metadata_v0(u64 *val, int *offset) |
63 | { |
64 | int i = *offset, j, nr_params = 0, fmt_offset; |
65 | u64 magic; |
66 | |
67 | /* check magic value */ |
68 | magic = val[i + CS_ETM_MAGIC]; |
69 | if ((magic != __perf_cs_etmv3_magic) && |
70 | (magic != __perf_cs_etmv4_magic)) { |
71 | /* failure - note bad magic value */ |
72 | fprintf(stdout, magic_unk_fmt, magic); |
73 | return -EINVAL; |
74 | } |
75 | |
76 | /* print common header block */ |
77 | fprintf(stdout, cs_etm_priv_fmts[CS_ETM_MAGIC], val[i++]); |
78 | fprintf(stdout, cs_etm_priv_fmts[CS_ETM_CPU], val[i++]); |
79 | |
80 | if (magic == __perf_cs_etmv3_magic) { |
81 | nr_params = CS_ETM_NR_TRC_PARAMS_V0; |
82 | fmt_offset = CS_ETM_ETMCR; |
83 | /* after common block, offset format index past NR_PARAMS */ |
84 | for (j = fmt_offset; j < nr_params + fmt_offset; j++, i++) |
85 | fprintf(stdout, cs_etm_priv_fmts[j], val[i]); |
86 | } else if (magic == __perf_cs_etmv4_magic) { |
87 | nr_params = CS_ETMV4_NR_TRC_PARAMS_V0; |
88 | fmt_offset = CS_ETMV4_TRCCONFIGR; |
89 | /* after common block, offset format index past NR_PARAMS */ |
90 | for (j = fmt_offset; j < nr_params + fmt_offset; j++, i++) |
91 | fprintf(stdout, cs_etmv4_priv_fmts[j], val[i]); |
92 | } |
93 | *offset = i; |
94 | return 0; |
95 | } |
96 | |
97 | static int cs_etm__print_cpu_metadata_v1(u64 *val, int *offset) |
98 | { |
99 | int i = *offset, j, total_params = 0; |
100 | u64 magic; |
101 | |
102 | magic = val[i + CS_ETM_MAGIC]; |
103 | /* total params to print is NR_PARAMS + common block size for v1 */ |
104 | total_params = val[i + CS_ETM_NR_TRC_PARAMS] + CS_ETM_COMMON_BLK_MAX_V1; |
105 | |
106 | if (magic == __perf_cs_etmv3_magic) { |
107 | for (j = 0; j < total_params; j++, i++) { |
108 | /* if newer record - could be excess params */ |
109 | if (j >= CS_ETM_PRIV_MAX) |
110 | fprintf(stdout, param_unk_fmt, j, val[i]); |
111 | else |
112 | fprintf(stdout, cs_etm_priv_fmts[j], val[i]); |
113 | } |
114 | } else if (magic == __perf_cs_etmv4_magic) { |
115 | for (j = 0; j < total_params; j++, i++) { |
116 | /* if newer record - could be excess params */ |
117 | if (j >= CS_ETMV4_PRIV_MAX) |
118 | fprintf(stdout, param_unk_fmt, j, val[i]); |
119 | else |
120 | fprintf(stdout, cs_etmv4_priv_fmts[j], val[i]); |
121 | } |
122 | } else if (magic == __perf_cs_ete_magic) { |
123 | for (j = 0; j < total_params; j++, i++) { |
124 | /* if newer record - could be excess params */ |
125 | if (j >= CS_ETE_PRIV_MAX) |
126 | fprintf(stdout, param_unk_fmt, j, val[i]); |
127 | else |
128 | fprintf(stdout, cs_ete_priv_fmts[j], val[i]); |
129 | } |
130 | } else { |
131 | /* failure - note bad magic value and error out */ |
132 | fprintf(stdout, magic_unk_fmt, magic); |
133 | return -EINVAL; |
134 | } |
135 | *offset = i; |
136 | return 0; |
137 | } |
138 | |
139 | static void cs_etm__print_auxtrace_info(u64 *val, int num) |
140 | { |
141 | int i, cpu = 0, version, err; |
142 | |
143 | version = val[0]; |
144 | |
145 | for (i = 0; i < CS_HEADER_VERSION_MAX; i++) |
146 | fprintf(stdout, cs_etm_global_header_fmts[i], val[i]); |
147 | |
148 | for (i = CS_HEADER_VERSION_MAX; cpu < num; cpu++) { |
149 | if (version == 0) |
150 | err = cs_etm__print_cpu_metadata_v0(val, offset: &i); |
151 | /* printing same for both, but value bit flags added on v2 */ |
152 | else if ((version == 1) || (version == 2)) |
153 | err = cs_etm__print_cpu_metadata_v1(val, offset: &i); |
154 | if (err) |
155 | return; |
156 | } |
157 | } |
158 | |
159 | /* |
160 | * Do some basic checks and print the auxtrace info header before calling |
161 | * into cs_etm__process_auxtrace_info_full() which requires OpenCSD to be |
162 | * linked in. This allows some basic debugging if OpenCSD is missing. |
163 | */ |
164 | int cs_etm__process_auxtrace_info(union perf_event *event, |
165 | struct perf_session *session) |
166 | { |
167 | struct perf_record_auxtrace_info *auxtrace_info = &event->auxtrace_info; |
168 | int = sizeof(struct perf_event_header); |
169 | int num_cpu; |
170 | u64 *ptr = NULL; |
171 | u64 hdr_version; |
172 | |
173 | if (auxtrace_info->header.size < (event_header_size + INFO_HEADER_SIZE)) |
174 | return -EINVAL; |
175 | |
176 | /* First the global part */ |
177 | ptr = (u64 *) auxtrace_info->priv; |
178 | |
179 | /* Look for version of the header */ |
180 | hdr_version = ptr[0]; |
181 | if (hdr_version > CS_HEADER_CURRENT_VERSION) { |
182 | pr_err("\nCS ETM Trace: Unknown Header Version = %#" PRIx64, hdr_version); |
183 | pr_err(", version supported <= %x\n" , CS_HEADER_CURRENT_VERSION); |
184 | return -EINVAL; |
185 | } |
186 | |
187 | if (dump_trace) { |
188 | num_cpu = ptr[CS_PMU_TYPE_CPUS] & 0xffffffff; |
189 | cs_etm__print_auxtrace_info(val: ptr, num: num_cpu); |
190 | } |
191 | |
192 | return cs_etm__process_auxtrace_info_full(event, session); |
193 | } |
194 | |