cs-etm.c 21.4 KB
Newer Older
1
// SPDX-License-Identifier: GPL-2.0
2 3 4 5 6 7
/*
 * Copyright(C) 2015 Linaro Limited. All rights reserved.
 * Author: Mathieu Poirier <mathieu.poirier@linaro.org>
 */

#include <api/fs/fs.h>
8
#include <linux/bits.h>
9
#include <linux/bitops.h>
10
#include <linux/compiler.h>
11 12 13
#include <linux/coresight-pmu.h>
#include <linux/kernel.h>
#include <linux/log2.h>
14
#include <linux/string.h>
15
#include <linux/types.h>
16
#include <linux/zalloc.h>
17 18

#include "cs-etm.h"
19
#include "../../util/debug.h"
20
#include "../../util/record.h"
21 22
#include "../../util/auxtrace.h"
#include "../../util/cpumap.h"
23
#include "../../util/event.h"
24
#include "../../util/evlist.h"
25
#include "../../util/evsel.h"
26
#include "../../util/perf_api_probe.h"
27
#include "../../util/evsel_config.h"
28 29
#include "../../util/pmu.h"
#include "../../util/cs-etm.h"
30
#include <internal/lib.h> // page_size
31
#include "../../util/session.h"
32

33
#include <errno.h>
34
#include <stdlib.h>
35
#include <sys/stat.h>
36 37 38 39

struct cs_etm_recording {
	struct auxtrace_record	itr;
	struct perf_pmu		*cs_etm_pmu;
40
	struct evlist		*evlist;
41 42 43 44
	bool			snapshot_mode;
	size_t			snapshot_size;
};

45 46 47 48 49 50 51 52 53 54 55 56 57
static const char *metadata_etmv3_ro[CS_ETM_PRIV_MAX] = {
	[CS_ETM_ETMCCER]	= "mgmt/etmccer",
	[CS_ETM_ETMIDR]		= "mgmt/etmidr",
};

static const char *metadata_etmv4_ro[CS_ETMV4_PRIV_MAX] = {
	[CS_ETMV4_TRCIDR0]		= "trcidr/trcidr0",
	[CS_ETMV4_TRCIDR1]		= "trcidr/trcidr1",
	[CS_ETMV4_TRCIDR2]		= "trcidr/trcidr2",
	[CS_ETMV4_TRCIDR8]		= "trcidr/trcidr8",
	[CS_ETMV4_TRCAUTHSTATUS]	= "mgmt/trcauthstatus",
};

58 59
static bool cs_etm_is_etmv4(struct auxtrace_record *itr, int cpu);

60
static int cs_etm_set_context_id(struct auxtrace_record *itr,
61
				 struct evsel *evsel, int cpu)
