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 cs_etm_global_header_fmts[] = {
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
cs_etm__print_cpu_metadata_v0(u64 * val,int * offset)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
cs_etm__print_cpu_metadata_v1(u64 * val,int * offset)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
cs_etm__print_auxtrace_info(u64 * val,int num)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, &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, &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 */
cs_etm__process_auxtrace_info(union perf_event * event,struct perf_session * session)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 event_header_size = 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(ptr, num_cpu);
190 }
191
192 return cs_etm__process_auxtrace_info_full(event, session);
193 }
194