xref: /openbmc/linux/arch/x86/events/intel/cstate.c (revision 1159e094)
16aec1ad7SBorislav Petkov /*
2940b2f2fSBorislav Petkov  * Support cstate residency counters
36aec1ad7SBorislav Petkov  *
46aec1ad7SBorislav Petkov  * Copyright (C) 2015, Intel Corp.
56aec1ad7SBorislav Petkov  * Author: Kan Liang (kan.liang@intel.com)
66aec1ad7SBorislav Petkov  *
76aec1ad7SBorislav Petkov  * This library is free software; you can redistribute it and/or
86aec1ad7SBorislav Petkov  * modify it under the terms of the GNU Library General Public
96aec1ad7SBorislav Petkov  * License as published by the Free Software Foundation; either
106aec1ad7SBorislav Petkov  * version 2 of the License, or (at your option) any later version.
116aec1ad7SBorislav Petkov  *
126aec1ad7SBorislav Petkov  * This library is distributed in the hope that it will be useful,
136aec1ad7SBorislav Petkov  * but WITHOUT ANY WARRANTY; without even the implied warranty of
146aec1ad7SBorislav Petkov  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
156aec1ad7SBorislav Petkov  * Library General Public License for more details.
166aec1ad7SBorislav Petkov  *
176aec1ad7SBorislav Petkov  */
186aec1ad7SBorislav Petkov 
196aec1ad7SBorislav Petkov /*
206aec1ad7SBorislav Petkov  * This file export cstate related free running (read-only) counters
216aec1ad7SBorislav Petkov  * for perf. These counters may be use simultaneously by other tools,
226aec1ad7SBorislav Petkov  * such as turbostat. However, it still make sense to implement them
236aec1ad7SBorislav Petkov  * in perf. Because we can conveniently collect them together with
246aec1ad7SBorislav Petkov  * other events, and allow to use them from tools without special MSR
256aec1ad7SBorislav Petkov  * access code.
266aec1ad7SBorislav Petkov  *
276aec1ad7SBorislav Petkov  * The events only support system-wide mode counting. There is no
286aec1ad7SBorislav Petkov  * sampling support because it is not supported by the hardware.
296aec1ad7SBorislav Petkov  *
306aec1ad7SBorislav Petkov  * According to counters' scope and category, two PMUs are registered
316aec1ad7SBorislav Petkov  * with the perf_event core subsystem.
326aec1ad7SBorislav Petkov  *  - 'cstate_core': The counter is available for each physical core.
336aec1ad7SBorislav Petkov  *    The counters include CORE_C*_RESIDENCY.
346aec1ad7SBorislav Petkov  *  - 'cstate_pkg': The counter is available for each physical package.
356aec1ad7SBorislav Petkov  *    The counters include PKG_C*_RESIDENCY.
366aec1ad7SBorislav Petkov  *
376aec1ad7SBorislav Petkov  * All of these counters are specified in the Intel® 64 and IA-32
386aec1ad7SBorislav Petkov  * Architectures Software Developer.s Manual Vol3b.
396aec1ad7SBorislav Petkov  *
406aec1ad7SBorislav Petkov  * Model specific counters:
416aec1ad7SBorislav Petkov  *	MSR_CORE_C1_RES: CORE C1 Residency Counter
426aec1ad7SBorislav Petkov  *			 perf code: 0x00
431159e094SHarry Pan  *			 Available model: SLM,AMT,GLM,CNL
446aec1ad7SBorislav Petkov  *			 Scope: Core (each processor core has a MSR)
456aec1ad7SBorislav Petkov  *	MSR_CORE_C3_RESIDENCY: CORE C3 Residency Counter
466aec1ad7SBorislav Petkov  *			       perf code: 0x01
471159e094SHarry Pan  *			       Available model: NHM,WSM,SNB,IVB,HSW,BDW,SKL,GLM,
481159e094SHarry Pan 						CNL
496aec1ad7SBorislav Petkov  *			       Scope: Core
506aec1ad7SBorislav Petkov  *	MSR_CORE_C6_RESIDENCY: CORE C6 Residency Counter
516aec1ad7SBorislav Petkov  *			       perf code: 0x02
521159e094SHarry Pan  *			       Available model: SLM,AMT,NHM,WSM,SNB,IVB,HSW,BDW,
531159e094SHarry Pan  *						SKL,KNL,GLM,CNL
546aec1ad7SBorislav Petkov  *			       Scope: Core
556aec1ad7SBorislav Petkov  *	MSR_CORE_C7_RESIDENCY: CORE C7 Residency Counter
566aec1ad7SBorislav Petkov  *			       perf code: 0x03
571159e094SHarry Pan  *			       Available model: SNB,IVB,HSW,BDW,SKL,CNL
586aec1ad7SBorislav Petkov  *			       Scope: Core
596aec1ad7SBorislav Petkov  *	MSR_PKG_C2_RESIDENCY:  Package C2 Residency Counter.
606aec1ad7SBorislav Petkov  *			       perf code: 0x00
611159e094SHarry Pan  *			       Available model: SNB,IVB,HSW,BDW,SKL,KNL,GLM,CNL
626aec1ad7SBorislav Petkov  *			       Scope: Package (physical package)
636aec1ad7SBorislav Petkov  *	MSR_PKG_C3_RESIDENCY:  Package C3 Residency Counter.
646aec1ad7SBorislav Petkov  *			       perf code: 0x01
651159e094SHarry Pan  *			       Available model: NHM,WSM,SNB,IVB,HSW,BDW,SKL,KNL,
661159e094SHarry Pan  *						GLM,CNL
676aec1ad7SBorislav Petkov  *			       Scope: Package (physical package)
686aec1ad7SBorislav Petkov  *	MSR_PKG_C6_RESIDENCY:  Package C6 Residency Counter.
696aec1ad7SBorislav Petkov  *			       perf code: 0x02
70889882bcSLukasz Odzioba  *			       Available model: SLM,AMT,NHM,WSM,SNB,IVB,HSW,BDW
711159e094SHarry Pan  *						SKL,KNL,GLM,CNL
726aec1ad7SBorislav Petkov  *			       Scope: Package (physical package)
736aec1ad7SBorislav Petkov  *	MSR_PKG_C7_RESIDENCY:  Package C7 Residency Counter.
746aec1ad7SBorislav Petkov  *			       perf code: 0x03
751159e094SHarry Pan  *			       Available model: NHM,WSM,SNB,IVB,HSW,BDW,SKL,CNL
766aec1ad7SBorislav Petkov  *			       Scope: Package (physical package)
776aec1ad7SBorislav Petkov  *	MSR_PKG_C8_RESIDENCY:  Package C8 Residency Counter.
786aec1ad7SBorislav Petkov  *			       perf code: 0x04
791159e094SHarry Pan  *			       Available model: HSW ULT,CNL
806aec1ad7SBorislav Petkov  *			       Scope: Package (physical package)
816aec1ad7SBorislav Petkov  *	MSR_PKG_C9_RESIDENCY:  Package C9 Residency Counter.
826aec1ad7SBorislav Petkov  *			       perf code: 0x05
831159e094SHarry Pan  *			       Available model: HSW ULT,CNL
846aec1ad7SBorislav Petkov  *			       Scope: Package (physical package)
856aec1ad7SBorislav Petkov  *	MSR_PKG_C10_RESIDENCY: Package C10 Residency Counter.
866aec1ad7SBorislav Petkov  *			       perf code: 0x06
871159e094SHarry Pan  *			       Available model: HSW ULT,GLM,CNL
886aec1ad7SBorislav Petkov  *			       Scope: Package (physical package)
896aec1ad7SBorislav Petkov  *
906aec1ad7SBorislav Petkov  */
916aec1ad7SBorislav Petkov 
926aec1ad7SBorislav Petkov #include <linux/module.h>
936aec1ad7SBorislav Petkov #include <linux/slab.h>
946aec1ad7SBorislav Petkov #include <linux/perf_event.h>
956aec1ad7SBorislav Petkov #include <asm/cpu_device_id.h>
96bf4ad541SDave Hansen #include <asm/intel-family.h>
9727f6d22bSBorislav Petkov #include "../perf_event.h"
986aec1ad7SBorislav Petkov 
99c7afba32SThomas Gleixner MODULE_LICENSE("GPL");
100c7afba32SThomas Gleixner 
1016aec1ad7SBorislav Petkov #define DEFINE_CSTATE_FORMAT_ATTR(_var, _name, _format)		\
1026aec1ad7SBorislav Petkov static ssize_t __cstate_##_var##_show(struct kobject *kobj,	\
1036aec1ad7SBorislav Petkov 				struct kobj_attribute *attr,	\
1046aec1ad7SBorislav Petkov 				char *page)			\
1056aec1ad7SBorislav Petkov {								\
1066aec1ad7SBorislav Petkov 	BUILD_BUG_ON(sizeof(_format) >= PAGE_SIZE);		\
1076aec1ad7SBorislav Petkov 	return sprintf(page, _format "\n");			\
1086aec1ad7SBorislav Petkov }								\
1096aec1ad7SBorislav Petkov static struct kobj_attribute format_attr_##_var =		\
1106aec1ad7SBorislav Petkov 	__ATTR(_name, 0444, __cstate_##_var##_show, NULL)
1116aec1ad7SBorislav Petkov 
1126aec1ad7SBorislav Petkov static ssize_t cstate_get_attr_cpumask(struct device *dev,
1136aec1ad7SBorislav Petkov 				       struct device_attribute *attr,
1146aec1ad7SBorislav Petkov 				       char *buf);
1156aec1ad7SBorislav Petkov 
116424646eeSThomas Gleixner /* Model -> events mapping */
117424646eeSThomas Gleixner struct cstate_model {
118424646eeSThomas Gleixner 	unsigned long		core_events;
119424646eeSThomas Gleixner 	unsigned long		pkg_events;
120424646eeSThomas Gleixner 	unsigned long		quirks;
121424646eeSThomas Gleixner };
122424646eeSThomas Gleixner 
123424646eeSThomas Gleixner /* Quirk flags */
124424646eeSThomas Gleixner #define SLM_PKG_C6_USE_C7_MSR	(1UL << 0)
125889882bcSLukasz Odzioba #define KNL_CORE_C6_MSR		(1UL << 1)
126424646eeSThomas Gleixner 
1276aec1ad7SBorislav Petkov struct perf_cstate_msr {
1286aec1ad7SBorislav Petkov 	u64	msr;
1296aec1ad7SBorislav Petkov 	struct	perf_pmu_events_attr *attr;
1306aec1ad7SBorislav Petkov };
1316aec1ad7SBorislav Petkov 
1326aec1ad7SBorislav Petkov 
1336aec1ad7SBorislav Petkov /* cstate_core PMU */
1346aec1ad7SBorislav Petkov static struct pmu cstate_core_pmu;
1356aec1ad7SBorislav Petkov static bool has_cstate_core;
1366aec1ad7SBorislav Petkov 
137424646eeSThomas Gleixner enum perf_cstate_core_events {
1386aec1ad7SBorislav Petkov 	PERF_CSTATE_CORE_C1_RES = 0,
1396aec1ad7SBorislav Petkov 	PERF_CSTATE_CORE_C3_RES,
1406aec1ad7SBorislav Petkov 	PERF_CSTATE_CORE_C6_RES,
1416aec1ad7SBorislav Petkov 	PERF_CSTATE_CORE_C7_RES,
1426aec1ad7SBorislav Petkov 
1436aec1ad7SBorislav Petkov 	PERF_CSTATE_CORE_EVENT_MAX,
1446aec1ad7SBorislav Petkov };
1456aec1ad7SBorislav Petkov 
1466aec1ad7SBorislav Petkov PMU_EVENT_ATTR_STRING(c1-residency, evattr_cstate_core_c1, "event=0x00");
1476aec1ad7SBorislav Petkov PMU_EVENT_ATTR_STRING(c3-residency, evattr_cstate_core_c3, "event=0x01");
1486aec1ad7SBorislav Petkov PMU_EVENT_ATTR_STRING(c6-residency, evattr_cstate_core_c6, "event=0x02");
1496aec1ad7SBorislav Petkov PMU_EVENT_ATTR_STRING(c7-residency, evattr_cstate_core_c7, "event=0x03");
1506aec1ad7SBorislav Petkov 
1516aec1ad7SBorislav Petkov static struct perf_cstate_msr core_msr[] = {
152424646eeSThomas Gleixner 	[PERF_CSTATE_CORE_C1_RES] = { MSR_CORE_C1_RES,		&evattr_cstate_core_c1 },
153424646eeSThomas Gleixner 	[PERF_CSTATE_CORE_C3_RES] = { MSR_CORE_C3_RESIDENCY,	&evattr_cstate_core_c3 },
154424646eeSThomas Gleixner 	[PERF_CSTATE_CORE_C6_RES] = { MSR_CORE_C6_RESIDENCY,	&evattr_cstate_core_c6 },
155424646eeSThomas Gleixner 	[PERF_CSTATE_CORE_C7_RES] = { MSR_CORE_C7_RESIDENCY,	&evattr_cstate_core_c7 },
1566aec1ad7SBorislav Petkov };
1576aec1ad7SBorislav Petkov 
1586aec1ad7SBorislav Petkov static struct attribute *core_events_attrs[PERF_CSTATE_CORE_EVENT_MAX + 1] = {
1596aec1ad7SBorislav Petkov 	NULL,
1606aec1ad7SBorislav Petkov };
1616aec1ad7SBorislav Petkov 
1626aec1ad7SBorislav Petkov static struct attribute_group core_events_attr_group = {
1636aec1ad7SBorislav Petkov 	.name = "events",
1646aec1ad7SBorislav Petkov 	.attrs = core_events_attrs,
1656aec1ad7SBorislav Petkov };
1666aec1ad7SBorislav Petkov 
1676aec1ad7SBorislav Petkov DEFINE_CSTATE_FORMAT_ATTR(core_event, event, "config:0-63");
1686aec1ad7SBorislav Petkov static struct attribute *core_format_attrs[] = {
1696aec1ad7SBorislav Petkov 	&format_attr_core_event.attr,
1706aec1ad7SBorislav Petkov 	NULL,
1716aec1ad7SBorislav Petkov };
1726aec1ad7SBorislav Petkov 
1736aec1ad7SBorislav Petkov static struct attribute_group core_format_attr_group = {
1746aec1ad7SBorislav Petkov 	.name = "format",
1756aec1ad7SBorislav Petkov 	.attrs = core_format_attrs,
1766aec1ad7SBorislav Petkov };
1776aec1ad7SBorislav Petkov 
1786aec1ad7SBorislav Petkov static cpumask_t cstate_core_cpu_mask;
1796aec1ad7SBorislav Petkov static DEVICE_ATTR(cpumask, S_IRUGO, cstate_get_attr_cpumask, NULL);
1806aec1ad7SBorislav Petkov 
1816aec1ad7SBorislav Petkov static struct attribute *cstate_cpumask_attrs[] = {
1826aec1ad7SBorislav Petkov 	&dev_attr_cpumask.attr,
1836aec1ad7SBorislav Petkov 	NULL,
1846aec1ad7SBorislav Petkov };
1856aec1ad7SBorislav Petkov 
1866aec1ad7SBorislav Petkov static struct attribute_group cpumask_attr_group = {
1876aec1ad7SBorislav Petkov 	.attrs = cstate_cpumask_attrs,
1886aec1ad7SBorislav Petkov };
1896aec1ad7SBorislav Petkov 
1906aec1ad7SBorislav Petkov static const struct attribute_group *core_attr_groups[] = {
1916aec1ad7SBorislav Petkov 	&core_events_attr_group,
1926aec1ad7SBorislav Petkov 	&core_format_attr_group,
1936aec1ad7SBorislav Petkov 	&cpumask_attr_group,
1946aec1ad7SBorislav Petkov 	NULL,
1956aec1ad7SBorislav Petkov };
1966aec1ad7SBorislav Petkov 
1976aec1ad7SBorislav Petkov /* cstate_pkg PMU */
1986aec1ad7SBorislav Petkov static struct pmu cstate_pkg_pmu;
1996aec1ad7SBorislav Petkov static bool has_cstate_pkg;
2006aec1ad7SBorislav Petkov 
201424646eeSThomas Gleixner enum perf_cstate_pkg_events {
2026aec1ad7SBorislav Petkov 	PERF_CSTATE_PKG_C2_RES = 0,
2036aec1ad7SBorislav Petkov 	PERF_CSTATE_PKG_C3_RES,
2046aec1ad7SBorislav Petkov 	PERF_CSTATE_PKG_C6_RES,
2056aec1ad7SBorislav Petkov 	PERF_CSTATE_PKG_C7_RES,
2066aec1ad7SBorislav Petkov 	PERF_CSTATE_PKG_C8_RES,
2076aec1ad7SBorislav Petkov 	PERF_CSTATE_PKG_C9_RES,
2086aec1ad7SBorislav Petkov 	PERF_CSTATE_PKG_C10_RES,
2096aec1ad7SBorislav Petkov 
2106aec1ad7SBorislav Petkov 	PERF_CSTATE_PKG_EVENT_MAX,
2116aec1ad7SBorislav Petkov };
2126aec1ad7SBorislav Petkov 
2136aec1ad7SBorislav Petkov PMU_EVENT_ATTR_STRING(c2-residency, evattr_cstate_pkg_c2, "event=0x00");
2146aec1ad7SBorislav Petkov PMU_EVENT_ATTR_STRING(c3-residency, evattr_cstate_pkg_c3, "event=0x01");
2156aec1ad7SBorislav Petkov PMU_EVENT_ATTR_STRING(c6-residency, evattr_cstate_pkg_c6, "event=0x02");
2166aec1ad7SBorislav Petkov PMU_EVENT_ATTR_STRING(c7-residency, evattr_cstate_pkg_c7, "event=0x03");
2176aec1ad7SBorislav Petkov PMU_EVENT_ATTR_STRING(c8-residency, evattr_cstate_pkg_c8, "event=0x04");
2186aec1ad7SBorislav Petkov PMU_EVENT_ATTR_STRING(c9-residency, evattr_cstate_pkg_c9, "event=0x05");
2196aec1ad7SBorislav Petkov PMU_EVENT_ATTR_STRING(c10-residency, evattr_cstate_pkg_c10, "event=0x06");
2206aec1ad7SBorislav Petkov 
2216aec1ad7SBorislav Petkov static struct perf_cstate_msr pkg_msr[] = {
222424646eeSThomas Gleixner 	[PERF_CSTATE_PKG_C2_RES] = { MSR_PKG_C2_RESIDENCY,	&evattr_cstate_pkg_c2 },
223424646eeSThomas Gleixner 	[PERF_CSTATE_PKG_C3_RES] = { MSR_PKG_C3_RESIDENCY,	&evattr_cstate_pkg_c3 },
224424646eeSThomas Gleixner 	[PERF_CSTATE_PKG_C6_RES] = { MSR_PKG_C6_RESIDENCY,	&evattr_cstate_pkg_c6 },
225424646eeSThomas Gleixner 	[PERF_CSTATE_PKG_C7_RES] = { MSR_PKG_C7_RESIDENCY,	&evattr_cstate_pkg_c7 },
226424646eeSThomas Gleixner 	[PERF_CSTATE_PKG_C8_RES] = { MSR_PKG_C8_RESIDENCY,	&evattr_cstate_pkg_c8 },
227424646eeSThomas Gleixner 	[PERF_CSTATE_PKG_C9_RES] = { MSR_PKG_C9_RESIDENCY,	&evattr_cstate_pkg_c9 },
228424646eeSThomas Gleixner 	[PERF_CSTATE_PKG_C10_RES] = { MSR_PKG_C10_RESIDENCY,	&evattr_cstate_pkg_c10 },
2296aec1ad7SBorislav Petkov };
2306aec1ad7SBorislav Petkov 
2316aec1ad7SBorislav Petkov static struct attribute *pkg_events_attrs[PERF_CSTATE_PKG_EVENT_MAX + 1] = {
2326aec1ad7SBorislav Petkov 	NULL,
2336aec1ad7SBorislav Petkov };
2346aec1ad7SBorislav Petkov 
2356aec1ad7SBorislav Petkov static struct attribute_group pkg_events_attr_group = {
2366aec1ad7SBorislav Petkov 	.name = "events",
2376aec1ad7SBorislav Petkov 	.attrs = pkg_events_attrs,
2386aec1ad7SBorislav Petkov };
2396aec1ad7SBorislav Petkov 
2406aec1ad7SBorislav Petkov DEFINE_CSTATE_FORMAT_ATTR(pkg_event, event, "config:0-63");
2416aec1ad7SBorislav Petkov static struct attribute *pkg_format_attrs[] = {
2426aec1ad7SBorislav Petkov 	&format_attr_pkg_event.attr,
2436aec1ad7SBorislav Petkov 	NULL,
2446aec1ad7SBorislav Petkov };
2456aec1ad7SBorislav Petkov static struct attribute_group pkg_format_attr_group = {
2466aec1ad7SBorislav Petkov 	.name = "format",
2476aec1ad7SBorislav Petkov 	.attrs = pkg_format_attrs,
2486aec1ad7SBorislav Petkov };
2496aec1ad7SBorislav Petkov 
2506aec1ad7SBorislav Petkov static cpumask_t cstate_pkg_cpu_mask;
2516aec1ad7SBorislav Petkov 
2526aec1ad7SBorislav Petkov static const struct attribute_group *pkg_attr_groups[] = {
2536aec1ad7SBorislav Petkov 	&pkg_events_attr_group,
2546aec1ad7SBorislav Petkov 	&pkg_format_attr_group,
2556aec1ad7SBorislav Petkov 	&cpumask_attr_group,
2566aec1ad7SBorislav Petkov 	NULL,
2576aec1ad7SBorislav Petkov };
2586aec1ad7SBorislav Petkov 
2596aec1ad7SBorislav Petkov static ssize_t cstate_get_attr_cpumask(struct device *dev,
2606aec1ad7SBorislav Petkov 				       struct device_attribute *attr,
2616aec1ad7SBorislav Petkov 				       char *buf)
2626aec1ad7SBorislav Petkov {
2636aec1ad7SBorislav Petkov 	struct pmu *pmu = dev_get_drvdata(dev);
2646aec1ad7SBorislav Petkov 
2656aec1ad7SBorislav Petkov 	if (pmu == &cstate_core_pmu)
2666aec1ad7SBorislav Petkov 		return cpumap_print_to_pagebuf(true, buf, &cstate_core_cpu_mask);
2676aec1ad7SBorislav Petkov 	else if (pmu == &cstate_pkg_pmu)
2686aec1ad7SBorislav Petkov 		return cpumap_print_to_pagebuf(true, buf, &cstate_pkg_cpu_mask);
2696aec1ad7SBorislav Petkov 	else
2706aec1ad7SBorislav Petkov 		return 0;
2716aec1ad7SBorislav Petkov }
2726aec1ad7SBorislav Petkov 
2736aec1ad7SBorislav Petkov static int cstate_pmu_event_init(struct perf_event *event)
2746aec1ad7SBorislav Petkov {
2756aec1ad7SBorislav Petkov 	u64 cfg = event->attr.config;
27649de0493SThomas Gleixner 	int cpu;
2776aec1ad7SBorislav Petkov 
2786aec1ad7SBorislav Petkov 	if (event->attr.type != event->pmu->type)
2796aec1ad7SBorislav Petkov 		return -ENOENT;
2806aec1ad7SBorislav Petkov 
2816aec1ad7SBorislav Petkov 	/* unsupported modes and filters */
2826aec1ad7SBorislav Petkov 	if (event->attr.exclude_user   ||
2836aec1ad7SBorislav Petkov 	    event->attr.exclude_kernel ||
2846aec1ad7SBorislav Petkov 	    event->attr.exclude_hv     ||
2856aec1ad7SBorislav Petkov 	    event->attr.exclude_idle   ||
2866aec1ad7SBorislav Petkov 	    event->attr.exclude_host   ||
2876aec1ad7SBorislav Petkov 	    event->attr.exclude_guest  ||
2886aec1ad7SBorislav Petkov 	    event->attr.sample_period) /* no sampling */
2896aec1ad7SBorislav Petkov 		return -EINVAL;
2906aec1ad7SBorislav Petkov 
29149de0493SThomas Gleixner 	if (event->cpu < 0)
29249de0493SThomas Gleixner 		return -EINVAL;
29349de0493SThomas Gleixner 
2946aec1ad7SBorislav Petkov 	if (event->pmu == &cstate_core_pmu) {
2956aec1ad7SBorislav Petkov 		if (cfg >= PERF_CSTATE_CORE_EVENT_MAX)
2966aec1ad7SBorislav Petkov 			return -EINVAL;
2976aec1ad7SBorislav Petkov 		if (!core_msr[cfg].attr)
2986aec1ad7SBorislav Petkov 			return -EINVAL;
2996aec1ad7SBorislav Petkov 		event->hw.event_base = core_msr[cfg].msr;
30049de0493SThomas Gleixner 		cpu = cpumask_any_and(&cstate_core_cpu_mask,
30149de0493SThomas Gleixner 				      topology_sibling_cpumask(event->cpu));
3026aec1ad7SBorislav Petkov 	} else if (event->pmu == &cstate_pkg_pmu) {
3036aec1ad7SBorislav Petkov 		if (cfg >= PERF_CSTATE_PKG_EVENT_MAX)
3046aec1ad7SBorislav Petkov 			return -EINVAL;
3056aec1ad7SBorislav Petkov 		if (!pkg_msr[cfg].attr)
3066aec1ad7SBorislav Petkov 			return -EINVAL;
3076aec1ad7SBorislav Petkov 		event->hw.event_base = pkg_msr[cfg].msr;
30849de0493SThomas Gleixner 		cpu = cpumask_any_and(&cstate_pkg_cpu_mask,
30949de0493SThomas Gleixner 				      topology_core_cpumask(event->cpu));
31049de0493SThomas Gleixner 	} else {
3116aec1ad7SBorislav Petkov 		return -ENOENT;
31249de0493SThomas Gleixner 	}
3136aec1ad7SBorislav Petkov 
31449de0493SThomas Gleixner 	if (cpu >= nr_cpu_ids)
31549de0493SThomas Gleixner 		return -ENODEV;
31649de0493SThomas Gleixner 
31749de0493SThomas Gleixner 	event->cpu = cpu;
3186aec1ad7SBorislav Petkov 	event->hw.config = cfg;
3196aec1ad7SBorislav Petkov 	event->hw.idx = -1;
32049de0493SThomas Gleixner 	return 0;
3216aec1ad7SBorislav Petkov }
3226aec1ad7SBorislav Petkov 
3236aec1ad7SBorislav Petkov static inline u64 cstate_pmu_read_counter(struct perf_event *event)
3246aec1ad7SBorislav Petkov {
3256aec1ad7SBorislav Petkov 	u64 val;
3266aec1ad7SBorislav Petkov 
3276aec1ad7SBorislav Petkov 	rdmsrl(event->hw.event_base, val);
3286aec1ad7SBorislav Petkov 	return val;
3296aec1ad7SBorislav Petkov }
3306aec1ad7SBorislav Petkov 
3316aec1ad7SBorislav Petkov static void cstate_pmu_event_update(struct perf_event *event)
3326aec1ad7SBorislav Petkov {
3336aec1ad7SBorislav Petkov 	struct hw_perf_event *hwc = &event->hw;
3346aec1ad7SBorislav Petkov 	u64 prev_raw_count, new_raw_count;
3356aec1ad7SBorislav Petkov 
3366aec1ad7SBorislav Petkov again:
3376aec1ad7SBorislav Petkov 	prev_raw_count = local64_read(&hwc->prev_count);
3386aec1ad7SBorislav Petkov 	new_raw_count = cstate_pmu_read_counter(event);
3396aec1ad7SBorislav Petkov 
3406aec1ad7SBorislav Petkov 	if (local64_cmpxchg(&hwc->prev_count, prev_raw_count,
3416aec1ad7SBorislav Petkov 			    new_raw_count) != prev_raw_count)
3426aec1ad7SBorislav Petkov 		goto again;
3436aec1ad7SBorislav Petkov 
3446aec1ad7SBorislav Petkov 	local64_add(new_raw_count - prev_raw_count, &event->count);
3456aec1ad7SBorislav Petkov }
3466aec1ad7SBorislav Petkov 
3476aec1ad7SBorislav Petkov static void cstate_pmu_event_start(struct perf_event *event, int mode)
3486aec1ad7SBorislav Petkov {
3496aec1ad7SBorislav Petkov 	local64_set(&event->hw.prev_count, cstate_pmu_read_counter(event));
3506aec1ad7SBorislav Petkov }
3516aec1ad7SBorislav Petkov 
3526aec1ad7SBorislav Petkov static void cstate_pmu_event_stop(struct perf_event *event, int mode)
3536aec1ad7SBorislav Petkov {
3546aec1ad7SBorislav Petkov 	cstate_pmu_event_update(event);
3556aec1ad7SBorislav Petkov }
3566aec1ad7SBorislav Petkov 
3576aec1ad7SBorislav Petkov static void cstate_pmu_event_del(struct perf_event *event, int mode)
3586aec1ad7SBorislav Petkov {
3596aec1ad7SBorislav Petkov 	cstate_pmu_event_stop(event, PERF_EF_UPDATE);
3606aec1ad7SBorislav Petkov }
3616aec1ad7SBorislav Petkov 
3626aec1ad7SBorislav Petkov static int cstate_pmu_event_add(struct perf_event *event, int mode)
3636aec1ad7SBorislav Petkov {
3646aec1ad7SBorislav Petkov 	if (mode & PERF_EF_START)
3656aec1ad7SBorislav Petkov 		cstate_pmu_event_start(event, mode);
3666aec1ad7SBorislav Petkov 
3676aec1ad7SBorislav Petkov 	return 0;
3686aec1ad7SBorislav Petkov }
3696aec1ad7SBorislav Petkov 
37049de0493SThomas Gleixner /*
37149de0493SThomas Gleixner  * Check if exiting cpu is the designated reader. If so migrate the
37249de0493SThomas Gleixner  * events when there is a valid target available
37349de0493SThomas Gleixner  */
37477c34ef1SSebastian Andrzej Siewior static int cstate_cpu_exit(unsigned int cpu)
3756aec1ad7SBorislav Petkov {
37649de0493SThomas Gleixner 	unsigned int target;
3776aec1ad7SBorislav Petkov 
37849de0493SThomas Gleixner 	if (has_cstate_core &&
37949de0493SThomas Gleixner 	    cpumask_test_and_clear_cpu(cpu, &cstate_core_cpu_mask)) {
3806aec1ad7SBorislav Petkov 
38149de0493SThomas Gleixner 		target = cpumask_any_but(topology_sibling_cpumask(cpu), cpu);
38249de0493SThomas Gleixner 		/* Migrate events if there is a valid target */
38349de0493SThomas Gleixner 		if (target < nr_cpu_ids) {
3846aec1ad7SBorislav Petkov 			cpumask_set_cpu(target, &cstate_core_cpu_mask);
3856aec1ad7SBorislav Petkov 			perf_pmu_migrate_context(&cstate_core_pmu, cpu, target);
3866aec1ad7SBorislav Petkov 		}
3876aec1ad7SBorislav Petkov 	}
38849de0493SThomas Gleixner 
38949de0493SThomas Gleixner 	if (has_cstate_pkg &&
39049de0493SThomas Gleixner 	    cpumask_test_and_clear_cpu(cpu, &cstate_pkg_cpu_mask)) {
39149de0493SThomas Gleixner 
39249de0493SThomas Gleixner 		target = cpumask_any_but(topology_core_cpumask(cpu), cpu);
39349de0493SThomas Gleixner 		/* Migrate events if there is a valid target */
39449de0493SThomas Gleixner 		if (target < nr_cpu_ids) {
3956aec1ad7SBorislav Petkov 			cpumask_set_cpu(target, &cstate_pkg_cpu_mask);
3966aec1ad7SBorislav Petkov 			perf_pmu_migrate_context(&cstate_pkg_pmu, cpu, target);
3976aec1ad7SBorislav Petkov 		}
3986aec1ad7SBorislav Petkov 	}
39977c34ef1SSebastian Andrzej Siewior 	return 0;
40049de0493SThomas Gleixner }
4016aec1ad7SBorislav Petkov 
40277c34ef1SSebastian Andrzej Siewior static int cstate_cpu_init(unsigned int cpu)
4036aec1ad7SBorislav Petkov {
40449de0493SThomas Gleixner 	unsigned int target;
4056aec1ad7SBorislav Petkov 
40649de0493SThomas Gleixner 	/*
40749de0493SThomas Gleixner 	 * If this is the first online thread of that core, set it in
40849de0493SThomas Gleixner 	 * the core cpu mask as the designated reader.
40949de0493SThomas Gleixner 	 */
41049de0493SThomas Gleixner 	target = cpumask_any_and(&cstate_core_cpu_mask,
41149de0493SThomas Gleixner 				 topology_sibling_cpumask(cpu));
41249de0493SThomas Gleixner 
41349de0493SThomas Gleixner 	if (has_cstate_core && target >= nr_cpu_ids)
4146aec1ad7SBorislav Petkov 		cpumask_set_cpu(cpu, &cstate_core_cpu_mask);
4156aec1ad7SBorislav Petkov 
41649de0493SThomas Gleixner 	/*
41749de0493SThomas Gleixner 	 * If this is the first online thread of that package, set it
41849de0493SThomas Gleixner 	 * in the package cpu mask as the designated reader.
41949de0493SThomas Gleixner 	 */
42049de0493SThomas Gleixner 	target = cpumask_any_and(&cstate_pkg_cpu_mask,
42149de0493SThomas Gleixner 				 topology_core_cpumask(cpu));
42249de0493SThomas Gleixner 	if (has_cstate_pkg && target >= nr_cpu_ids)
4236aec1ad7SBorislav Petkov 		cpumask_set_cpu(cpu, &cstate_pkg_cpu_mask);
4246aec1ad7SBorislav Petkov 
42577c34ef1SSebastian Andrzej Siewior 	return 0;
4266aec1ad7SBorislav Petkov }
427c7afba32SThomas Gleixner 
428424646eeSThomas Gleixner static struct pmu cstate_core_pmu = {
429424646eeSThomas Gleixner 	.attr_groups	= core_attr_groups,
430424646eeSThomas Gleixner 	.name		= "cstate_core",
431424646eeSThomas Gleixner 	.task_ctx_nr	= perf_invalid_context,
432424646eeSThomas Gleixner 	.event_init	= cstate_pmu_event_init,
433424646eeSThomas Gleixner 	.add		= cstate_pmu_event_add,
434424646eeSThomas Gleixner 	.del		= cstate_pmu_event_del,
435424646eeSThomas Gleixner 	.start		= cstate_pmu_event_start,
436424646eeSThomas Gleixner 	.stop		= cstate_pmu_event_stop,
437424646eeSThomas Gleixner 	.read		= cstate_pmu_event_update,
438424646eeSThomas Gleixner 	.capabilities	= PERF_PMU_CAP_NO_INTERRUPT,
43974545f63SDavid Carrillo-Cisneros 	.module		= THIS_MODULE,
440424646eeSThomas Gleixner };
441424646eeSThomas Gleixner 
442424646eeSThomas Gleixner static struct pmu cstate_pkg_pmu = {
443424646eeSThomas Gleixner 	.attr_groups	= pkg_attr_groups,
444424646eeSThomas Gleixner 	.name		= "cstate_pkg",
445424646eeSThomas Gleixner 	.task_ctx_nr	= perf_invalid_context,
446424646eeSThomas Gleixner 	.event_init	= cstate_pmu_event_init,
447424646eeSThomas Gleixner 	.add		= cstate_pmu_event_add,
448424646eeSThomas Gleixner 	.del		= cstate_pmu_event_del,
449424646eeSThomas Gleixner 	.start		= cstate_pmu_event_start,
450424646eeSThomas Gleixner 	.stop		= cstate_pmu_event_stop,
451424646eeSThomas Gleixner 	.read		= cstate_pmu_event_update,
452424646eeSThomas Gleixner 	.capabilities	= PERF_PMU_CAP_NO_INTERRUPT,
45374545f63SDavid Carrillo-Cisneros 	.module		= THIS_MODULE,
454424646eeSThomas Gleixner };
455424646eeSThomas Gleixner 
456424646eeSThomas Gleixner static const struct cstate_model nhm_cstates __initconst = {
457424646eeSThomas Gleixner 	.core_events		= BIT(PERF_CSTATE_CORE_C3_RES) |
458424646eeSThomas Gleixner 				  BIT(PERF_CSTATE_CORE_C6_RES),
459424646eeSThomas Gleixner 
460424646eeSThomas Gleixner 	.pkg_events		= BIT(PERF_CSTATE_PKG_C3_RES) |
461424646eeSThomas Gleixner 				  BIT(PERF_CSTATE_PKG_C6_RES) |
462424646eeSThomas Gleixner 				  BIT(PERF_CSTATE_PKG_C7_RES),
463424646eeSThomas Gleixner };
464424646eeSThomas Gleixner 
465424646eeSThomas Gleixner static const struct cstate_model snb_cstates __initconst = {
466424646eeSThomas Gleixner 	.core_events		= BIT(PERF_CSTATE_CORE_C3_RES) |
467424646eeSThomas Gleixner 				  BIT(PERF_CSTATE_CORE_C6_RES) |
468424646eeSThomas Gleixner 				  BIT(PERF_CSTATE_CORE_C7_RES),
469424646eeSThomas Gleixner 
470424646eeSThomas Gleixner 	.pkg_events		= BIT(PERF_CSTATE_PKG_C2_RES) |
471424646eeSThomas Gleixner 				  BIT(PERF_CSTATE_PKG_C3_RES) |
472424646eeSThomas Gleixner 				  BIT(PERF_CSTATE_PKG_C6_RES) |
473424646eeSThomas Gleixner 				  BIT(PERF_CSTATE_PKG_C7_RES),
474424646eeSThomas Gleixner };
475424646eeSThomas Gleixner 
476424646eeSThomas Gleixner static const struct cstate_model hswult_cstates __initconst = {
477424646eeSThomas Gleixner 	.core_events		= BIT(PERF_CSTATE_CORE_C3_RES) |
478424646eeSThomas Gleixner 				  BIT(PERF_CSTATE_CORE_C6_RES) |
479424646eeSThomas Gleixner 				  BIT(PERF_CSTATE_CORE_C7_RES),
480424646eeSThomas Gleixner 
481424646eeSThomas Gleixner 	.pkg_events		= BIT(PERF_CSTATE_PKG_C2_RES) |
482424646eeSThomas Gleixner 				  BIT(PERF_CSTATE_PKG_C3_RES) |
483424646eeSThomas Gleixner 				  BIT(PERF_CSTATE_PKG_C6_RES) |
484424646eeSThomas Gleixner 				  BIT(PERF_CSTATE_PKG_C7_RES) |
485424646eeSThomas Gleixner 				  BIT(PERF_CSTATE_PKG_C8_RES) |
486424646eeSThomas Gleixner 				  BIT(PERF_CSTATE_PKG_C9_RES) |
487424646eeSThomas Gleixner 				  BIT(PERF_CSTATE_PKG_C10_RES),
488424646eeSThomas Gleixner };
489424646eeSThomas Gleixner 
4901159e094SHarry Pan static const struct cstate_model cnl_cstates __initconst = {
4911159e094SHarry Pan 	.core_events		= BIT(PERF_CSTATE_CORE_C1_RES) |
4921159e094SHarry Pan 				  BIT(PERF_CSTATE_CORE_C3_RES) |
4931159e094SHarry Pan 				  BIT(PERF_CSTATE_CORE_C6_RES) |
4941159e094SHarry Pan 				  BIT(PERF_CSTATE_CORE_C7_RES),
4951159e094SHarry Pan 
4961159e094SHarry Pan 	.pkg_events		= BIT(PERF_CSTATE_PKG_C2_RES) |
4971159e094SHarry Pan 				  BIT(PERF_CSTATE_PKG_C3_RES) |
4981159e094SHarry Pan 				  BIT(PERF_CSTATE_PKG_C6_RES) |
4991159e094SHarry Pan 				  BIT(PERF_CSTATE_PKG_C7_RES) |
5001159e094SHarry Pan 				  BIT(PERF_CSTATE_PKG_C8_RES) |
5011159e094SHarry Pan 				  BIT(PERF_CSTATE_PKG_C9_RES) |
5021159e094SHarry Pan 				  BIT(PERF_CSTATE_PKG_C10_RES),
5031159e094SHarry Pan };
5041159e094SHarry Pan 
505424646eeSThomas Gleixner static const struct cstate_model slm_cstates __initconst = {
506424646eeSThomas Gleixner 	.core_events		= BIT(PERF_CSTATE_CORE_C1_RES) |
507424646eeSThomas Gleixner 				  BIT(PERF_CSTATE_CORE_C6_RES),
508424646eeSThomas Gleixner 
509424646eeSThomas Gleixner 	.pkg_events		= BIT(PERF_CSTATE_PKG_C6_RES),
510424646eeSThomas Gleixner 	.quirks			= SLM_PKG_C6_USE_C7_MSR,
511424646eeSThomas Gleixner };
512424646eeSThomas Gleixner 
513889882bcSLukasz Odzioba 
514889882bcSLukasz Odzioba static const struct cstate_model knl_cstates __initconst = {
515889882bcSLukasz Odzioba 	.core_events		= BIT(PERF_CSTATE_CORE_C6_RES),
516889882bcSLukasz Odzioba 
517889882bcSLukasz Odzioba 	.pkg_events		= BIT(PERF_CSTATE_PKG_C2_RES) |
518889882bcSLukasz Odzioba 				  BIT(PERF_CSTATE_PKG_C3_RES) |
519889882bcSLukasz Odzioba 				  BIT(PERF_CSTATE_PKG_C6_RES),
520889882bcSLukasz Odzioba 	.quirks			= KNL_CORE_C6_MSR,
521889882bcSLukasz Odzioba };
522889882bcSLukasz Odzioba 
523889882bcSLukasz Odzioba 
5245c10b048SHarry Pan static const struct cstate_model glm_cstates __initconst = {
5255c10b048SHarry Pan 	.core_events		= BIT(PERF_CSTATE_CORE_C1_RES) |
5265c10b048SHarry Pan 				  BIT(PERF_CSTATE_CORE_C3_RES) |
5275c10b048SHarry Pan 				  BIT(PERF_CSTATE_CORE_C6_RES),
5285c10b048SHarry Pan 
5295c10b048SHarry Pan 	.pkg_events		= BIT(PERF_CSTATE_PKG_C2_RES) |
5305c10b048SHarry Pan 				  BIT(PERF_CSTATE_PKG_C3_RES) |
5315c10b048SHarry Pan 				  BIT(PERF_CSTATE_PKG_C6_RES) |
5325c10b048SHarry Pan 				  BIT(PERF_CSTATE_PKG_C10_RES),
5335c10b048SHarry Pan };
5345c10b048SHarry Pan 
535889882bcSLukasz Odzioba 
536424646eeSThomas Gleixner #define X86_CSTATES_MODEL(model, states)				\
537424646eeSThomas Gleixner 	{ X86_VENDOR_INTEL, 6, model, X86_FEATURE_ANY, (unsigned long) &(states) }
538424646eeSThomas Gleixner 
539424646eeSThomas Gleixner static const struct x86_cpu_id intel_cstates_match[] __initconst = {
540bf4ad541SDave Hansen 	X86_CSTATES_MODEL(INTEL_FAM6_NEHALEM,    nhm_cstates),
541bf4ad541SDave Hansen 	X86_CSTATES_MODEL(INTEL_FAM6_NEHALEM_EP, nhm_cstates),
542bf4ad541SDave Hansen 	X86_CSTATES_MODEL(INTEL_FAM6_NEHALEM_EX, nhm_cstates),
543424646eeSThomas Gleixner 
544bf4ad541SDave Hansen 	X86_CSTATES_MODEL(INTEL_FAM6_WESTMERE,    nhm_cstates),
545bf4ad541SDave Hansen 	X86_CSTATES_MODEL(INTEL_FAM6_WESTMERE_EP, nhm_cstates),
546bf4ad541SDave Hansen 	X86_CSTATES_MODEL(INTEL_FAM6_WESTMERE_EX, nhm_cstates),
547424646eeSThomas Gleixner 
548bf4ad541SDave Hansen 	X86_CSTATES_MODEL(INTEL_FAM6_SANDYBRIDGE,   snb_cstates),
549bf4ad541SDave Hansen 	X86_CSTATES_MODEL(INTEL_FAM6_SANDYBRIDGE_X, snb_cstates),
550424646eeSThomas Gleixner 
551bf4ad541SDave Hansen 	X86_CSTATES_MODEL(INTEL_FAM6_IVYBRIDGE,   snb_cstates),
552bf4ad541SDave Hansen 	X86_CSTATES_MODEL(INTEL_FAM6_IVYBRIDGE_X, snb_cstates),
553424646eeSThomas Gleixner 
554bf4ad541SDave Hansen 	X86_CSTATES_MODEL(INTEL_FAM6_HASWELL_CORE, snb_cstates),
555bf4ad541SDave Hansen 	X86_CSTATES_MODEL(INTEL_FAM6_HASWELL_X,	   snb_cstates),
556bf4ad541SDave Hansen 	X86_CSTATES_MODEL(INTEL_FAM6_HASWELL_GT3E, snb_cstates),
557424646eeSThomas Gleixner 
558bf4ad541SDave Hansen 	X86_CSTATES_MODEL(INTEL_FAM6_HASWELL_ULT, hswult_cstates),
559424646eeSThomas Gleixner 
560bf4ad541SDave Hansen 	X86_CSTATES_MODEL(INTEL_FAM6_ATOM_SILVERMONT1, slm_cstates),
561bf4ad541SDave Hansen 	X86_CSTATES_MODEL(INTEL_FAM6_ATOM_SILVERMONT2, slm_cstates),
562bf4ad541SDave Hansen 	X86_CSTATES_MODEL(INTEL_FAM6_ATOM_AIRMONT,     slm_cstates),
563424646eeSThomas Gleixner 
564bf4ad541SDave Hansen 	X86_CSTATES_MODEL(INTEL_FAM6_BROADWELL_CORE,   snb_cstates),
565bf4ad541SDave Hansen 	X86_CSTATES_MODEL(INTEL_FAM6_BROADWELL_XEON_D, snb_cstates),
566bf4ad541SDave Hansen 	X86_CSTATES_MODEL(INTEL_FAM6_BROADWELL_GT3E,   snb_cstates),
567bf4ad541SDave Hansen 	X86_CSTATES_MODEL(INTEL_FAM6_BROADWELL_X,      snb_cstates),
568424646eeSThomas Gleixner 
569bf4ad541SDave Hansen 	X86_CSTATES_MODEL(INTEL_FAM6_SKYLAKE_MOBILE,  snb_cstates),
570bf4ad541SDave Hansen 	X86_CSTATES_MODEL(INTEL_FAM6_SKYLAKE_DESKTOP, snb_cstates),
571b09c146fSKan Liang 	X86_CSTATES_MODEL(INTEL_FAM6_SKYLAKE_X, snb_cstates),
572889882bcSLukasz Odzioba 
573f2029b1eSSrinivas Pandruvada 	X86_CSTATES_MODEL(INTEL_FAM6_KABYLAKE_MOBILE,  snb_cstates),
574f2029b1eSSrinivas Pandruvada 	X86_CSTATES_MODEL(INTEL_FAM6_KABYLAKE_DESKTOP, snb_cstates),
575f2029b1eSSrinivas Pandruvada 
5761159e094SHarry Pan 	X86_CSTATES_MODEL(INTEL_FAM6_CANNONLAKE_MOBILE, cnl_cstates),
5771159e094SHarry Pan 
578889882bcSLukasz Odzioba 	X86_CSTATES_MODEL(INTEL_FAM6_XEON_PHI_KNL, knl_cstates),
5791dba23b1SPiotr Luc 	X86_CSTATES_MODEL(INTEL_FAM6_XEON_PHI_KNM, knl_cstates),
5805c10b048SHarry Pan 
5815c10b048SHarry Pan 	X86_CSTATES_MODEL(INTEL_FAM6_ATOM_GOLDMONT, glm_cstates),
582b09c146fSKan Liang 	X86_CSTATES_MODEL(INTEL_FAM6_ATOM_DENVERTON, glm_cstates),
583b09c146fSKan Liang 
584b09c146fSKan Liang 	X86_CSTATES_MODEL(INTEL_FAM6_ATOM_GEMINI_LAKE, glm_cstates),
585424646eeSThomas Gleixner 	{ },
586424646eeSThomas Gleixner };
587424646eeSThomas Gleixner MODULE_DEVICE_TABLE(x86cpu, intel_cstates_match);
588424646eeSThomas Gleixner 
5896aec1ad7SBorislav Petkov /*
5906aec1ad7SBorislav Petkov  * Probe the cstate events and insert the available one into sysfs attrs
591424646eeSThomas Gleixner  * Return false if there are no available events.
5926aec1ad7SBorislav Petkov  */
593424646eeSThomas Gleixner static bool __init cstate_probe_msr(const unsigned long evmsk, int max,
594424646eeSThomas Gleixner                                    struct perf_cstate_msr *msr,
595424646eeSThomas Gleixner                                    struct attribute **attrs)
5966aec1ad7SBorislav Petkov {
597424646eeSThomas Gleixner 	bool found = false;
598424646eeSThomas Gleixner 	unsigned int bit;
5996aec1ad7SBorislav Petkov 	u64 val;
6006aec1ad7SBorislav Petkov 
601424646eeSThomas Gleixner 	for (bit = 0; bit < max; bit++) {
602424646eeSThomas Gleixner 		if (test_bit(bit, &evmsk) && !rdmsrl_safe(msr[bit].msr, &val)) {
603424646eeSThomas Gleixner 			*attrs++ = &msr[bit].attr->attr.attr;
604424646eeSThomas Gleixner 			found = true;
605424646eeSThomas Gleixner 		} else {
606424646eeSThomas Gleixner 			msr[bit].attr = NULL;
607424646eeSThomas Gleixner 		}
608424646eeSThomas Gleixner 	}
609424646eeSThomas Gleixner 	*attrs = NULL;
610424646eeSThomas Gleixner 
611424646eeSThomas Gleixner 	return found;
6126aec1ad7SBorislav Petkov }
6136aec1ad7SBorislav Petkov 
614424646eeSThomas Gleixner static int __init cstate_probe(const struct cstate_model *cm)
6156aec1ad7SBorislav Petkov {
6166aec1ad7SBorislav Petkov 	/* SLM has different MSR for PKG C6 */
617424646eeSThomas Gleixner 	if (cm->quirks & SLM_PKG_C6_USE_C7_MSR)
6186aec1ad7SBorislav Petkov 		pkg_msr[PERF_CSTATE_PKG_C6_RES].msr = MSR_PKG_C7_RESIDENCY;
6196aec1ad7SBorislav Petkov 
620889882bcSLukasz Odzioba 	/* KNL has different MSR for CORE C6 */
621889882bcSLukasz Odzioba 	if (cm->quirks & KNL_CORE_C6_MSR)
622889882bcSLukasz Odzioba 		pkg_msr[PERF_CSTATE_CORE_C6_RES].msr = MSR_KNL_CORE_C6_RESIDENCY;
623889882bcSLukasz Odzioba 
624889882bcSLukasz Odzioba 
625424646eeSThomas Gleixner 	has_cstate_core = cstate_probe_msr(cm->core_events,
626424646eeSThomas Gleixner 					   PERF_CSTATE_CORE_EVENT_MAX,
627424646eeSThomas Gleixner 					   core_msr, core_events_attrs);
6286aec1ad7SBorislav Petkov 
629424646eeSThomas Gleixner 	has_cstate_pkg = cstate_probe_msr(cm->pkg_events,
630424646eeSThomas Gleixner 					  PERF_CSTATE_PKG_EVENT_MAX,
631424646eeSThomas Gleixner 					  pkg_msr, pkg_events_attrs);
6326aec1ad7SBorislav Petkov 
6336aec1ad7SBorislav Petkov 	return (has_cstate_core || has_cstate_pkg) ? 0 : -ENODEV;
6346aec1ad7SBorislav Petkov }
6356aec1ad7SBorislav Petkov 
636c7afba32SThomas Gleixner static inline void cstate_cleanup(void)
6376aec1ad7SBorislav Petkov {
638834fcd29SThomas Gleixner 	cpuhp_remove_state_nocalls(CPUHP_AP_PERF_X86_CSTATE_ONLINE);
639834fcd29SThomas Gleixner 	cpuhp_remove_state_nocalls(CPUHP_AP_PERF_X86_CSTATE_STARTING);
640834fcd29SThomas Gleixner 
641d29859e7SThomas Gleixner 	if (has_cstate_core)
642d29859e7SThomas Gleixner 		perf_pmu_unregister(&cstate_core_pmu);
643d29859e7SThomas Gleixner 
644d29859e7SThomas Gleixner 	if (has_cstate_pkg)
645d29859e7SThomas Gleixner 		perf_pmu_unregister(&cstate_pkg_pmu);
646d29859e7SThomas Gleixner }
647d29859e7SThomas Gleixner 
648d29859e7SThomas Gleixner static int __init cstate_init(void)
649d29859e7SThomas Gleixner {
65077c34ef1SSebastian Andrzej Siewior 	int err;
6516aec1ad7SBorislav Petkov 
65277c34ef1SSebastian Andrzej Siewior 	cpuhp_setup_state(CPUHP_AP_PERF_X86_CSTATE_STARTING,
653834fcd29SThomas Gleixner 			  "perf/x86/cstate:starting", cstate_cpu_init, NULL);
65477c34ef1SSebastian Andrzej Siewior 	cpuhp_setup_state(CPUHP_AP_PERF_X86_CSTATE_ONLINE,
655834fcd29SThomas Gleixner 			  "perf/x86/cstate:online", NULL, cstate_cpu_exit);
6566aec1ad7SBorislav Petkov 
6576aec1ad7SBorislav Petkov 	if (has_cstate_core) {
6586aec1ad7SBorislav Petkov 		err = perf_pmu_register(&cstate_core_pmu, cstate_core_pmu.name, -1);
659d29859e7SThomas Gleixner 		if (err) {
660d29859e7SThomas Gleixner 			has_cstate_core = false;
661d29859e7SThomas Gleixner 			pr_info("Failed to register cstate core pmu\n");
662834fcd29SThomas Gleixner 			cstate_cleanup();
66377c34ef1SSebastian Andrzej Siewior 			return err;
664d29859e7SThomas Gleixner 		}
6656aec1ad7SBorislav Petkov 	}
6666aec1ad7SBorislav Petkov 
6676aec1ad7SBorislav Petkov 	if (has_cstate_pkg) {
6686aec1ad7SBorislav Petkov 		err = perf_pmu_register(&cstate_pkg_pmu, cstate_pkg_pmu.name, -1);
669d29859e7SThomas Gleixner 		if (err) {
670d29859e7SThomas Gleixner 			has_cstate_pkg = false;
671d29859e7SThomas Gleixner 			pr_info("Failed to register cstate pkg pmu\n");
672d29859e7SThomas Gleixner 			cstate_cleanup();
67377c34ef1SSebastian Andrzej Siewior 			return err;
6746aec1ad7SBorislav Petkov 		}
6756aec1ad7SBorislav Petkov 	}
676834fcd29SThomas Gleixner 	return 0;
677d29859e7SThomas Gleixner }
6786aec1ad7SBorislav Petkov 
6796aec1ad7SBorislav Petkov static int __init cstate_pmu_init(void)
6806aec1ad7SBorislav Petkov {
681424646eeSThomas Gleixner 	const struct x86_cpu_id *id;
6826aec1ad7SBorislav Petkov 	int err;
6836aec1ad7SBorislav Petkov 
684424646eeSThomas Gleixner 	if (boot_cpu_has(X86_FEATURE_HYPERVISOR))
6856aec1ad7SBorislav Petkov 		return -ENODEV;
6866aec1ad7SBorislav Petkov 
687424646eeSThomas Gleixner 	id = x86_match_cpu(intel_cstates_match);
688424646eeSThomas Gleixner 	if (!id)
689424646eeSThomas Gleixner 		return -ENODEV;
690424646eeSThomas Gleixner 
691424646eeSThomas Gleixner 	err = cstate_probe((const struct cstate_model *) id->driver_data);
6926aec1ad7SBorislav Petkov 	if (err)
6936aec1ad7SBorislav Petkov 		return err;
6946aec1ad7SBorislav Petkov 
695d29859e7SThomas Gleixner 	return cstate_init();
6966aec1ad7SBorislav Petkov }
697c7afba32SThomas Gleixner module_init(cstate_pmu_init);
698c7afba32SThomas Gleixner 
699c7afba32SThomas Gleixner static void __exit cstate_pmu_exit(void)
700c7afba32SThomas Gleixner {
701c7afba32SThomas Gleixner 	cstate_cleanup();
702c7afba32SThomas Gleixner }
703c7afba32SThomas Gleixner module_exit(cstate_pmu_exit);
704