62 63 64 65 66 67
{
	struct cs_etm_recording *ptr;
	struct perf_pmu *cs_etm_pmu;
	char path[PATH_MAX];
	int err = -EINVAL;
	u32 val;
68
	u64 contextid;
69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87

	ptr = container_of(itr, struct cs_etm_recording, itr);
	cs_etm_pmu = ptr->cs_etm_pmu;

	if (!cs_etm_is_etmv4(itr, cpu))
		goto out;

	/* Get a handle on TRCIRD2 */
	snprintf(path, PATH_MAX, "cpu%d/%s",
		 cpu, metadata_etmv4_ro[CS_ETMV4_TRCIDR2]);
	err = perf_pmu__scan_file(cs_etm_pmu, path, "%x", &val);

	/* There was a problem reading the file, bailing out */
	if (err != 1) {
		pr_err("%s: can't read file %s\n",
		       CORESIGHT_ETM_PMU_NAME, path);
		goto out;
	}

88 89 90 91
	/* User has configured for PID tracing, respects it. */
	contextid = evsel->core.attr.config &
			(BIT(ETM_OPT_CTXTID) | BIT(ETM_OPT_CTXTID2));

92
	/*
93 94 95 96 97
	 * If user doesn't configure the contextid format, parse PMU format and
	 * enable PID tracing according to the "contextid" format bits:
	 *
	 *   If bit ETM_OPT_CTXTID is set, trace CONTEXTIDR_EL1;
	 *   If bit ETM_OPT_CTXTID2 is set, trace CONTEXTIDR_EL2.
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 129 130 131 132 133
	if (!contextid)
		contextid = perf_pmu__format_bits(&cs_etm_pmu->format,
						  "contextid");

	if (contextid & BIT(ETM_OPT_CTXTID)) {
		/*
		 * TRCIDR2.CIDSIZE, bit [9-5], indicates whether contextID
		 * tracing is supported:
		 *  0b00000 Context ID tracing is not supported.
		 *  0b00100 Maximum of 32-bit Context ID size.
		 *  All other values are reserved.
		 */
		val = BMVAL(val, 5, 9);
		if (!val || val != 0x4) {
			pr_err("%s: CONTEXTIDR_EL1 isn't supported\n",
			       CORESIGHT_ETM_PMU_NAME);
			err = -EINVAL;
			goto out;
		}
	}

	if (contextid & BIT(ETM_OPT_CTXTID2)) {
		/*
		 * TRCIDR2.VMIDOPT[30:29] != 0 and
		 * TRCIDR2.VMIDSIZE[14:10] == 0b00100 (32bit virtual contextid)
		 * We can't support CONTEXTIDR in VMID if the size of the
		 * virtual context id is < 32bit.
		 * Any value of VMIDSIZE >= 4 (i.e, > 32bit) is fine for us.
		 */
		if (!BMVAL(val, 29, 30) || BMVAL(val, 10, 14) < 4) {
			pr_err("%s: CONTEXTIDR_EL2 isn't supported\n",
			       CORESIGHT_ETM_PMU_NAME);
			err = -EINVAL;
			goto out;
		}
134 135 136
	}

	/* All good, let the kernel know */
137
	evsel->core.attr.config |= contextid;
138 139 140 141 142 143
	err = 0;

out:
	return err;
}

144
static int cs_etm_set_timestamp(struct auxtrace_record *itr,
145
				struct evsel *evsel, int cpu)
146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184
{
	struct cs_etm_recording *ptr;
	struct perf_pmu *cs_etm_pmu;
	char path[PATH_MAX];
	int err = -EINVAL;
	u32 val;

	ptr = container_of(itr, struct cs_etm_recording, itr);
	cs_etm_pmu = ptr->cs_etm_pmu;

	if (!cs_etm_is_etmv4(itr, cpu))
		goto out;

	/* Get a handle on TRCIRD0 */
	snprintf(path, PATH_MAX, "cpu%d/%s",
		 cpu, metadata_etmv4_ro[CS_ETMV4_TRCIDR0]);
	err = perf_pmu__scan_file(cs_etm_pmu, path, "%x", &val);

	/* There was a problem reading the file, bailing out */
	if (err != 1) {
		pr_err("%s: can't read file %s\n",
		       CORESIGHT_ETM_PMU_NAME, path);
		goto out;
	}

	/*
	 * TRCIDR0.TSSIZE, bit [28-24], indicates whether global timestamping
	 * is supported:
	 *  0b00000 Global timestamping is not implemented
	 *  0b00110 Implementation supports a maximum timestamp of 48bits.
	 *  0b01000 Implementation supports a maximum timestamp of 64bits.
	 */
	val &= GENMASK(28, 24);
	if (!val) {
		err = -EINVAL;
		goto out;
	}

	/* All good, let the kernel know */
185
	evsel->core.attr.config |= (1 << ETM_OPT_TS);
186 187 188 189 190 191
	err = 0;

out:
	return err;
}

192 193 194 195
#define ETM_SET_OPT_CTXTID	(1 << 0)
#define ETM_SET_OPT_TS		(1 << 1)
#define ETM_SET_OPT_MASK	(ETM_SET_OPT_CTXTID | ETM_SET_OPT_TS)

196
static int cs_etm_set_option(struct auxtrace_record *itr,
197
			     struct evsel *evsel, u32 option)
