xref: /openbmc/linux/arch/powerpc/perf/imc-pmu.c (revision 8365a898)
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * In-Memory Collection (IMC) Performance Monitor counter support.
4  *
5  * Copyright (C) 2017 Madhavan Srinivasan, IBM Corporation.
6  *           (C) 2017 Anju T Sudhakar, IBM Corporation.
7  *           (C) 2017 Hemant K Shaw, IBM Corporation.
8  */
9 #include <linux/perf_event.h>
10 #include <linux/slab.h>
11 #include <asm/opal.h>
12 #include <asm/imc-pmu.h>
13 #include <asm/cputhreads.h>
14 #include <asm/smp.h>
15 #include <linux/string.h>
16 
17 /* Nest IMC data structures and variables */
18 
19 /*
20  * Used to avoid races in counting the nest-pmu units during hotplug
21  * register and unregister
22  */
23 static DEFINE_MUTEX(nest_init_lock);
24 static DEFINE_PER_CPU(struct imc_pmu_ref *, local_nest_imc_refc);
25 static struct imc_pmu **per_nest_pmu_arr;
26 static cpumask_t nest_imc_cpumask;
27 static struct imc_pmu_ref *nest_imc_refc;
28 static int nest_pmus;
29 
30 /* Core IMC data structures and variables */
31 
32 static cpumask_t core_imc_cpumask;
33 static struct imc_pmu_ref *core_imc_refc;
34 static struct imc_pmu *core_imc_pmu;
35 
36 /* Thread IMC data structures and variables */
37 
38 static DEFINE_PER_CPU(u64 *, thread_imc_mem);
39 static struct imc_pmu *thread_imc_pmu;
40 static int thread_imc_mem_size;
41 
42 /* Trace IMC data structures */
43 static DEFINE_PER_CPU(u64 *, trace_imc_mem);
44 static struct imc_pmu_ref *trace_imc_refc;
45 static int trace_imc_mem_size;
46 
47 /*
48  * Global data structure used to avoid races between thread,
49  * core and trace-imc
50  */
51 static struct imc_pmu_ref imc_global_refc = {
52 	.lock = __MUTEX_INITIALIZER(imc_global_refc.lock),
53 	.id = 0,
54 	.refc = 0,
55 };
56 
57 static struct imc_pmu *imc_event_to_pmu(struct perf_event *event)
58 {
59 	return container_of(event->pmu, struct imc_pmu, pmu);
60 }
61 
62 PMU_FORMAT_ATTR(event, "config:0-61");
63 PMU_FORMAT_ATTR(offset, "config:0-31");
64 PMU_FORMAT_ATTR(rvalue, "config:32");
65 PMU_FORMAT_ATTR(mode, "config:33-40");
66 static struct attribute *imc_format_attrs[] = {
67 	&format_attr_event.attr,
68 	&format_attr_offset.attr,
69 	&format_attr_rvalue.attr,
70 	&format_attr_mode.attr,
71 	NULL,
72 };
73 
74 static struct attribute_group imc_format_group = {
75 	.name = "format",
76 	.attrs = imc_format_attrs,
77 };
78 
79 /* Format attribute for imc trace-mode */
80 PMU_FORMAT_ATTR(cpmc_reserved, "config:0-19");
81 PMU_FORMAT_ATTR(cpmc_event, "config:20-27");
82 PMU_FORMAT_ATTR(cpmc_samplesel, "config:28-29");
83 PMU_FORMAT_ATTR(cpmc_load, "config:30-61");
84 static struct attribute *trace_imc_format_attrs[] = {
85 	&format_attr_event.attr,
86 	&format_attr_cpmc_reserved.attr,
87 	&format_attr_cpmc_event.attr,
88 	&format_attr_cpmc_samplesel.attr,
89 	&format_attr_cpmc_load.attr,
90 	NULL,
91 };
92 
93 static struct attribute_group trace_imc_format_group = {
94 .name = "format",
95 .attrs = trace_imc_format_attrs,
96 };
97 
98 /* Get the cpumask printed to a buffer "buf" */
99 static ssize_t imc_pmu_cpumask_get_attr(struct device *dev,
100 					struct device_attribute *attr,
101 					char *buf)
102 {
103 	struct pmu *pmu = dev_get_drvdata(dev);
104 	struct imc_pmu *imc_pmu = container_of(pmu, struct imc_pmu, pmu);
105 	cpumask_t *active_mask;
106 
107 	switch(imc_pmu->domain){
108 	case IMC_DOMAIN_NEST:
109 		active_mask = &nest_imc_cpumask;
110 		break;
111 	case IMC_DOMAIN_CORE:
112 		active_mask = &core_imc_cpumask;
113 		break;
114 	default:
115 		return 0;
116 	}
117 
118 	return cpumap_print_to_pagebuf(true, buf, active_mask);
119 }
120 
121 static DEVICE_ATTR(cpumask, S_IRUGO, imc_pmu_cpumask_get_attr, NULL);
122 
123 static struct attribute *imc_pmu_cpumask_attrs[] = {
124 	&dev_attr_cpumask.attr,
125 	NULL,
126 };
127 
128 static struct attribute_group imc_pmu_cpumask_attr_group = {
129 	.attrs = imc_pmu_cpumask_attrs,
130 };
131 
132 /* device_str_attr_create : Populate event "name" and string "str" in attribute */
133 static struct attribute *device_str_attr_create(const char *name, const char *str)
134 {
135 	struct perf_pmu_events_attr *attr;
136 
137 	attr = kzalloc(sizeof(*attr), GFP_KERNEL);
138 	if (!attr)
139 		return NULL;
140 	sysfs_attr_init(&attr->attr.attr);
141 
142 	attr->event_str = str;
143 	attr->attr.attr.name = name;
144 	attr->attr.attr.mode = 0444;
145 	attr->attr.show = perf_event_sysfs_show;
146 
147 	return &attr->attr.attr;
148 }
149 
150 static int imc_parse_event(struct device_node *np, const char *scale,
151 				  const char *unit, const char *prefix,
152 				  u32 base, struct imc_events *event)
153 {
154 	const char *s;
155 	u32 reg;
156 
157 	if (of_property_read_u32(np, "reg", &reg))
158 		goto error;
159 	/* Add the base_reg value to the "reg" */
160 	event->value = base + reg;
161 
162 	if (of_property_read_string(np, "event-name", &s))
163 		goto error;
164 
165 	event->name = kasprintf(GFP_KERNEL, "%s%s", prefix, s);
166 	if (!event->name)
167 		goto error;
168 
169 	if (of_property_read_string(np, "scale", &s))
170 		s = scale;
171 
172 	if (s) {
173 		event->scale = kstrdup(s, GFP_KERNEL);
174 		if (!event->scale)
175 			goto error;
176 	}
177 
178 	if (of_property_read_string(np, "unit", &s))
179 		s = unit;
180 
181 	if (s) {
182 		event->unit = kstrdup(s, GFP_KERNEL);
183 		if (!event->unit)
184 			goto error;
185 	}
186 
187 	return 0;
188 error:
189 	kfree(event->unit);
190 	kfree(event->scale);
191 	kfree(event->name);
192 	return -EINVAL;
193 }
194 
195 /*
196  * imc_free_events: Function to cleanup the events list, having
197  * 		    "nr_entries".
198  */
199 static void imc_free_events(struct imc_events *events, int nr_entries)
200 {
201 	int i;
202 
203 	/* Nothing to clean, return */
204 	if (!events)
205 		return;
206 	for (i = 0; i < nr_entries; i++) {
207 		kfree(events[i].unit);
208 		kfree(events[i].scale);
209 		kfree(events[i].name);
210 	}
211 
212 	kfree(events);
213 }
214 
215 /*
216  * update_events_in_group: Update the "events" information in an attr_group
217  *                         and assign the attr_group to the pmu "pmu".
218  */
219 static int update_events_in_group(struct device_node *node, struct imc_pmu *pmu)
220 {
221 	struct attribute_group *attr_group;
222 	struct attribute **attrs, *dev_str;
223 	struct device_node *np, *pmu_events;
224 	u32 handle, base_reg;
225 	int i = 0, j = 0, ct, ret;
226 	const char *prefix, *g_scale, *g_unit;
227 	const char *ev_val_str, *ev_scale_str, *ev_unit_str;
228 
229 	if (!of_property_read_u32(node, "events", &handle))
230 		pmu_events = of_find_node_by_phandle(handle);
231 	else
232 		return 0;
233 
234 	/* Did not find any node with a given phandle */
235 	if (!pmu_events)
236 		return 0;
237 
238 	/* Get a count of number of child nodes */
239 	ct = of_get_child_count(pmu_events);
240 
241 	/* Get the event prefix */
242 	if (of_property_read_string(node, "events-prefix", &prefix))
243 		return 0;
244 
245 	/* Get a global unit and scale data if available */
246 	if (of_property_read_string(node, "scale", &g_scale))
247 		g_scale = NULL;
248 
249 	if (of_property_read_string(node, "unit", &g_unit))
250 		g_unit = NULL;
251 
252 	/* "reg" property gives out the base offset of the counters data */
253 	of_property_read_u32(node, "reg", &base_reg);
254 
255 	/* Allocate memory for the events */
256 	pmu->events = kcalloc(ct, sizeof(struct imc_events), GFP_KERNEL);
257 	if (!pmu->events)
258 		return -ENOMEM;
259 
260 	ct = 0;
261 	/* Parse the events and update the struct */
262 	for_each_child_of_node(pmu_events, np) {
263 		ret = imc_parse_event(np, g_scale, g_unit, prefix, base_reg, &pmu->events[ct]);
264 		if (!ret)
265 			ct++;
266 	}
267 
268 	/* Allocate memory for attribute group */
269 	attr_group = kzalloc(sizeof(*attr_group), GFP_KERNEL);
270 	if (!attr_group) {
271 		imc_free_events(pmu->events, ct);
272 		return -ENOMEM;
273 	}
274 
275 	/*
276 	 * Allocate memory for attributes.
277 	 * Since we have count of events for this pmu, we also allocate
278 	 * memory for the scale and unit attribute for now.
279 	 * "ct" has the total event structs added from the events-parent node.
280 	 * So allocate three times the "ct" (this includes event, event_scale and
281 	 * event_unit).
282 	 */
283 	attrs = kcalloc(((ct * 3) + 1), sizeof(struct attribute *), GFP_KERNEL);
284 	if (!attrs) {
285 		kfree(attr_group);
286 		imc_free_events(pmu->events, ct);
287 		return -ENOMEM;
288 	}
289 
290 	attr_group->name = "events";
291 	attr_group->attrs = attrs;
292 	do {
293 		ev_val_str = kasprintf(GFP_KERNEL, "event=0x%x", pmu->events[i].value);
294 		dev_str = device_str_attr_create(pmu->events[i].name, ev_val_str);
295 		if (!dev_str)
296 			continue;
297 
298 		attrs[j++] = dev_str;
299 		if (pmu->events[i].scale) {
300 			ev_scale_str = kasprintf(GFP_KERNEL, "%s.scale", pmu->events[i].name);
301 			dev_str = device_str_attr_create(ev_scale_str, pmu->events[i].scale);
302 			if (!dev_str)
303 				continue;
304 
305 			attrs[j++] = dev_str;
306 		}
307 
308 		if (pmu->events[i].unit) {
309 			ev_unit_str = kasprintf(GFP_KERNEL, "%s.unit", pmu->events[i].name);
310 			dev_str = device_str_attr_create(ev_unit_str, pmu->events[i].unit);
311 			if (!dev_str)
312 				continue;
313 
314 			attrs[j++] = dev_str;
315 		}
316 	} while (++i < ct);
317 
318 	/* Save the event attribute */
319 	pmu->attr_groups[IMC_EVENT_ATTR] = attr_group;
320 
321 	return 0;
322 }
323 
324 /* get_nest_pmu_ref: Return the imc_pmu_ref struct for the given node */
325 static struct imc_pmu_ref *get_nest_pmu_ref(int cpu)
326 {
327 	return per_cpu(local_nest_imc_refc, cpu);
328 }
329 
330 static void nest_change_cpu_context(int old_cpu, int new_cpu)
331 {
332 	struct imc_pmu **pn = per_nest_pmu_arr;
333 
334 	if (old_cpu < 0 || new_cpu < 0)
335 		return;
336 
337 	while (*pn) {
338 		perf_pmu_migrate_context(&(*pn)->pmu, old_cpu, new_cpu);
339 		pn++;
340 	}
341 }
342 
343 static int ppc_nest_imc_cpu_offline(unsigned int cpu)
344 {
345 	int nid, target = -1;
346 	const struct cpumask *l_cpumask;
347 	struct imc_pmu_ref *ref;
348 
349 	/*
350 	 * Check in the designated list for this cpu. Dont bother
351 	 * if not one of them.
352 	 */
353 	if (!cpumask_test_and_clear_cpu(cpu, &nest_imc_cpumask))
354 		return 0;
355 
356 	/*
357 	 * Check whether nest_imc is registered. We could end up here if the
358 	 * cpuhotplug callback registration fails. i.e, callback invokes the
359 	 * offline path for all successfully registered nodes. At this stage,
360 	 * nest_imc pmu will not be registered and we should return here.
361 	 *
362 	 * We return with a zero since this is not an offline failure. And
363 	 * cpuhp_setup_state() returns the actual failure reason to the caller,
364 	 * which in turn will call the cleanup routine.
365 	 */
366 	if (!nest_pmus)
367 		return 0;
368 
369 	/*
370 	 * Now that this cpu is one of the designated,
371 	 * find a next cpu a) which is online and b) in same chip.
372 	 */
373 	nid = cpu_to_node(cpu);
374 	l_cpumask = cpumask_of_node(nid);
375 	target = cpumask_last(l_cpumask);
376 
377 	/*
378 	 * If this(target) is the last cpu in the cpumask for this chip,
379 	 * check for any possible online cpu in the chip.
380 	 */
381 	if (unlikely(target == cpu))
382 		target = cpumask_any_but(l_cpumask, cpu);
383 
384 	/*
385 	 * Update the cpumask with the target cpu and
386 	 * migrate the context if needed
387 	 */
388 	if (target >= 0 && target < nr_cpu_ids) {
389 		cpumask_set_cpu(target, &nest_imc_cpumask);
390 		nest_change_cpu_context(cpu, target);
391 	} else {
392 		opal_imc_counters_stop(OPAL_IMC_COUNTERS_NEST,
393 				       get_hard_smp_processor_id(cpu));
394 		/*
395 		 * If this is the last cpu in this chip then, skip the reference
396 		 * count mutex lock and make the reference count on this chip zero.
397 		 */
398 		ref = get_nest_pmu_ref(cpu);
399 		if (!ref)
400 			return -EINVAL;
401 
402 		ref->refc = 0;
403 	}
404 	return 0;
405 }
406 
407 static int ppc_nest_imc_cpu_online(unsigned int cpu)
408 {
409 	const struct cpumask *l_cpumask;
410 	static struct cpumask tmp_mask;
411 	int res;
412 
413 	/* Get the cpumask of this node */
414 	l_cpumask = cpumask_of_node(cpu_to_node(cpu));
415 
416 	/*
417 	 * If this is not the first online CPU on this node, then
418 	 * just return.
419 	 */
420 	if (cpumask_and(&tmp_mask, l_cpumask, &nest_imc_cpumask))
421 		return 0;
422 
423 	/*
424 	 * If this is the first online cpu on this node
425 	 * disable the nest counters by making an OPAL call.
426 	 */
427 	res = opal_imc_counters_stop(OPAL_IMC_COUNTERS_NEST,
428 				     get_hard_smp_processor_id(cpu));
429 	if (res)
430 		return res;
431 
432 	/* Make this CPU the designated target for counter collection */
433 	cpumask_set_cpu(cpu, &nest_imc_cpumask);
434 	return 0;
435 }
436 
437 static int nest_pmu_cpumask_init(void)
438 {
439 	return cpuhp_setup_state(CPUHP_AP_PERF_POWERPC_NEST_IMC_ONLINE,
440 				 "perf/powerpc/imc:online",
441 				 ppc_nest_imc_cpu_online,
442 				 ppc_nest_imc_cpu_offline);
443 }
444 
445 static void nest_imc_counters_release(struct perf_event *event)
446 {
447 	int rc, node_id;
448 	struct imc_pmu_ref *ref;
449 
450 	if (event->cpu < 0)
451 		return;
452 
453 	node_id = cpu_to_node(event->cpu);
454 
455 	/*
456 	 * See if we need to disable the nest PMU.
457 	 * If no events are currently in use, then we have to take a
458 	 * mutex to ensure that we don't race with another task doing
459 	 * enable or disable the nest counters.
460 	 */
461 	ref = get_nest_pmu_ref(event->cpu);
462 	if (!ref)
463 		return;
464 
465 	/* Take the mutex lock for this node and then decrement the reference count */
466 	mutex_lock(&ref->lock);
467 	if (ref->refc == 0) {
468 		/*
469 		 * The scenario where this is true is, when perf session is
470 		 * started, followed by offlining of all cpus in a given node.
471 		 *
472 		 * In the cpuhotplug offline path, ppc_nest_imc_cpu_offline()
473 		 * function set the ref->count to zero, if the cpu which is
474 		 * about to offline is the last cpu in a given node and make
475 		 * an OPAL call to disable the engine in that node.
476 		 *
477 		 */
478 		mutex_unlock(&ref->lock);
479 		return;
480 	}
481 	ref->refc--;
482 	if (ref->refc == 0) {
483 		rc = opal_imc_counters_stop(OPAL_IMC_COUNTERS_NEST,
484 					    get_hard_smp_processor_id(event->cpu));
485 		if (rc) {
486 			mutex_unlock(&ref->lock);
487 			pr_err("nest-imc: Unable to stop the counters for core %d\n", node_id);
488 			return;
489 		}
490 	} else if (ref->refc < 0) {
491 		WARN(1, "nest-imc: Invalid event reference count\n");
492 		ref->refc = 0;
493 	}
494 	mutex_unlock(&ref->lock);
495 }
496 
497 static int nest_imc_event_init(struct perf_event *event)
498 {
499 	int chip_id, rc, node_id;
500 	u32 l_config, config = event->attr.config;
501 	struct imc_mem_info *pcni;
502 	struct imc_pmu *pmu;
503 	struct imc_pmu_ref *ref;
504 	bool flag = false;
505 
506 	if (event->attr.type != event->pmu->type)
507 		return -ENOENT;
508 
509 	/* Sampling not supported */
510 	if (event->hw.sample_period)
511 		return -EINVAL;
512 
513 	if (event->cpu < 0)
514 		return -EINVAL;
515 
516 	pmu = imc_event_to_pmu(event);
517 
518 	/* Sanity check for config (event offset) */
519 	if ((config & IMC_EVENT_OFFSET_MASK) > pmu->counter_mem_size)
520 		return -EINVAL;
521 
522 	/*
523 	 * Nest HW counter memory resides in a per-chip reserve-memory (HOMER).
524 	 * Get the base memory addresss for this cpu.
525 	 */
526 	chip_id = cpu_to_chip_id(event->cpu);
527 
528 	/* Return, if chip_id is not valid */
529 	if (chip_id < 0)
530 		return -ENODEV;
531 
532 	pcni = pmu->mem_info;
533 	do {
534 		if (pcni->id == chip_id) {
535 			flag = true;
536 			break;
537 		}
538 		pcni++;
539 	} while (pcni->vbase != 0);
540 
541 	if (!flag)
542 		return -ENODEV;
543 
544 	/*
545 	 * Add the event offset to the base address.
546 	 */
547 	l_config = config & IMC_EVENT_OFFSET_MASK;
548 	event->hw.event_base = (u64)pcni->vbase + l_config;
549 	node_id = cpu_to_node(event->cpu);
550 
551 	/*
552 	 * Get the imc_pmu_ref struct for this node.
553 	 * Take the mutex lock and then increment the count of nest pmu events
554 	 * inited.
555 	 */
556 	ref = get_nest_pmu_ref(event->cpu);
557 	if (!ref)
558 		return -EINVAL;
559 
560 	mutex_lock(&ref->lock);
561 	if (ref->refc == 0) {
562 		rc = opal_imc_counters_start(OPAL_IMC_COUNTERS_NEST,
563 					     get_hard_smp_processor_id(event->cpu));
564 		if (rc) {
565 			mutex_unlock(&ref->lock);
566 			pr_err("nest-imc: Unable to start the counters for node %d\n",
567 									node_id);
568 			return rc;
569 		}
570 	}
571 	++ref->refc;
572 	mutex_unlock(&ref->lock);
573 
574 	event->destroy = nest_imc_counters_release;
575 	return 0;
576 }
577 
578 /*
579  * core_imc_mem_init : Initializes memory for the current core.
580  *
581  * Uses alloc_pages_node() and uses the returned address as an argument to
582  * an opal call to configure the pdbar. The address sent as an argument is
583  * converted to physical address before the opal call is made. This is the
584  * base address at which the core imc counters are populated.
585  */
586 static int core_imc_mem_init(int cpu, int size)
587 {
588 	int nid, rc = 0, core_id = (cpu / threads_per_core);
589 	struct imc_mem_info *mem_info;
590 	struct page *page;
591 
592 	/*
593 	 * alloc_pages_node() will allocate memory for core in the
594 	 * local node only.
595 	 */
596 	nid = cpu_to_node(cpu);
597 	mem_info = &core_imc_pmu->mem_info[core_id];
598 	mem_info->id = core_id;
599 
600 	/* We need only vbase for core counters */
601 	page = alloc_pages_node(nid,
602 				GFP_KERNEL | __GFP_ZERO | __GFP_THISNODE |
603 				__GFP_NOWARN, get_order(size));
604 	if (!page)
605 		return -ENOMEM;
606 	mem_info->vbase = page_address(page);
607 
608 	/* Init the mutex */
609 	core_imc_refc[core_id].id = core_id;
610 	mutex_init(&core_imc_refc[core_id].lock);
611 
612 	rc = opal_imc_counters_init(OPAL_IMC_COUNTERS_CORE,
613 				__pa((void *)mem_info->vbase),
614 				get_hard_smp_processor_id(cpu));
615 	if (rc) {
616 		free_pages((u64)mem_info->vbase, get_order(size));
617 		mem_info->vbase = NULL;
618 	}
619 
620 	return rc;
621 }
622 
623 static bool is_core_imc_mem_inited(int cpu)
624 {
625 	struct imc_mem_info *mem_info;
626 	int core_id = (cpu / threads_per_core);
627 
628 	mem_info = &core_imc_pmu->mem_info[core_id];
629 	if (!mem_info->vbase)
630 		return false;
631 
632 	return true;
633 }
634 
635 static int ppc_core_imc_cpu_online(unsigned int cpu)
636 {
637 	const struct cpumask *l_cpumask;
638 	static struct cpumask tmp_mask;
639 	int ret = 0;
640 
641 	/* Get the cpumask for this core */
642 	l_cpumask = cpu_sibling_mask(cpu);
643 
644 	/* If a cpu for this core is already set, then, don't do anything */
645 	if (cpumask_and(&tmp_mask, l_cpumask, &core_imc_cpumask))
646 		return 0;
647 
648 	if (!is_core_imc_mem_inited(cpu)) {
649 		ret = core_imc_mem_init(cpu, core_imc_pmu->counter_mem_size);
650 		if (ret) {
651 			pr_info("core_imc memory allocation for cpu %d failed\n", cpu);
652 			return ret;
653 		}
654 	}
655 
656 	/* set the cpu in the mask */
657 	cpumask_set_cpu(cpu, &core_imc_cpumask);
658 	return 0;
659 }
660 
661 static int ppc_core_imc_cpu_offline(unsigned int cpu)
662 {
663 	unsigned int core_id;
664 	int ncpu;
665 	struct imc_pmu_ref *ref;
666 
667 	/*
668 	 * clear this cpu out of the mask, if not present in the mask,
669 	 * don't bother doing anything.
670 	 */
671 	if (!cpumask_test_and_clear_cpu(cpu, &core_imc_cpumask))
672 		return 0;
673 
674 	/*
675 	 * Check whether core_imc is registered. We could end up here
676 	 * if the cpuhotplug callback registration fails. i.e, callback
677 	 * invokes the offline path for all sucessfully registered cpus.
678 	 * At this stage, core_imc pmu will not be registered and we
679 	 * should return here.
680 	 *
681 	 * We return with a zero since this is not an offline failure.
682 	 * And cpuhp_setup_state() returns the actual failure reason
683 	 * to the caller, which inturn will call the cleanup routine.
684 	 */
685 	if (!core_imc_pmu->pmu.event_init)
686 		return 0;
687 
688 	/* Find any online cpu in that core except the current "cpu" */
689 	ncpu = cpumask_last(cpu_sibling_mask(cpu));
690 
691 	if (unlikely(ncpu == cpu))
692 		ncpu = cpumask_any_but(cpu_sibling_mask(cpu), cpu);
693 
694 	if (ncpu >= 0 && ncpu < nr_cpu_ids) {
695 		cpumask_set_cpu(ncpu, &core_imc_cpumask);
696 		perf_pmu_migrate_context(&core_imc_pmu->pmu, cpu, ncpu);
697 	} else {
698 		/*
699 		 * If this is the last cpu in this core then, skip taking refernce
700 		 * count mutex lock for this core and directly zero "refc" for
701 		 * this core.
702 		 */
703 		opal_imc_counters_stop(OPAL_IMC_COUNTERS_CORE,
704 				       get_hard_smp_processor_id(cpu));
705 		core_id = cpu / threads_per_core;
706 		ref = &core_imc_refc[core_id];
707 		if (!ref)
708 			return -EINVAL;
709 
710 		ref->refc = 0;
711 		/*
712 		 * Reduce the global reference count, if this is the
713 		 * last cpu in this core and core-imc event running
714 		 * in this cpu.
715 		 */
716 		mutex_lock(&imc_global_refc.lock);
717 		if (imc_global_refc.id == IMC_DOMAIN_CORE)
718 			imc_global_refc.refc--;
719 
720 		mutex_unlock(&imc_global_refc.lock);
721 	}
722 	return 0;
723 }
724 
725 static int core_imc_pmu_cpumask_init(void)
726 {
727 	return cpuhp_setup_state(CPUHP_AP_PERF_POWERPC_CORE_IMC_ONLINE,
728 				 "perf/powerpc/imc_core:online",
729 				 ppc_core_imc_cpu_online,
730 				 ppc_core_imc_cpu_offline);
731 }
732 
733 static void reset_global_refc(struct perf_event *event)
734 {
735 		mutex_lock(&imc_global_refc.lock);
736 		imc_global_refc.refc--;
737 
738 		/*
739 		 * If no other thread is running any
740 		 * event for this domain(thread/core/trace),
741 		 * set the global id to zero.
742 		 */
743 		if (imc_global_refc.refc <= 0) {
744 			imc_global_refc.refc = 0;
745 			imc_global_refc.id = 0;
746 		}
747 		mutex_unlock(&imc_global_refc.lock);
748 }
749 
750 static void core_imc_counters_release(struct perf_event *event)
751 {
752 	int rc, core_id;
753 	struct imc_pmu_ref *ref;
754 
755 	if (event->cpu < 0)
756 		return;
757 	/*
758 	 * See if we need to disable the IMC PMU.
759 	 * If no events are currently in use, then we have to take a
760 	 * mutex to ensure that we don't race with another task doing
761 	 * enable or disable the core counters.
762 	 */
763 	core_id = event->cpu / threads_per_core;
764 
765 	/* Take the mutex lock and decrement the refernce count for this core */
766 	ref = &core_imc_refc[core_id];
767 	if (!ref)
768 		return;
769 
770 	mutex_lock(&ref->lock);
771 	if (ref->refc == 0) {
772 		/*
773 		 * The scenario where this is true is, when perf session is
774 		 * started, followed by offlining of all cpus in a given core.
775 		 *
776 		 * In the cpuhotplug offline path, ppc_core_imc_cpu_offline()
777 		 * function set the ref->count to zero, if the cpu which is
778 		 * about to offline is the last cpu in a given core and make
779 		 * an OPAL call to disable the engine in that core.
780 		 *
781 		 */
782 		mutex_unlock(&ref->lock);
783 		return;
784 	}
785 	ref->refc--;
786 	if (ref->refc == 0) {
787 		rc = opal_imc_counters_stop(OPAL_IMC_COUNTERS_CORE,
788 					    get_hard_smp_processor_id(event->cpu));
789 		if (rc) {
790 			mutex_unlock(&ref->lock);
791 			pr_err("IMC: Unable to stop the counters for core %d\n", core_id);
792 			return;
793 		}
794 	} else if (ref->refc < 0) {
795 		WARN(1, "core-imc: Invalid event reference count\n");
796 		ref->refc = 0;
797 	}
798 	mutex_unlock(&ref->lock);
799 
800 	reset_global_refc(event);
801 }
802 
803 static int core_imc_event_init(struct perf_event *event)
804 {
805 	int core_id, rc;
806 	u64 config = event->attr.config;
807 	struct imc_mem_info *pcmi;
808 	struct imc_pmu *pmu;
809 	struct imc_pmu_ref *ref;
810 
811 	if (event->attr.type != event->pmu->type)
812 		return -ENOENT;
813 
814 	/* Sampling not supported */
815 	if (event->hw.sample_period)
816 		return -EINVAL;
817 
818 	if (event->cpu < 0)
819 		return -EINVAL;
820 
821 	event->hw.idx = -1;
822 	pmu = imc_event_to_pmu(event);
823 
824 	/* Sanity check for config (event offset) */
825 	if (((config & IMC_EVENT_OFFSET_MASK) > pmu->counter_mem_size))
826 		return -EINVAL;
827 
828 	if (!is_core_imc_mem_inited(event->cpu))
829 		return -ENODEV;
830 
831 	core_id = event->cpu / threads_per_core;
832 	pcmi = &core_imc_pmu->mem_info[core_id];
833 	if ((!pcmi->vbase))
834 		return -ENODEV;
835 
836 	/* Get the core_imc mutex for this core */
837 	ref = &core_imc_refc[core_id];
838 	if (!ref)
839 		return -EINVAL;
840 
841 	/*
842 	 * Core pmu units are enabled only when it is used.
843 	 * See if this is triggered for the first time.
844 	 * If yes, take the mutex lock and enable the core counters.
845 	 * If not, just increment the count in core_imc_refc struct.
846 	 */
847 	mutex_lock(&ref->lock);
848 	if (ref->refc == 0) {
849 		rc = opal_imc_counters_start(OPAL_IMC_COUNTERS_CORE,
850 					     get_hard_smp_processor_id(event->cpu));
851 		if (rc) {
852 			mutex_unlock(&ref->lock);
853 			pr_err("core-imc: Unable to start the counters for core %d\n",
854 									core_id);
855 			return rc;
856 		}
857 	}
858 	++ref->refc;
859 	mutex_unlock(&ref->lock);
860 
861 	/*
862 	 * Since the system can run either in accumulation or trace-mode
863 	 * of IMC at a time, core-imc events are allowed only if no other
864 	 * trace/thread imc events are enabled/monitored.
865 	 *
866 	 * Take the global lock, and check the refc.id
867 	 * to know whether any other trace/thread imc
868 	 * events are running.
869 	 */
870 	mutex_lock(&imc_global_refc.lock);
871 	if (imc_global_refc.id == 0 || imc_global_refc.id == IMC_DOMAIN_CORE) {
872 		/*
873 		 * No other trace/thread imc events are running in
874 		 * the system, so set the refc.id to core-imc.
875 		 */
876 		imc_global_refc.id = IMC_DOMAIN_CORE;
877 		imc_global_refc.refc++;
878 	} else {
879 		mutex_unlock(&imc_global_refc.lock);
880 		return -EBUSY;
881 	}
882 	mutex_unlock(&imc_global_refc.lock);
883 
884 	event->hw.event_base = (u64)pcmi->vbase + (config & IMC_EVENT_OFFSET_MASK);
885 	event->destroy = core_imc_counters_release;
886 	return 0;
887 }
888 
889 /*
890  * Allocates a page of memory for each of the online cpus, and load
891  * LDBAR with 0.
892  * The physical base address of the page allocated for a cpu will be
893  * written to the LDBAR for that cpu, when the thread-imc event
894  * is added.
895  *
896  * LDBAR Register Layout:
897  *
898  *  0          4         8         12        16        20        24        28
899  * | - - - - | - - - - | - - - - | - - - - | - - - - | - - - - | - - - - | - - - - |
900  *   | |       [   ]    [                   Counter Address [8:50]
901  *   | * Mode    |
902  *   |           * PB Scope
903  *   * Enable/Disable
904  *
905  *  32        36        40        44        48        52        56        60
906  * | - - - - | - - - - | - - - - | - - - - | - - - - | - - - - | - - - - | - - - - |
907  *           Counter Address [8:50]              ]
908  *
909  */
910 static int thread_imc_mem_alloc(int cpu_id, int size)
911 {
912 	u64 *local_mem = per_cpu(thread_imc_mem, cpu_id);
913 	int nid = cpu_to_node(cpu_id);
914 
915 	if (!local_mem) {
916 		struct page *page;
917 		/*
918 		 * This case could happen only once at start, since we dont
919 		 * free the memory in cpu offline path.
920 		 */
921 		page = alloc_pages_node(nid,
922 				  GFP_KERNEL | __GFP_ZERO | __GFP_THISNODE |
923 				  __GFP_NOWARN, get_order(size));
924 		if (!page)
925 			return -ENOMEM;
926 		local_mem = page_address(page);
927 
928 		per_cpu(thread_imc_mem, cpu_id) = local_mem;
929 	}
930 
931 	mtspr(SPRN_LDBAR, 0);
932 	return 0;
933 }
934 
935 static int ppc_thread_imc_cpu_online(unsigned int cpu)
936 {
937 	return thread_imc_mem_alloc(cpu, thread_imc_mem_size);
938 }
939 
940 static int ppc_thread_imc_cpu_offline(unsigned int cpu)
941 {
942 	/*
943 	 * Set the bit 0 of LDBAR to zero.
944 	 *
945 	 * If bit 0 of LDBAR is unset, it will stop posting
946 	 * the counter data to memory.
947 	 * For thread-imc, bit 0 of LDBAR will be set to 1 in the
948 	 * event_add function. So reset this bit here, to stop the updates
949 	 * to memory in the cpu_offline path.
950 	 */
951 	mtspr(SPRN_LDBAR, (mfspr(SPRN_LDBAR) & (~(1UL << 63))));
952 
953 	/* Reduce the refc if thread-imc event running on this cpu */
954 	mutex_lock(&imc_global_refc.lock);
955 	if (imc_global_refc.id == IMC_DOMAIN_THREAD)
956 		imc_global_refc.refc--;
957 	mutex_unlock(&imc_global_refc.lock);
958 
959 	return 0;
960 }
961 
962 static int thread_imc_cpu_init(void)
963 {
964 	return cpuhp_setup_state(CPUHP_AP_PERF_POWERPC_THREAD_IMC_ONLINE,
965 			  "perf/powerpc/imc_thread:online",
966 			  ppc_thread_imc_cpu_online,
967 			  ppc_thread_imc_cpu_offline);
968 }
969 
970 static int thread_imc_event_init(struct perf_event *event)
971 {
972 	u32 config = event->attr.config;
973 	struct task_struct *target;
974 	struct imc_pmu *pmu;
975 
976 	if (event->attr.type != event->pmu->type)
977 		return -ENOENT;
978 
979 	if (!perfmon_capable())
980 		return -EACCES;
981 
982 	/* Sampling not supported */
983 	if (event->hw.sample_period)
984 		return -EINVAL;
985 
986 	event->hw.idx = -1;
987 	pmu = imc_event_to_pmu(event);
988 
989 	/* Sanity check for config offset */
990 	if (((config & IMC_EVENT_OFFSET_MASK) > pmu->counter_mem_size))
991 		return -EINVAL;
992 
993 	target = event->hw.target;
994 	if (!target)
995 		return -EINVAL;
996 
997 	mutex_lock(&imc_global_refc.lock);
998 	/*
999 	 * Check if any other trace/core imc events are running in the
1000 	 * system, if not set the global id to thread-imc.
1001 	 */
1002 	if (imc_global_refc.id == 0 || imc_global_refc.id == IMC_DOMAIN_THREAD) {
1003 		imc_global_refc.id = IMC_DOMAIN_THREAD;
1004 		imc_global_refc.refc++;
1005 	} else {
1006 		mutex_unlock(&imc_global_refc.lock);
1007 		return -EBUSY;
1008 	}
1009 	mutex_unlock(&imc_global_refc.lock);
1010 
1011 	event->pmu->task_ctx_nr = perf_sw_context;
1012 	event->destroy = reset_global_refc;
1013 	return 0;
1014 }
1015 
1016 static bool is_thread_imc_pmu(struct perf_event *event)
1017 {
1018 	if (!strncmp(event->pmu->name, "thread_imc", strlen("thread_imc")))
1019 		return true;
1020 
1021 	return false;
1022 }
1023 
1024 static u64 * get_event_base_addr(struct perf_event *event)
1025 {
1026 	u64 addr;
1027 
1028 	if (is_thread_imc_pmu(event)) {
1029 		addr = (u64)per_cpu(thread_imc_mem, smp_processor_id());
1030 		return (u64 *)(addr + (event->attr.config & IMC_EVENT_OFFSET_MASK));
1031 	}
1032 
1033 	return (u64 *)event->hw.event_base;
1034 }
1035 
1036 static void thread_imc_pmu_start_txn(struct pmu *pmu,
1037 				     unsigned int txn_flags)
1038 {
1039 	if (txn_flags & ~PERF_PMU_TXN_ADD)
1040 		return;
1041 	perf_pmu_disable(pmu);
1042 }
1043 
1044 static void thread_imc_pmu_cancel_txn(struct pmu *pmu)
1045 {
1046 	perf_pmu_enable(pmu);
1047 }
1048 
1049 static int thread_imc_pmu_commit_txn(struct pmu *pmu)
1050 {
1051 	perf_pmu_enable(pmu);
1052 	return 0;
1053 }
1054 
1055 static u64 imc_read_counter(struct perf_event *event)
1056 {
1057 	u64 *addr, data;
1058 
1059 	/*
1060 	 * In-Memory Collection (IMC) counters are free flowing counters.
1061 	 * So we take a snapshot of the counter value on enable and save it
1062 	 * to calculate the delta at later stage to present the event counter
1063 	 * value.
1064 	 */
1065 	addr = get_event_base_addr(event);
1066 	data = be64_to_cpu(READ_ONCE(*addr));
1067 	local64_set(&event->hw.prev_count, data);
1068 
1069 	return data;
1070 }
1071 
1072 static void imc_event_update(struct perf_event *event)
1073 {
1074 	u64 counter_prev, counter_new, final_count;
1075 
1076 	counter_prev = local64_read(&event->hw.prev_count);
1077 	counter_new = imc_read_counter(event);
1078 	final_count = counter_new - counter_prev;
1079 
1080 	/* Update the delta to the event count */
1081 	local64_add(final_count, &event->count);
1082 }
1083 
1084 static void imc_event_start(struct perf_event *event, int flags)
1085 {
1086 	/*
1087 	 * In Memory Counters are free flowing counters. HW or the microcode
1088 	 * keeps adding to the counter offset in memory. To get event
1089 	 * counter value, we snapshot the value here and we calculate
1090 	 * delta at later point.
1091 	 */
1092 	imc_read_counter(event);
1093 }
1094 
1095 static void imc_event_stop(struct perf_event *event, int flags)
1096 {
1097 	/*
1098 	 * Take a snapshot and calculate the delta and update
1099 	 * the event counter values.
1100 	 */
1101 	imc_event_update(event);
1102 }
1103 
1104 static int imc_event_add(struct perf_event *event, int flags)
1105 {
1106 	if (flags & PERF_EF_START)
1107 		imc_event_start(event, flags);
1108 
1109 	return 0;
1110 }
1111 
1112 static int thread_imc_event_add(struct perf_event *event, int flags)
1113 {
1114 	int core_id;
1115 	struct imc_pmu_ref *ref;
1116 	u64 ldbar_value, *local_mem = per_cpu(thread_imc_mem, smp_processor_id());
1117 
1118 	if (flags & PERF_EF_START)
1119 		imc_event_start(event, flags);
1120 
1121 	if (!is_core_imc_mem_inited(smp_processor_id()))
1122 		return -EINVAL;
1123 
1124 	core_id = smp_processor_id() / threads_per_core;
1125 	ldbar_value = ((u64)local_mem & THREAD_IMC_LDBAR_MASK) | THREAD_IMC_ENABLE;
1126 	mtspr(SPRN_LDBAR, ldbar_value);
1127 
1128 	/*
1129 	 * imc pmus are enabled only when it is used.
1130 	 * See if this is triggered for the first time.
1131 	 * If yes, take the mutex lock and enable the counters.
1132 	 * If not, just increment the count in ref count struct.
1133 	 */
1134 	ref = &core_imc_refc[core_id];
1135 	if (!ref)
1136 		return -EINVAL;
1137 
1138 	mutex_lock(&ref->lock);
1139 	if (ref->refc == 0) {
1140 		if (opal_imc_counters_start(OPAL_IMC_COUNTERS_CORE,
1141 		    get_hard_smp_processor_id(smp_processor_id()))) {
1142 			mutex_unlock(&ref->lock);
1143 			pr_err("thread-imc: Unable to start the counter\
1144 				for core %d\n", core_id);
1145 			return -EINVAL;
1146 		}
1147 	}
1148 	++ref->refc;
1149 	mutex_unlock(&ref->lock);
1150 	return 0;
1151 }
1152 
1153 static void thread_imc_event_del(struct perf_event *event, int flags)
1154 {
1155 
1156 	int core_id;
1157 	struct imc_pmu_ref *ref;
1158 
1159 	core_id = smp_processor_id() / threads_per_core;
1160 	ref = &core_imc_refc[core_id];
1161 	if (!ref) {
1162 		pr_debug("imc: Failed to get event reference count\n");
1163 		return;
1164 	}
1165 
1166 	mutex_lock(&ref->lock);
1167 	ref->refc--;
1168 	if (ref->refc == 0) {
1169 		if (opal_imc_counters_stop(OPAL_IMC_COUNTERS_CORE,
1170 		    get_hard_smp_processor_id(smp_processor_id()))) {
1171 			mutex_unlock(&ref->lock);
1172 			pr_err("thread-imc: Unable to stop the counters\
1173 				for core %d\n", core_id);
1174 			return;
1175 		}
1176 	} else if (ref->refc < 0) {
1177 		ref->refc = 0;
1178 	}
1179 	mutex_unlock(&ref->lock);
1180 
1181 	/* Set bit 0 of LDBAR to zero, to stop posting updates to memory */
1182 	mtspr(SPRN_LDBAR, (mfspr(SPRN_LDBAR) & (~(1UL << 63))));
1183 
1184 	/*
1185 	 * Take a snapshot and calculate the delta and update
1186 	 * the event counter values.
1187 	 */
1188 	imc_event_update(event);
1189 }
1190 
1191 /*
1192  * Allocate a page of memory for each cpu, and load LDBAR with 0.
1193  */
1194 static int trace_imc_mem_alloc(int cpu_id, int size)
1195 {
1196 	u64 *local_mem = per_cpu(trace_imc_mem, cpu_id);
1197 	int phys_id = cpu_to_node(cpu_id), rc = 0;
1198 	int core_id = (cpu_id / threads_per_core);
1199 
1200 	if (!local_mem) {
1201 		struct page *page;
1202 
1203 		page = alloc_pages_node(phys_id,
1204 				GFP_KERNEL | __GFP_ZERO | __GFP_THISNODE |
1205 				__GFP_NOWARN, get_order(size));
1206 		if (!page)
1207 			return -ENOMEM;
1208 		local_mem = page_address(page);
1209 		per_cpu(trace_imc_mem, cpu_id) = local_mem;
1210 
1211 		/* Initialise the counters for trace mode */
1212 		rc = opal_imc_counters_init(OPAL_IMC_COUNTERS_TRACE, __pa((void *)local_mem),
1213 					    get_hard_smp_processor_id(cpu_id));
1214 		if (rc) {
1215 			pr_info("IMC:opal init failed for trace imc\n");
1216 			return rc;
1217 		}
1218 	}
1219 
1220 	/* Init the mutex, if not already */
1221 	trace_imc_refc[core_id].id = core_id;
1222 	mutex_init(&trace_imc_refc[core_id].lock);
1223 
1224 	mtspr(SPRN_LDBAR, 0);
1225 	return 0;
1226 }
1227 
1228 static int ppc_trace_imc_cpu_online(unsigned int cpu)
1229 {
1230 	return trace_imc_mem_alloc(cpu, trace_imc_mem_size);
1231 }
1232 
1233 static int ppc_trace_imc_cpu_offline(unsigned int cpu)
1234 {
1235 	/*
1236 	 * No need to set bit 0 of LDBAR to zero, as
1237 	 * it is set to zero for imc trace-mode
1238 	 *
1239 	 * Reduce the refc if any trace-imc event running
1240 	 * on this cpu.
1241 	 */
1242 	mutex_lock(&imc_global_refc.lock);
1243 	if (imc_global_refc.id == IMC_DOMAIN_TRACE)
1244 		imc_global_refc.refc--;
1245 	mutex_unlock(&imc_global_refc.lock);
1246 
1247 	return 0;
1248 }
1249 
1250 static int trace_imc_cpu_init(void)
1251 {
1252 	return cpuhp_setup_state(CPUHP_AP_PERF_POWERPC_TRACE_IMC_ONLINE,
1253 			  "perf/powerpc/imc_trace:online",
1254 			  ppc_trace_imc_cpu_online,
1255 			  ppc_trace_imc_cpu_offline);
1256 }
1257 
1258 static u64 get_trace_imc_event_base_addr(void)
1259 {
1260 	return (u64)per_cpu(trace_imc_mem, smp_processor_id());
1261 }
1262 
1263 /*
1264  * Function to parse trace-imc data obtained
1265  * and to prepare the perf sample.
1266  */
1267 static int trace_imc_prepare_sample(struct trace_imc_data *mem,
1268 				    struct perf_sample_data *data,
1269 				    u64 *prev_tb,
1270 				    struct perf_event_header *header,
1271 				    struct perf_event *event)
1272 {
1273 	/* Sanity checks for a valid record */
1274 	if (be64_to_cpu(READ_ONCE(mem->tb1)) > *prev_tb)
1275 		*prev_tb = be64_to_cpu(READ_ONCE(mem->tb1));
1276 	else
1277 		return -EINVAL;
1278 
1279 	if ((be64_to_cpu(READ_ONCE(mem->tb1)) & IMC_TRACE_RECORD_TB1_MASK) !=
1280 			 be64_to_cpu(READ_ONCE(mem->tb2)))
1281 		return -EINVAL;
1282 
1283 	/* Prepare perf sample */
1284 	data->ip =  be64_to_cpu(READ_ONCE(mem->ip));
1285 	data->period = event->hw.last_period;
1286 
1287 	header->type = PERF_RECORD_SAMPLE;
1288 	header->size = sizeof(*header) + event->header_size;
1289 	header->misc = 0;
1290 
1291 	if (is_kernel_addr(data->ip))
1292 		header->misc |= PERF_RECORD_MISC_KERNEL;
1293 	else
1294 		header->misc |= PERF_RECORD_MISC_USER;
1295 
1296 	perf_event_header__init_id(header, data, event);
1297 
1298 	return 0;
1299 }
1300 
1301 static void dump_trace_imc_data(struct perf_event *event)
1302 {
1303 	struct trace_imc_data *mem;
1304 	int i, ret;
1305 	u64 prev_tb = 0;
1306 
1307 	mem = (struct trace_imc_data *)get_trace_imc_event_base_addr();
1308 	for (i = 0; i < (trace_imc_mem_size / sizeof(struct trace_imc_data));
1309 		i++, mem++) {
1310 		struct perf_sample_data data;
1311 		struct perf_event_header header;
1312 
1313 		ret = trace_imc_prepare_sample(mem, &data, &prev_tb, &header, event);
1314 		if (ret) /* Exit, if not a valid record */
1315 			break;
1316 		else {
1317 			/* If this is a valid record, create the sample */
1318 			struct perf_output_handle handle;
1319 
1320 			if (perf_output_begin(&handle, event, header.size))
1321 				return;
1322 
1323 			perf_output_sample(&handle, &header, &data, event);
1324 			perf_output_end(&handle);
1325 		}
1326 	}
1327 }
1328 
1329 static int trace_imc_event_add(struct perf_event *event, int flags)
1330 {
1331 	int core_id = smp_processor_id() / threads_per_core;
1332 	struct imc_pmu_ref *ref = NULL;
1333 	u64 local_mem, ldbar_value;
1334 
1335 	/* Set trace-imc bit in ldbar and load ldbar with per-thread memory address */
1336 	local_mem = get_trace_imc_event_base_addr();
1337 	ldbar_value = ((u64)local_mem & THREAD_IMC_LDBAR_MASK) | TRACE_IMC_ENABLE;
1338 
1339 	/* trace-imc reference count */
1340 	if (trace_imc_refc)
1341 		ref = &trace_imc_refc[core_id];
1342 	if (!ref) {
1343 		pr_debug("imc: Failed to get the event reference count\n");
1344 		return -EINVAL;
1345 	}
1346 
1347 	mtspr(SPRN_LDBAR, ldbar_value);
1348 	mutex_lock(&ref->lock);
1349 	if (ref->refc == 0) {
1350 		if (opal_imc_counters_start(OPAL_IMC_COUNTERS_TRACE,
1351 				get_hard_smp_processor_id(smp_processor_id()))) {
1352 			mutex_unlock(&ref->lock);
1353 			pr_err("trace-imc: Unable to start the counters for core %d\n", core_id);
1354 			return -EINVAL;
1355 		}
1356 	}
1357 	++ref->refc;
1358 	mutex_unlock(&ref->lock);
1359 	return 0;
1360 }
1361 
1362 static void trace_imc_event_read(struct perf_event *event)
1363 {
1364 	return;
1365 }
1366 
1367 static void trace_imc_event_stop(struct perf_event *event, int flags)
1368 {
1369 	u64 local_mem = get_trace_imc_event_base_addr();
1370 	dump_trace_imc_data(event);
1371 	memset((void *)local_mem, 0, sizeof(u64));
1372 }
1373 
1374 static void trace_imc_event_start(struct perf_event *event, int flags)
1375 {
1376 	return;
1377 }
1378 
1379 static void trace_imc_event_del(struct perf_event *event, int flags)
1380 {
1381 	int core_id = smp_processor_id() / threads_per_core;
1382 	struct imc_pmu_ref *ref = NULL;
1383 
1384 	if (trace_imc_refc)
1385 		ref = &trace_imc_refc[core_id];
1386 	if (!ref) {
1387 		pr_debug("imc: Failed to get event reference count\n");
1388 		return;
1389 	}
1390 
1391 	mutex_lock(&ref->lock);
1392 	ref->refc--;
1393 	if (ref->refc == 0) {
1394 		if (opal_imc_counters_stop(OPAL_IMC_COUNTERS_TRACE,
1395 				get_hard_smp_processor_id(smp_processor_id()))) {
1396 			mutex_unlock(&ref->lock);
1397 			pr_err("trace-imc: Unable to stop the counters for core %d\n", core_id);
1398 			return;
1399 		}
1400 	} else if (ref->refc < 0) {
1401 		ref->refc = 0;
1402 	}
1403 	mutex_unlock(&ref->lock);
1404 
1405 	trace_imc_event_stop(event, flags);
1406 }
1407 
1408 static int trace_imc_event_init(struct perf_event *event)
1409 {
1410 	struct task_struct *target;
1411 
1412 	if (event->attr.type != event->pmu->type)
1413 		return -ENOENT;
1414 
1415 	if (!perfmon_capable())
1416 		return -EACCES;
1417 
1418 	/* Return if this is a couting event */
1419 	if (event->attr.sample_period == 0)
1420 		return -ENOENT;
1421 
1422 	/*
1423 	 * Take the global lock, and make sure
1424 	 * no other thread is running any core/thread imc
1425 	 * events
1426 	 */
1427 	mutex_lock(&imc_global_refc.lock);
1428 	if (imc_global_refc.id == 0 || imc_global_refc.id == IMC_DOMAIN_TRACE) {
1429 		/*
1430 		 * No core/thread imc events are running in the
1431 		 * system, so set the refc.id to trace-imc.
1432 		 */
1433 		imc_global_refc.id = IMC_DOMAIN_TRACE;
1434 		imc_global_refc.refc++;
1435 	} else {
1436 		mutex_unlock(&imc_global_refc.lock);
1437 		return -EBUSY;
1438 	}
1439 	mutex_unlock(&imc_global_refc.lock);
1440 
1441 	event->hw.idx = -1;
1442 	target = event->hw.target;
1443 
1444 	event->pmu->task_ctx_nr = perf_hw_context;
1445 	event->destroy = reset_global_refc;
1446 	return 0;
1447 }
1448 
1449 /* update_pmu_ops : Populate the appropriate operations for "pmu" */
1450 static int update_pmu_ops(struct imc_pmu *pmu)
1451 {
1452 	pmu->pmu.task_ctx_nr = perf_invalid_context;
1453 	pmu->pmu.add = imc_event_add;
1454 	pmu->pmu.del = imc_event_stop;
1455 	pmu->pmu.start = imc_event_start;
1456 	pmu->pmu.stop = imc_event_stop;
1457 	pmu->pmu.read = imc_event_update;
1458 	pmu->pmu.attr_groups = pmu->attr_groups;
1459 	pmu->pmu.capabilities = PERF_PMU_CAP_NO_EXCLUDE;
1460 	pmu->attr_groups[IMC_FORMAT_ATTR] = &imc_format_group;
1461 
1462 	switch (pmu->domain) {
1463 	case IMC_DOMAIN_NEST:
1464 		pmu->pmu.event_init = nest_imc_event_init;
1465 		pmu->attr_groups[IMC_CPUMASK_ATTR] = &imc_pmu_cpumask_attr_group;
1466 		break;
1467 	case IMC_DOMAIN_CORE:
1468 		pmu->pmu.event_init = core_imc_event_init;
1469 		pmu->attr_groups[IMC_CPUMASK_ATTR] = &imc_pmu_cpumask_attr_group;
1470 		break;
1471 	case IMC_DOMAIN_THREAD:
1472 		pmu->pmu.event_init = thread_imc_event_init;
1473 		pmu->pmu.add = thread_imc_event_add;
1474 		pmu->pmu.del = thread_imc_event_del;
1475 		pmu->pmu.start_txn = thread_imc_pmu_start_txn;
1476 		pmu->pmu.cancel_txn = thread_imc_pmu_cancel_txn;
1477 		pmu->pmu.commit_txn = thread_imc_pmu_commit_txn;
1478 		break;
1479 	case IMC_DOMAIN_TRACE:
1480 		pmu->pmu.event_init = trace_imc_event_init;
1481 		pmu->pmu.add = trace_imc_event_add;
1482 		pmu->pmu.del = trace_imc_event_del;
1483 		pmu->pmu.start = trace_imc_event_start;
1484 		pmu->pmu.stop = trace_imc_event_stop;
1485 		pmu->pmu.read = trace_imc_event_read;
1486 		pmu->attr_groups[IMC_FORMAT_ATTR] = &trace_imc_format_group;
1487 	default:
1488 		break;
1489 	}
1490 
1491 	return 0;
1492 }
1493 
1494 /* init_nest_pmu_ref: Initialize the imc_pmu_ref struct for all the nodes */
1495 static int init_nest_pmu_ref(void)
1496 {
1497 	int nid, i, cpu;
1498 
1499 	nest_imc_refc = kcalloc(num_possible_nodes(), sizeof(*nest_imc_refc),
1500 								GFP_KERNEL);
1501 
1502 	if (!nest_imc_refc)
1503 		return -ENOMEM;
1504 
1505 	i = 0;
1506 	for_each_node(nid) {
1507 		/*
1508 		 * Mutex lock to avoid races while tracking the number of
1509 		 * sessions using the chip's nest pmu units.
1510 		 */
1511 		mutex_init(&nest_imc_refc[i].lock);
1512 
1513 		/*
1514 		 * Loop to init the "id" with the node_id. Variable "i" initialized to
1515 		 * 0 and will be used as index to the array. "i" will not go off the
1516 		 * end of the array since the "for_each_node" loops for "N_POSSIBLE"
1517 		 * nodes only.
1518 		 */
1519 		nest_imc_refc[i++].id = nid;
1520 	}
1521 
1522 	/*
1523 	 * Loop to init the per_cpu "local_nest_imc_refc" with the proper
1524 	 * "nest_imc_refc" index. This makes get_nest_pmu_ref() alot simple.
1525 	 */
1526 	for_each_possible_cpu(cpu) {
1527 		nid = cpu_to_node(cpu);
1528 		for (i = 0; i < num_possible_nodes(); i++) {
1529 			if (nest_imc_refc[i].id == nid) {
1530 				per_cpu(local_nest_imc_refc, cpu) = &nest_imc_refc[i];
1531 				break;
1532 			}
1533 		}
1534 	}
1535 	return 0;
1536 }
1537 
1538 static void cleanup_all_core_imc_memory(void)
1539 {
1540 	int i, nr_cores = DIV_ROUND_UP(num_possible_cpus(), threads_per_core);
1541 	struct imc_mem_info *ptr = core_imc_pmu->mem_info;
1542 	int size = core_imc_pmu->counter_mem_size;
1543 
1544 	/* mem_info will never be NULL */
1545 	for (i = 0; i < nr_cores; i++) {
1546 		if (ptr[i].vbase)
1547 			free_pages((u64)ptr[i].vbase, get_order(size));
1548 	}
1549 
1550 	kfree(ptr);
1551 	kfree(core_imc_refc);
1552 }
1553 
1554 static void thread_imc_ldbar_disable(void *dummy)
1555 {
1556 	/*
1557 	 * By setting 0th bit of LDBAR to zero, we disable thread-imc
1558 	 * updates to memory.
1559 	 */
1560 	mtspr(SPRN_LDBAR, (mfspr(SPRN_LDBAR) & (~(1UL << 63))));
1561 }
1562 
1563 void thread_imc_disable(void)
1564 {
1565 	on_each_cpu(thread_imc_ldbar_disable, NULL, 1);
1566 }
1567 
1568 static void cleanup_all_thread_imc_memory(void)
1569 {
1570 	int i, order = get_order(thread_imc_mem_size);
1571 
1572 	for_each_online_cpu(i) {
1573 		if (per_cpu(thread_imc_mem, i))
1574 			free_pages((u64)per_cpu(thread_imc_mem, i), order);
1575 
1576 	}
1577 }
1578 
1579 static void cleanup_all_trace_imc_memory(void)
1580 {
1581 	int i, order = get_order(trace_imc_mem_size);
1582 
1583 	for_each_online_cpu(i) {
1584 		if (per_cpu(trace_imc_mem, i))
1585 			free_pages((u64)per_cpu(trace_imc_mem, i), order);
1586 
1587 	}
1588 	kfree(trace_imc_refc);
1589 }
1590 
1591 /* Function to free the attr_groups which are dynamically allocated */
1592 static void imc_common_mem_free(struct imc_pmu *pmu_ptr)
1593 {
1594 	if (pmu_ptr->attr_groups[IMC_EVENT_ATTR])
1595 		kfree(pmu_ptr->attr_groups[IMC_EVENT_ATTR]->attrs);
1596 	kfree(pmu_ptr->attr_groups[IMC_EVENT_ATTR]);
1597 }
1598 
1599 /*
1600  * Common function to unregister cpu hotplug callback and
1601  * free the memory.
1602  * TODO: Need to handle pmu unregistering, which will be
1603  * done in followup series.
1604  */
1605 static void imc_common_cpuhp_mem_free(struct imc_pmu *pmu_ptr)
1606 {
1607 	if (pmu_ptr->domain == IMC_DOMAIN_NEST) {
1608 		mutex_lock(&nest_init_lock);
1609 		if (nest_pmus == 1) {
1610 			cpuhp_remove_state(CPUHP_AP_PERF_POWERPC_NEST_IMC_ONLINE);
1611 			kfree(nest_imc_refc);
1612 			kfree(per_nest_pmu_arr);
1613 			per_nest_pmu_arr = NULL;
1614 		}
1615 
1616 		if (nest_pmus > 0)
1617 			nest_pmus--;
1618 		mutex_unlock(&nest_init_lock);
1619 	}
1620 
1621 	/* Free core_imc memory */
1622 	if (pmu_ptr->domain == IMC_DOMAIN_CORE) {
1623 		cpuhp_remove_state(CPUHP_AP_PERF_POWERPC_CORE_IMC_ONLINE);
1624 		cleanup_all_core_imc_memory();
1625 	}
1626 
1627 	/* Free thread_imc memory */
1628 	if (pmu_ptr->domain == IMC_DOMAIN_THREAD) {
1629 		cpuhp_remove_state(CPUHP_AP_PERF_POWERPC_THREAD_IMC_ONLINE);
1630 		cleanup_all_thread_imc_memory();
1631 	}
1632 
1633 	if (pmu_ptr->domain == IMC_DOMAIN_TRACE) {
1634 		cpuhp_remove_state(CPUHP_AP_PERF_POWERPC_TRACE_IMC_ONLINE);
1635 		cleanup_all_trace_imc_memory();
1636 	}
1637 }
1638 
1639 /*
1640  * Function to unregister thread-imc if core-imc
1641  * is not registered.
1642  */
1643 void unregister_thread_imc(void)
1644 {
1645 	imc_common_cpuhp_mem_free(thread_imc_pmu);
1646 	imc_common_mem_free(thread_imc_pmu);
1647 	perf_pmu_unregister(&thread_imc_pmu->pmu);
1648 }
1649 
1650 /*
1651  * imc_mem_init : Function to support memory allocation for core imc.
1652  */
1653 static int imc_mem_init(struct imc_pmu *pmu_ptr, struct device_node *parent,
1654 								int pmu_index)
1655 {
1656 	const char *s;
1657 	int nr_cores, cpu, res = -ENOMEM;
1658 
1659 	if (of_property_read_string(parent, "name", &s))
1660 		return -ENODEV;
1661 
1662 	switch (pmu_ptr->domain) {
1663 	case IMC_DOMAIN_NEST:
1664 		/* Update the pmu name */
1665 		pmu_ptr->pmu.name = kasprintf(GFP_KERNEL, "%s%s_imc", "nest_", s);
1666 		if (!pmu_ptr->pmu.name)
1667 			goto err;
1668 
1669 		/* Needed for hotplug/migration */
1670 		if (!per_nest_pmu_arr) {
1671 			per_nest_pmu_arr = kcalloc(get_max_nest_dev() + 1,
1672 						sizeof(struct imc_pmu *),
1673 						GFP_KERNEL);
1674 			if (!per_nest_pmu_arr)
1675 				goto err;
1676 		}
1677 		per_nest_pmu_arr[pmu_index] = pmu_ptr;
1678 		break;
1679 	case IMC_DOMAIN_CORE:
1680 		/* Update the pmu name */
1681 		pmu_ptr->pmu.name = kasprintf(GFP_KERNEL, "%s%s", s, "_imc");
1682 		if (!pmu_ptr->pmu.name)
1683 			goto err;
1684 
1685 		nr_cores = DIV_ROUND_UP(num_possible_cpus(), threads_per_core);
1686 		pmu_ptr->mem_info = kcalloc(nr_cores, sizeof(struct imc_mem_info),
1687 								GFP_KERNEL);
1688 
1689 		if (!pmu_ptr->mem_info)
1690 			goto err;
1691 
1692 		core_imc_refc = kcalloc(nr_cores, sizeof(struct imc_pmu_ref),
1693 								GFP_KERNEL);
1694 
1695 		if (!core_imc_refc) {
1696 			kfree(pmu_ptr->mem_info);
1697 			goto err;
1698 		}
1699 
1700 		core_imc_pmu = pmu_ptr;
1701 		break;
1702 	case IMC_DOMAIN_THREAD:
1703 		/* Update the pmu name */
1704 		pmu_ptr->pmu.name = kasprintf(GFP_KERNEL, "%s%s", s, "_imc");
1705 		if (!pmu_ptr->pmu.name)
1706 			goto err;
1707 
1708 		thread_imc_mem_size = pmu_ptr->counter_mem_size;
1709 		for_each_online_cpu(cpu) {
1710 			res = thread_imc_mem_alloc(cpu, pmu_ptr->counter_mem_size);
1711 			if (res) {
1712 				cleanup_all_thread_imc_memory();
1713 				goto err;
1714 			}
1715 		}
1716 
1717 		thread_imc_pmu = pmu_ptr;
1718 		break;
1719 	case IMC_DOMAIN_TRACE:
1720 		/* Update the pmu name */
1721 		pmu_ptr->pmu.name = kasprintf(GFP_KERNEL, "%s%s", s, "_imc");
1722 		if (!pmu_ptr->pmu.name)
1723 			return -ENOMEM;
1724 
1725 		nr_cores = DIV_ROUND_UP(num_possible_cpus(), threads_per_core);
1726 		trace_imc_refc = kcalloc(nr_cores, sizeof(struct imc_pmu_ref),
1727 								GFP_KERNEL);
1728 		if (!trace_imc_refc)
1729 			return -ENOMEM;
1730 
1731 		trace_imc_mem_size = pmu_ptr->counter_mem_size;
1732 		for_each_online_cpu(cpu) {
1733 			res = trace_imc_mem_alloc(cpu, trace_imc_mem_size);
1734 			if (res) {
1735 				cleanup_all_trace_imc_memory();
1736 				goto err;
1737 			}
1738 		}
1739 		break;
1740 	default:
1741 		return -EINVAL;
1742 	}
1743 
1744 	return 0;
1745 err:
1746 	return res;
1747 }
1748 
1749 /*
1750  * init_imc_pmu : Setup and register the IMC pmu device.
1751  *
1752  * @parent:	Device tree unit node
1753  * @pmu_ptr:	memory allocated for this pmu
1754  * @pmu_idx:	Count of nest pmc registered
1755  *
1756  * init_imc_pmu() setup pmu cpumask and registers for a cpu hotplug callback.
1757  * Handles failure cases and accordingly frees memory.
1758  */
1759 int init_imc_pmu(struct device_node *parent, struct imc_pmu *pmu_ptr, int pmu_idx)
1760 {
1761 	int ret;
1762 
1763 	ret = imc_mem_init(pmu_ptr, parent, pmu_idx);
1764 	if (ret)
1765 		goto err_free_mem;
1766 
1767 	switch (pmu_ptr->domain) {
1768 	case IMC_DOMAIN_NEST:
1769 		/*
1770 		* Nest imc pmu need only one cpu per chip, we initialize the
1771 		* cpumask for the first nest imc pmu and use the same for the
1772 		* rest. To handle the cpuhotplug callback unregister, we track
1773 		* the number of nest pmus in "nest_pmus".
1774 		*/
1775 		mutex_lock(&nest_init_lock);
1776 		if (nest_pmus == 0) {
1777 			ret = init_nest_pmu_ref();
1778 			if (ret) {
1779 				mutex_unlock(&nest_init_lock);
1780 				kfree(per_nest_pmu_arr);
1781 				per_nest_pmu_arr = NULL;
1782 				goto err_free_mem;
1783 			}
1784 			/* Register for cpu hotplug notification. */
1785 			ret = nest_pmu_cpumask_init();
1786 			if (ret) {
1787 				mutex_unlock(&nest_init_lock);
1788 				kfree(nest_imc_refc);
1789 				kfree(per_nest_pmu_arr);
1790 				per_nest_pmu_arr = NULL;
1791 				goto err_free_mem;
1792 			}
1793 		}
1794 		nest_pmus++;
1795 		mutex_unlock(&nest_init_lock);
1796 		break;
1797 	case IMC_DOMAIN_CORE:
1798 		ret = core_imc_pmu_cpumask_init();
1799 		if (ret) {
1800 			cleanup_all_core_imc_memory();
1801 			goto err_free_mem;
1802 		}
1803 
1804 		break;
1805 	case IMC_DOMAIN_THREAD:
1806 		ret = thread_imc_cpu_init();
1807 		if (ret) {
1808 			cleanup_all_thread_imc_memory();
1809 			goto err_free_mem;
1810 		}
1811 
1812 		break;
1813 	case IMC_DOMAIN_TRACE:
1814 		ret = trace_imc_cpu_init();
1815 		if (ret) {
1816 			cleanup_all_trace_imc_memory();
1817 			goto err_free_mem;
1818 		}
1819 
1820 		break;
1821 	default:
1822 		return  -EINVAL;	/* Unknown domain */
1823 	}
1824 
1825 	ret = update_events_in_group(parent, pmu_ptr);
1826 	if (ret)
1827 		goto err_free_cpuhp_mem;
1828 
1829 	ret = update_pmu_ops(pmu_ptr);
1830 	if (ret)
1831 		goto err_free_cpuhp_mem;
1832 
1833 	ret = perf_pmu_register(&pmu_ptr->pmu, pmu_ptr->pmu.name, -1);
1834 	if (ret)
1835 		goto err_free_cpuhp_mem;
1836 
1837 	pr_debug("%s performance monitor hardware support registered\n",
1838 							pmu_ptr->pmu.name);
1839 
1840 	return 0;
1841 
1842 err_free_cpuhp_mem:
1843 	imc_common_cpuhp_mem_free(pmu_ptr);
1844 err_free_mem:
1845 	imc_common_mem_free(pmu_ptr);
1846 	return ret;
1847 }
1848