198 199
{
	int i, err = -EINVAL;
200
	struct perf_cpu_map *event_cpus = evsel->evlist->core.cpus;
201
	struct perf_cpu_map *online_cpus = perf_cpu_map__new(NULL);
202 203 204 205 206 207 208

	/* Set option of each CPU we have */
	for (i = 0; i < cpu__max_cpu(); i++) {
		if (!cpu_map__has(event_cpus, i) ||
		    !cpu_map__has(online_cpus, i))
			continue;

209
		if (option & BIT(ETM_OPT_CTXTID)) {
210 211 212
			err = cs_etm_set_context_id(itr, evsel, i);
			if (err)
				goto out;
213
		}
214
		if (option & BIT(ETM_OPT_TS)) {
215 216 217
			err = cs_etm_set_timestamp(itr, evsel, i);
			if (err)
				goto out;
218
		}
219
		if (option & ~(BIT(ETM_OPT_CTXTID) | BIT(ETM_OPT_TS)))
220 221
			/* Nothing else is currently supported */
			goto out;
222 223 224 225
	}

	err = 0;
out:
226
	perf_cpu_map__put(online_cpus);
227 228 229
	return err;
}

230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251
static int cs_etm_parse_snapshot_options(struct auxtrace_record *itr,
					 struct record_opts *opts,
					 const char *str)
{
	struct cs_etm_recording *ptr =
				container_of(itr, struct cs_etm_recording, itr);
	unsigned long long snapshot_size = 0;
	char *endptr;

	if (str) {
		snapshot_size = strtoull(str, &endptr, 0);
		if (*endptr || snapshot_size > SIZE_MAX)
			return -1;
	}

	opts->auxtrace_snapshot_mode = true;
	opts->auxtrace_snapshot_size = snapshot_size;
	ptr->snapshot_size = snapshot_size;

	return 0;
}

252
static int cs_etm_set_sink_attr(struct perf_pmu *pmu,
253
				struct evsel *evsel)
254 255
{
	char msg[BUFSIZ], path[PATH_MAX], *sink;
256
	struct evsel_config_term *term;
257 258 259
	int ret = -EINVAL;
	u32 hash;

260
	if (evsel->core.attr.config2 & GENMASK(31, 0))
261 262 263
		return 0;

	list_for_each_entry(term, &evsel->config_terms, list) {
264
		if (term->type != EVSEL__CONFIG_TERM_DRV_CFG)
265 266
			continue;

267
		sink = term->val.str;
268 269 270 271 272
		snprintf(path, PATH_MAX, "sinks/%s", sink);

		ret = perf_pmu__scan_file(pmu, path, "%x", &hash);
		if (ret != 1) {
			pr_err("failed to set sink \"%s\" on event %s with %d (%s)\n",
273
			       sink, evsel__name(evsel), errno,
274 275 276 277
			       str_error_r(errno, msg, sizeof(msg)));
			return ret;
		}

278
		evsel->core.attr.config2 |= hash;
279 280 281 282
		return 0;
	}

	/*
283 284
	 * No sink was provided on the command line - allow the CoreSight
	 * system to look for a default
285
	 */
286
	return 0;
287 288
}

289
static int cs_etm_recording_options(struct auxtrace_record *itr,
290
				    struct evlist *evlist,
291 292
				    struct record_opts *opts)
{
293
	int ret;
294 295 296
	struct cs_etm_recording *ptr =
				container_of(itr, struct cs_etm_recording, itr);
	struct perf_pmu *cs_etm_pmu = ptr->cs_etm_pmu;
297
	struct evsel *evsel, *cs_etm_evsel = NULL;
298
	struct perf_cpu_map *cpus = evlist->core.cpus;
299
	bool privileged = perf_event_paranoid_check(-1);
300
	int err = 0;
301 302 303

	ptr->evlist = evlist;
	ptr->snapshot_mode = opts->auxtrace_snapshot_mode;
304

305 306
	if (!record_opts__no_switch_events(opts) &&
	    perf_can_record_switch_events())
307
		opts->record_switch_events = true;
308 309

	evlist__for_each_entry(evlist, evsel) {
310
		if (evsel->core.attr.type == cs_etm_pmu->type) {
311 312 313 314 315
			if (cs_etm_evsel) {
				pr_err("There may be only one %s event\n",
				       CORESIGHT_ETM_PMU_NAME);
				return -EINVAL;
			}
316 317
			evsel->core.attr.freq = 0;
			evsel->core.attr.sample_period = 1;
318 319 320 321 322 323 324 325 326
			cs_etm_evsel = evsel;
			opts->full_auxtrace = true;
		}
	}

	/* no need to continue if at least one event of interest was found */
	if (!cs_etm_evsel)
		return 0;

327 328 329 330
	ret = cs_etm_set_sink_attr(cs_etm_pmu, cs_etm_evsel);
	if (ret)
		return ret;

331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378
	if (opts->use_clockid) {
		pr_err("Cannot use clockid (-k option) with %s\n",
		       CORESIGHT_ETM_PMU_NAME);
		return -EINVAL;
	}

	/* we are in snapshot mode */
	if (opts->auxtrace_snapshot_mode) {
		/*
		 * No size were given to '-S' or '-m,', so go with
		 * the default
		 */
		if (!opts->auxtrace_snapshot_size &&
		    !opts->auxtrace_mmap_pages) {
			if (privileged) {
				opts->auxtrace_mmap_pages = MiB(4) / page_size;
			} else {
				opts->auxtrace_mmap_pages =
							KiB(128) / page_size;
				if (opts->mmap_pages == UINT_MAX)
					opts->mmap_pages = KiB(256) / page_size;
			}
		} else if (!opts->auxtrace_mmap_pages && !privileged &&
						opts->mmap_pages == UINT_MAX) {
			opts->mmap_pages = KiB(256) / page_size;
		}

		/*
		 * '-m,xyz' was specified but no snapshot size, so make the
		 * snapshot size as big as the auxtrace mmap area.
		 */
		if (!opts->auxtrace_snapshot_size) {
			opts->auxtrace_snapshot_size =
				opts->auxtrace_mmap_pages * (size_t)page_size;
		}

		/*
		 * -Sxyz was specified but no auxtrace mmap area, so make the
		 * auxtrace mmap area big enough to fit the requested snapshot
		 * size.
		 */
		if (!opts->auxtrace_mmap_pages) {
			size_t sz = opts->auxtrace_snapshot_size;

			sz = round_up(sz, page_size) / page_size;
			opts->auxtrace_mmap_pages = roundup_pow_of_two(sz);
		}

379
		/* Snapshot size can't be bigger than the auxtrace area */
380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430
		if (opts->auxtrace_snapshot_size >
				opts->auxtrace_mmap_pages * (size_t)page_size) {
			pr_err("Snapshot size %zu must not be greater than AUX area tracing mmap size %zu\n",
			       opts->auxtrace_snapshot_size,
			       opts->auxtrace_mmap_pages * (size_t)page_size);
			return -EINVAL;
		}

		/* Something went wrong somewhere - this shouldn't happen */
		if (!opts->auxtrace_snapshot_size ||
		    !opts->auxtrace_mmap_pages) {
			pr_err("Failed to calculate default snapshot size and/or AUX area tracing mmap pages\n");
			return -EINVAL;
		}
	}

	/* We are in full trace mode but '-m,xyz' wasn't specified */
	if (opts->full_auxtrace && !opts->auxtrace_mmap_pages) {
		if (privileged) {
			opts->auxtrace_mmap_pages = MiB(4) / page_size;
		} else {
			opts->auxtrace_mmap_pages = KiB(128) / page_size;
			if (opts->mmap_pages == UINT_MAX)
				opts->mmap_pages = KiB(256) / page_size;
		}

	}

	/* Validate auxtrace_mmap_pages provided by user */
	if (opts->auxtrace_mmap_pages) {
		unsigned int max_page = (KiB(128) / page_size);
		size_t sz = opts->auxtrace_mmap_pages * (size_t)page_size;

		if (!privileged &&
		    opts->auxtrace_mmap_pages > max_page) {
			opts->auxtrace_mmap_pages = max_page;
			pr_err("auxtrace too big, truncating to %d\n",
			       max_page);
		}

		if (!is_power_of_2(sz)) {
			pr_err("Invalid mmap size for %s: must be a power of 2\n",
			       CORESIGHT_ETM_PMU_NAME);
			return -EINVAL;
		}
	}

	if (opts->auxtrace_snapshot_mode)
		pr_debug2("%s snapshot size: %zu\n", CORESIGHT_ETM_PMU_NAME,
			  opts->auxtrace_snapshot_size);

431 432 433 434
	/*
	 * To obtain the auxtrace buffer file descriptor, the auxtrace
	 * event must come first.
	 */
435
	evlist__to_front(evlist, cs_etm_evsel);
436 437 438

	/*
	 * In the case of per-cpu mmaps, we need the CPU on the
439 440
	 * AUX event.  We also need the contextID in order to be notified
	 * when a context switch happened.
441
	 */
442
	if (!perf_cpu_map__empty(cpus)) {
443
		evsel__set_sample_bit(cs_etm_evsel, CPU);
444

445
		err = cs_etm_set_option(itr, cs_etm_evsel,
446
					BIT(ETM_OPT_CTXTID) | BIT(ETM_OPT_TS));
447 448
		if (err)
			goto out;
449 450
	}

451 452
	/* Add dummy event to keep tracking */
	if (opts->full_auxtrace) {
453
		struct evsel *tracking_evsel;
454 455 456

		err = parse_events(evlist, "dummy:u", NULL);
		if (err)
457
			goto out;
458

459
		tracking_evsel = evlist__last(evlist);
460
		evlist__set_tracking_event(evlist, tracking_evsel);
461

462 463
		tracking_evsel->core.attr.freq = 0;
		tracking_evsel->core.attr.sample_period = 1;
464 465

		/* In per-cpu case, always need the time of mmap events etc */
466
		if (!perf_cpu_map__empty(cpus))
467
			evsel__set_sample_bit(tracking_evsel, TIME);
468 469
	}

470 471
out:
	return err;
472 473 474 475 476 477 478 479
}

static u64 cs_etm_get_config(struct auxtrace_record *itr)
{
	u64 config = 0;
	struct cs_etm_recording *ptr =
			container_of(itr, struct cs_etm_recording, itr);
	struct perf_pmu *cs_etm_pmu = ptr->cs_etm_pmu;
480
	struct evlist *evlist = ptr->evlist;
481
	struct evsel *evsel;
482 483

	evlist__for_each_entry(evlist, evsel) {
484
		if (evsel->core.attr.type == cs_etm_pmu->type) {
485 486 487 488 489 490 491 492
			/*
			 * Variable perf_event_attr::config is assigned to
			 * ETMv3/PTM.  The bit fields have been made to match
			 * the ETMv3.5 ETRMCR register specification.  See the
			 * PMU_FORMAT_ATTR() declarations in
			 * drivers/hwtracing/coresight/coresight-perf.c for
			 * details.
			 */
493
			config = evsel->core.attr.config;
494 495 496 497 498 499 500
			break;
		}
	}

	return config;
}

501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518
#ifndef BIT
#define BIT(N) (1UL << (N))
#endif

static u64 cs_etmv4_get_config(struct auxtrace_record *itr)
{
	u64 config = 0;
	u64 config_opts = 0;

	/*
	 * The perf event variable config bits represent both
	 * the command line options and register programming
	 * bits in ETMv3/PTM. For ETMv4 we must remap options
	 * to real bits
	 */
	config_opts = cs_etm_get_config(itr);
	if (config_opts & BIT(ETM_OPT_CYCACC))
		config |= BIT(ETM4_CFG_BIT_CYCACC);
519 520
	if (config_opts & BIT(ETM_OPT_CTXTID))
		config |= BIT(ETM4_CFG_BIT_CTXTID);
521 522 523 524
	if (config_opts & BIT(ETM_OPT_TS))
		config |= BIT(ETM4_CFG_BIT_TS);
	if (config_opts & BIT(ETM_OPT_RETSTK))
		config |= BIT(ETM4_CFG_BIT_RETSTK);
525 526 527
	if (config_opts & BIT(ETM_OPT_CTXTID2))
		config |= BIT(ETM4_CFG_BIT_VMID) |
			  BIT(ETM4_CFG_BIT_VMID_OPT);
528 529 530
	return config;
}

531 532
static size_t
cs_etm_info_priv_size(struct auxtrace_record *itr __maybe_unused,
533
		      struct evlist *evlist __maybe_unused)
534 535 536
{
	int i;
	int etmv3 = 0, etmv4 = 0;
537
	struct perf_cpu_map *event_cpus = evlist->core.cpus;
538
	struct perf_cpu_map *online_cpus = perf_cpu_map__new(NULL);
539 540

	/* cpu map is not empty, we have specific CPUs to work with */
541
	if (!perf_cpu_map__empty(event_cpus)) {
542 543 544 545 546 547
		for (i = 0; i < cpu__max_cpu(); i++) {
			if (!cpu_map__has(event_cpus, i) ||
			    !cpu_map__has(online_cpus, i))
				continue;

			if (cs_etm_is_etmv4(itr, i))
548 549 550 551 552 553 554
				etmv4++;
			else
				etmv3++;
		}
	} else {
		/* get configuration for all CPUs in the system */
		for (i = 0; i < cpu__max_cpu(); i++) {
555 556 557
			if (!cpu_map__has(online_cpus, i))
				continue;

558 559 560 561 562 563 564
			if (cs_etm_is_etmv4(itr, i))
				etmv4++;
			else
				etmv3++;
		}
	}

565
	perf_cpu_map__put(online_cpus);
566

567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611
	return (CS_ETM_HEADER_SIZE +
	       (etmv4 * CS_ETMV4_PRIV_SIZE) +
	       (etmv3 * CS_ETMV3_PRIV_SIZE));
}

static bool cs_etm_is_etmv4(struct auxtrace_record *itr, int cpu)
{
	bool ret = false;
	char path[PATH_MAX];
	int scan;
	unsigned int val;
	struct cs_etm_recording *ptr =
			container_of(itr, struct cs_etm_recording, itr);
	struct perf_pmu *cs_etm_pmu = ptr->cs_etm_pmu;

	/* Take any of the RO files for ETMv4 and see if it present */
	snprintf(path, PATH_MAX, "cpu%d/%s",
		 cpu, metadata_etmv4_ro[CS_ETMV4_TRCIDR0]);
	scan = perf_pmu__scan_file(cs_etm_pmu, path, "%x", &val);

	/* The file was read successfully, we have a winner */
	if (scan == 1)
		ret = true;

	return ret;
}

static int cs_etm_get_ro(struct perf_pmu *pmu, int cpu, const char *path)
{
	char pmu_path[PATH_MAX];
	int scan;
	unsigned int val = 0;

	/* Get RO metadata from sysfs */
	snprintf(pmu_path, PATH_MAX, "cpu%d/%s", cpu, path);

	scan = perf_pmu__scan_file(pmu, pmu_path, "%x", &val);
	if (scan != 1)
		pr_err("%s: error reading: %s\n", __func__, pmu_path);

	return val;
}

static void cs_etm_get_metadata(int cpu, u32 *offset,
				struct auxtrace_record *itr,
612
				struct perf_record_auxtrace_info *info)
613
{
614
	u32 increment, nr_trc_params;
615 616 617 618 619 620 621 622 623 624
	u64 magic;
	struct cs_etm_recording *ptr =
			container_of(itr, struct cs_etm_recording, itr);
	struct perf_pmu *cs_etm_pmu = ptr->cs_etm_pmu;

	/* first see what kind of tracer this cpu is affined to */
	if (cs_etm_is_etmv4(itr, cpu)) {
		magic = __perf_cs_etmv4_magic;
		/* Get trace configuration register */
		info->priv[*offset + CS_ETMV4_TRCCONFIGR] =
625
						cs_etmv4_get_config(itr);
626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648
		/* Get traceID from the framework */
		info->priv[*offset + CS_ETMV4_TRCTRACEIDR] =
						coresight_get_trace_id(cpu);
		/* Get read-only information from sysFS */
		info->priv[*offset + CS_ETMV4_TRCIDR0] =
			cs_etm_get_ro(cs_etm_pmu, cpu,
				      metadata_etmv4_ro[CS_ETMV4_TRCIDR0]);
		info->priv[*offset + CS_ETMV4_TRCIDR1] =
			cs_etm_get_ro(cs_etm_pmu, cpu,
				      metadata_etmv4_ro[CS_ETMV4_TRCIDR1]);
		info->priv[*offset + CS_ETMV4_TRCIDR2] =
			cs_etm_get_ro(cs_etm_pmu, cpu,
				      metadata_etmv4_ro[CS_ETMV4_TRCIDR2]);
		info->priv[*offset + CS_ETMV4_TRCIDR8] =
			cs_etm_get_ro(cs_etm_pmu, cpu,
				      metadata_etmv4_ro[CS_ETMV4_TRCIDR8]);
		info->priv[*offset + CS_ETMV4_TRCAUTHSTATUS] =
			cs_etm_get_ro(cs_etm_pmu, cpu,
				      metadata_etmv4_ro
				      [CS_ETMV4_TRCAUTHSTATUS]);

		/* How much space was used */
		increment = CS_ETMV4_PRIV_MAX;
649
		nr_trc_params = CS_ETMV4_PRIV_MAX - CS_ETMV4_TRCCONFIGR;
650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666
	} else {
		magic = __perf_cs_etmv3_magic;
		/* Get configuration register */
		info->priv[*offset + CS_ETM_ETMCR] = cs_etm_get_config(itr);
		/* Get traceID from the framework */
		info->priv[*offset + CS_ETM_ETMTRACEIDR] =
						coresight_get_trace_id(cpu);
		/* Get read-only information from sysFS */
		info->priv[*offset + CS_ETM_ETMCCER] =
			cs_etm_get_ro(cs_etm_pmu, cpu,
				      metadata_etmv3_ro[CS_ETM_ETMCCER]);
		info->priv[*offset + CS_ETM_ETMIDR] =
			cs_etm_get_ro(cs_etm_pmu, cpu,
				      metadata_etmv3_ro[CS_ETM_ETMIDR]);

		/* How much space was used */
		increment = CS_ETM_PRIV_MAX;
667
		nr_trc_params = CS_ETM_PRIV_MAX - CS_ETM_ETMCR;
668 669 670 671 672
	}

	/* Build generic header portion */
	info->priv[*offset + CS_ETM_MAGIC] = magic;
	info->priv[*offset + CS_ETM_CPU] = cpu;
673
	info->priv[*offset + CS_ETM_NR_TRC_PARAMS] = nr_trc_params;
674 675 676 677 678 679
	/* Where the next CPU entry should start from */
	*offset += increment;
}

static int cs_etm_info_fill(struct auxtrace_record *itr,
			    struct perf_session *session,
680
			    struct perf_record_auxtrace_info *info,
681 682 683 684 685
			    size_t priv_size)
{
	int i;
	u32 offset;
	u64 nr_cpu, type;
686
	struct perf_cpu_map *cpu_map;
687
	struct perf_cpu_map *event_cpus = session->evlist->core.cpus;
688
	struct perf_cpu_map *online_cpus = perf_cpu_map__new(NULL);
689 690 691 692 693 694 695
	struct cs_etm_recording *ptr =
			container_of(itr, struct cs_etm_recording, itr);
	struct perf_pmu *cs_etm_pmu = ptr->cs_etm_pmu;

	if (priv_size != cs_etm_info_priv_size(itr, session->evlist))
		return -EINVAL;

696
	if (!session->evlist->core.nr_mmaps)
697 698
		return -EINVAL;

699
	/* If the cpu_map is empty all online CPUs are involved */
700
	if (perf_cpu_map__empty(event_cpus)) {
701 702 703
		cpu_map = online_cpus;
	} else {
		/* Make sure all specified CPUs are online */
704
		for (i = 0; i < perf_cpu_map__nr(event_cpus); i++) {
705 706 707 708 709 710 711 712
			if (cpu_map__has(event_cpus, i) &&
			    !cpu_map__has(online_cpus, i))
				return -EINVAL;
		}

		cpu_map = event_cpus;
	}

713
	nr_cpu = perf_cpu_map__nr(cpu_map);
714 715 716 717 718
	/* Get PMU type as dynamically assigned by the core */
	type = cs_etm_pmu->type;

	/* First fill out the session header */
	info->type = PERF_AUXTRACE_CS_ETM;
719
	info->priv[CS_HEADER_VERSION] = CS_HEADER_CURRENT_VERSION;
720 721 722 723 724 725
	info->priv[CS_PMU_TYPE_CPUS] = type << 32;
	info->priv[CS_PMU_TYPE_CPUS] |= nr_cpu;
	info->priv[CS_ETM_SNAPSHOT] = ptr->snapshot_mode;

	offset = CS_ETM_SNAPSHOT + 1;

726 727
	for (i = 0; i < cpu__max_cpu() && offset < priv_size; i++)
		if (cpu_map__has(cpu_map, i))
728
			cs_etm_get_metadata(i, &offset, itr, info);
729

730
	perf_cpu_map__put(online_cpus);
731 732 733 734 735 736 737 738

	return 0;
}

static int cs_etm_snapshot_start(struct auxtrace_record *itr)
{
	struct cs_etm_recording *ptr =
			container_of(itr, struct cs_etm_recording, itr);
739
	struct evsel *evsel;
740 741

	evlist__for_each_entry(ptr->evlist, evsel) {
742
		if (evsel->core.attr.type == ptr->cs_etm_pmu->type)
743
			return evsel__disable(evsel);
744 745 746 747 748 749 750 751
	}
	return -EINVAL;
}

static int cs_etm_snapshot_finish(struct auxtrace_record *itr)
{
	struct cs_etm_recording *ptr =
			container_of(itr, struct cs_etm_recording, itr);
752
	struct evsel *evsel;
753 754

	evlist__for_each_entry(ptr->evlist, evsel) {
755
		if (evsel->core.attr.type == ptr->cs_etm_pmu->type)
756
			return evsel__enable(evsel);
757 758 759 760 761 762 763 764 765 766 767 768 769 770
	}
	return -EINVAL;
}

static u64 cs_etm_reference(struct auxtrace_record *itr __maybe_unused)
{
	return (((u64) rand() <<  0) & 0x00000000FFFFFFFFull) |
		(((u64) rand() << 32) & 0xFFFFFFFF00000000ull);
}

static void cs_etm_recording_free(struct auxtrace_record *itr)
{
	struct cs_etm_recording *ptr =
			container_of(itr, struct cs_etm_recording, itr);
771

772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793
	free(ptr);
}

struct auxtrace_record *cs_etm_record_init(int *err)
{
	struct perf_pmu *cs_etm_pmu;
	struct cs_etm_recording *ptr;

	cs_etm_pmu = perf_pmu__find(CORESIGHT_ETM_PMU_NAME);

	if (!cs_etm_pmu) {
		*err = -EINVAL;
		goto out;
	}

	ptr = zalloc(sizeof(struct cs_etm_recording));
	if (!ptr) {
		*err = -ENOMEM;
		goto out;
	}

	ptr->cs_etm_pmu			= cs_etm_pmu;
794
	ptr->itr.pmu			= cs_etm_pmu;
795 796 797 798 799 800 801 802
	ptr->itr.parse_snapshot_options	= cs_etm_parse_snapshot_options;
	ptr->itr.recording_options	= cs_etm_recording_options;
	ptr->itr.info_priv_size		= cs_etm_info_priv_size;
	ptr->itr.info_fill		= cs_etm_info_fill;
	ptr->itr.snapshot_start		= cs_etm_snapshot_start;
	ptr->itr.snapshot_finish	= cs_etm_snapshot_finish;
	ptr->itr.reference		= cs_etm_reference;
	ptr->itr.free			= cs_etm_recording_free;
803
	ptr->itr.read_finish		= auxtrace_record__read_finish;
804 805 806 807 808 809

	*err = 0;
	return &ptr->itr;
out:
	return NULL;
}