xref: /openbmc/linux/arch/s390/kernel/perf_cpum_cf.c (revision 0cceeab5a38d70fae3c2944e77e1d262c74d159b)
1a17ae4c3SGreg Kroah-Hartman // SPDX-License-Identifier: GPL-2.0
2212188a5SHendrik Brueckner /*
3212188a5SHendrik Brueckner  * Performance event support for s390x - CPU-measurement Counter Facility
4212188a5SHendrik Brueckner  *
546a984ffSThomas Richter  *  Copyright IBM Corp. 2012, 2019
646a984ffSThomas Richter  *  Author(s): Hendrik Brueckner <brueckner@linux.ibm.com>
7212188a5SHendrik Brueckner  */
8212188a5SHendrik Brueckner #define KMSG_COMPONENT	"cpum_cf"
9212188a5SHendrik Brueckner #define pr_fmt(fmt)	KMSG_COMPONENT ": " fmt
10212188a5SHendrik Brueckner 
11212188a5SHendrik Brueckner #include <linux/kernel.h>
12212188a5SHendrik Brueckner #include <linux/kernel_stat.h>
13212188a5SHendrik Brueckner #include <linux/percpu.h>
14212188a5SHendrik Brueckner #include <linux/notifier.h>
15212188a5SHendrik Brueckner #include <linux/init.h>
16212188a5SHendrik Brueckner #include <linux/export.h>
1730e145f8SHendrik Brueckner #include <asm/cpu_mcf.h>
18212188a5SHendrik Brueckner 
19ee699f32SHendrik Brueckner static enum cpumf_ctr_set get_counter_set(u64 event)
20212188a5SHendrik Brueckner {
21ee699f32SHendrik Brueckner 	int set = CPUMF_CTR_SET_MAX;
22212188a5SHendrik Brueckner 
23212188a5SHendrik Brueckner 	if (event < 32)
24212188a5SHendrik Brueckner 		set = CPUMF_CTR_SET_BASIC;
25212188a5SHendrik Brueckner 	else if (event < 64)
26212188a5SHendrik Brueckner 		set = CPUMF_CTR_SET_USER;
27212188a5SHendrik Brueckner 	else if (event < 128)
28212188a5SHendrik Brueckner 		set = CPUMF_CTR_SET_CRYPTO;
2946a984ffSThomas Richter 	else if (event < 288)
30212188a5SHendrik Brueckner 		set = CPUMF_CTR_SET_EXT;
31ee699f32SHendrik Brueckner 	else if (event >= 448 && event < 496)
32ee699f32SHendrik Brueckner 		set = CPUMF_CTR_SET_MT_DIAG;
33212188a5SHendrik Brueckner 
34212188a5SHendrik Brueckner 	return set;
35212188a5SHendrik Brueckner }
36212188a5SHendrik Brueckner 
37212188a5SHendrik Brueckner static int validate_ctr_version(const struct hw_perf_event *hwc)
38212188a5SHendrik Brueckner {
39f1c0b831SHendrik Brueckner 	struct cpu_cf_events *cpuhw;
40212188a5SHendrik Brueckner 	int err = 0;
41ee699f32SHendrik Brueckner 	u16 mtdiag_ctl;
42212188a5SHendrik Brueckner 
43f1c0b831SHendrik Brueckner 	cpuhw = &get_cpu_var(cpu_cf_events);
44212188a5SHendrik Brueckner 
45212188a5SHendrik Brueckner 	/* check required version for counter sets */
46212188a5SHendrik Brueckner 	switch (hwc->config_base) {
47212188a5SHendrik Brueckner 	case CPUMF_CTR_SET_BASIC:
48212188a5SHendrik Brueckner 	case CPUMF_CTR_SET_USER:
49212188a5SHendrik Brueckner 		if (cpuhw->info.cfvn < 1)
50212188a5SHendrik Brueckner 			err = -EOPNOTSUPP;
51212188a5SHendrik Brueckner 		break;
52212188a5SHendrik Brueckner 	case CPUMF_CTR_SET_CRYPTO:
5346a984ffSThomas Richter 		if ((cpuhw->info.csvn >= 1 && cpuhw->info.csvn <= 5 &&
5446a984ffSThomas Richter 		     hwc->config > 79) ||
5546a984ffSThomas Richter 		    (cpuhw->info.csvn >= 6 && hwc->config > 83))
5646a984ffSThomas Richter 			err = -EOPNOTSUPP;
5746a984ffSThomas Richter 		break;
58212188a5SHendrik Brueckner 	case CPUMF_CTR_SET_EXT:
59212188a5SHendrik Brueckner 		if (cpuhw->info.csvn < 1)
60212188a5SHendrik Brueckner 			err = -EOPNOTSUPP;
61f47586b2SHendrik Brueckner 		if ((cpuhw->info.csvn == 1 && hwc->config > 159) ||
62f47586b2SHendrik Brueckner 		    (cpuhw->info.csvn == 2 && hwc->config > 175) ||
6346a984ffSThomas Richter 		    (cpuhw->info.csvn >= 3 && cpuhw->info.csvn <= 5
6446a984ffSThomas Richter 		     && hwc->config > 255) ||
6546a984ffSThomas Richter 		    (cpuhw->info.csvn >= 6 && hwc->config > 287))
66f47586b2SHendrik Brueckner 			err = -EOPNOTSUPP;
67212188a5SHendrik Brueckner 		break;
68ee699f32SHendrik Brueckner 	case CPUMF_CTR_SET_MT_DIAG:
69ee699f32SHendrik Brueckner 		if (cpuhw->info.csvn <= 3)
70ee699f32SHendrik Brueckner 			err = -EOPNOTSUPP;
71ee699f32SHendrik Brueckner 		/*
72ee699f32SHendrik Brueckner 		 * MT-diagnostic counters are read-only.  The counter set
73ee699f32SHendrik Brueckner 		 * is automatically enabled and activated on all CPUs with
74ee699f32SHendrik Brueckner 		 * multithreading (SMT).  Deactivation of multithreading
75ee699f32SHendrik Brueckner 		 * also disables the counter set.  State changes are ignored
76ee699f32SHendrik Brueckner 		 * by lcctl().	Because Linux controls SMT enablement through
77ee699f32SHendrik Brueckner 		 * a kernel parameter only, the counter set is either disabled
78ee699f32SHendrik Brueckner 		 * or enabled and active.
79ee699f32SHendrik Brueckner 		 *
80ee699f32SHendrik Brueckner 		 * Thus, the counters can only be used if SMT is on and the
81ee699f32SHendrik Brueckner 		 * counter set is enabled and active.
82ee699f32SHendrik Brueckner 		 */
8330e145f8SHendrik Brueckner 		mtdiag_ctl = cpumf_ctr_ctl[CPUMF_CTR_SET_MT_DIAG];
84ee699f32SHendrik Brueckner 		if (!((cpuhw->info.auth_ctl & mtdiag_ctl) &&
85ee699f32SHendrik Brueckner 		      (cpuhw->info.enable_ctl & mtdiag_ctl) &&
86ee699f32SHendrik Brueckner 		      (cpuhw->info.act_ctl & mtdiag_ctl)))
87ee699f32SHendrik Brueckner 			err = -EOPNOTSUPP;
88ee699f32SHendrik Brueckner 		break;
89212188a5SHendrik Brueckner 	}
90212188a5SHendrik Brueckner 
91f1c0b831SHendrik Brueckner 	put_cpu_var(cpu_cf_events);
92212188a5SHendrik Brueckner 	return err;
93212188a5SHendrik Brueckner }
94212188a5SHendrik Brueckner 
95212188a5SHendrik Brueckner static int validate_ctr_auth(const struct hw_perf_event *hwc)
96212188a5SHendrik Brueckner {
97f1c0b831SHendrik Brueckner 	struct cpu_cf_events *cpuhw;
98212188a5SHendrik Brueckner 	u64 ctrs_state;
99212188a5SHendrik Brueckner 	int err = 0;
100212188a5SHendrik Brueckner 
101f1c0b831SHendrik Brueckner 	cpuhw = &get_cpu_var(cpu_cf_events);
102212188a5SHendrik Brueckner 
10358f8e9daSHendrik Brueckner 	/* Check authorization for cpu counter sets.
10458f8e9daSHendrik Brueckner 	 * If the particular CPU counter set is not authorized,
10558f8e9daSHendrik Brueckner 	 * return with -ENOENT in order to fall back to other
10658f8e9daSHendrik Brueckner 	 * PMUs that might suffice the event request.
10758f8e9daSHendrik Brueckner 	 */
10830e145f8SHendrik Brueckner 	ctrs_state = cpumf_ctr_ctl[hwc->config_base];
109212188a5SHendrik Brueckner 	if (!(ctrs_state & cpuhw->info.auth_ctl))
11058f8e9daSHendrik Brueckner 		err = -ENOENT;
111212188a5SHendrik Brueckner 
112f1c0b831SHendrik Brueckner 	put_cpu_var(cpu_cf_events);
113212188a5SHendrik Brueckner 	return err;
114212188a5SHendrik Brueckner }
115212188a5SHendrik Brueckner 
116212188a5SHendrik Brueckner /*
117212188a5SHendrik Brueckner  * Change the CPUMF state to active.
118212188a5SHendrik Brueckner  * Enable and activate the CPU-counter sets according
119212188a5SHendrik Brueckner  * to the per-cpu control state.
120212188a5SHendrik Brueckner  */
121212188a5SHendrik Brueckner static void cpumf_pmu_enable(struct pmu *pmu)
122212188a5SHendrik Brueckner {
123f1c0b831SHendrik Brueckner 	struct cpu_cf_events *cpuhw = this_cpu_ptr(&cpu_cf_events);
124212188a5SHendrik Brueckner 	int err;
125212188a5SHendrik Brueckner 
126212188a5SHendrik Brueckner 	if (cpuhw->flags & PMU_F_ENABLED)
127212188a5SHendrik Brueckner 		return;
128212188a5SHendrik Brueckner 
129212188a5SHendrik Brueckner 	err = lcctl(cpuhw->state);
130212188a5SHendrik Brueckner 	if (err) {
131212188a5SHendrik Brueckner 		pr_err("Enabling the performance measuring unit "
132af0ee94eSHeiko Carstens 		       "failed with rc=%x\n", err);
133212188a5SHendrik Brueckner 		return;
134212188a5SHendrik Brueckner 	}
135212188a5SHendrik Brueckner 
136212188a5SHendrik Brueckner 	cpuhw->flags |= PMU_F_ENABLED;
137212188a5SHendrik Brueckner }
138212188a5SHendrik Brueckner 
139212188a5SHendrik Brueckner /*
140212188a5SHendrik Brueckner  * Change the CPUMF state to inactive.
141212188a5SHendrik Brueckner  * Disable and enable (inactive) the CPU-counter sets according
142212188a5SHendrik Brueckner  * to the per-cpu control state.
143212188a5SHendrik Brueckner  */
144212188a5SHendrik Brueckner static void cpumf_pmu_disable(struct pmu *pmu)
145212188a5SHendrik Brueckner {
146f1c0b831SHendrik Brueckner 	struct cpu_cf_events *cpuhw = this_cpu_ptr(&cpu_cf_events);
147212188a5SHendrik Brueckner 	int err;
148212188a5SHendrik Brueckner 	u64 inactive;
149212188a5SHendrik Brueckner 
150212188a5SHendrik Brueckner 	if (!(cpuhw->flags & PMU_F_ENABLED))
151212188a5SHendrik Brueckner 		return;
152212188a5SHendrik Brueckner 
153212188a5SHendrik Brueckner 	inactive = cpuhw->state & ~((1 << CPUMF_LCCTL_ENABLE_SHIFT) - 1);
154212188a5SHendrik Brueckner 	err = lcctl(inactive);
155212188a5SHendrik Brueckner 	if (err) {
156212188a5SHendrik Brueckner 		pr_err("Disabling the performance measuring unit "
157af0ee94eSHeiko Carstens 		       "failed with rc=%x\n", err);
158212188a5SHendrik Brueckner 		return;
159212188a5SHendrik Brueckner 	}
160212188a5SHendrik Brueckner 
161212188a5SHendrik Brueckner 	cpuhw->flags &= ~PMU_F_ENABLED;
162212188a5SHendrik Brueckner }
163212188a5SHendrik Brueckner 
164212188a5SHendrik Brueckner 
165212188a5SHendrik Brueckner /* Number of perf events counting hardware events */
166212188a5SHendrik Brueckner static atomic_t num_events = ATOMIC_INIT(0);
167212188a5SHendrik Brueckner /* Used to avoid races in calling reserve/release_cpumf_hardware */
168212188a5SHendrik Brueckner static DEFINE_MUTEX(pmc_reserve_mutex);
169212188a5SHendrik Brueckner 
170212188a5SHendrik Brueckner /* Release the PMU if event is the last perf event */
171212188a5SHendrik Brueckner static void hw_perf_event_destroy(struct perf_event *event)
172212188a5SHendrik Brueckner {
173212188a5SHendrik Brueckner 	if (!atomic_add_unless(&num_events, -1, 1)) {
174212188a5SHendrik Brueckner 		mutex_lock(&pmc_reserve_mutex);
175212188a5SHendrik Brueckner 		if (atomic_dec_return(&num_events) == 0)
1763d33345aSHendrik Brueckner 			__kernel_cpumcf_end();
177212188a5SHendrik Brueckner 		mutex_unlock(&pmc_reserve_mutex);
178212188a5SHendrik Brueckner 	}
179212188a5SHendrik Brueckner }
180212188a5SHendrik Brueckner 
181212188a5SHendrik Brueckner /* CPUMF <-> perf event mappings for kernel+userspace (basic set) */
182212188a5SHendrik Brueckner static const int cpumf_generic_events_basic[] = {
183212188a5SHendrik Brueckner 	[PERF_COUNT_HW_CPU_CYCLES]	    = 0,
184212188a5SHendrik Brueckner 	[PERF_COUNT_HW_INSTRUCTIONS]	    = 1,
185212188a5SHendrik Brueckner 	[PERF_COUNT_HW_CACHE_REFERENCES]    = -1,
186212188a5SHendrik Brueckner 	[PERF_COUNT_HW_CACHE_MISSES]	    = -1,
187212188a5SHendrik Brueckner 	[PERF_COUNT_HW_BRANCH_INSTRUCTIONS] = -1,
188212188a5SHendrik Brueckner 	[PERF_COUNT_HW_BRANCH_MISSES]	    = -1,
189212188a5SHendrik Brueckner 	[PERF_COUNT_HW_BUS_CYCLES]	    = -1,
190212188a5SHendrik Brueckner };
191212188a5SHendrik Brueckner /* CPUMF <-> perf event mappings for userspace (problem-state set) */
192212188a5SHendrik Brueckner static const int cpumf_generic_events_user[] = {
193212188a5SHendrik Brueckner 	[PERF_COUNT_HW_CPU_CYCLES]	    = 32,
194212188a5SHendrik Brueckner 	[PERF_COUNT_HW_INSTRUCTIONS]	    = 33,
195212188a5SHendrik Brueckner 	[PERF_COUNT_HW_CACHE_REFERENCES]    = -1,
196212188a5SHendrik Brueckner 	[PERF_COUNT_HW_CACHE_MISSES]	    = -1,
197212188a5SHendrik Brueckner 	[PERF_COUNT_HW_BRANCH_INSTRUCTIONS] = -1,
198212188a5SHendrik Brueckner 	[PERF_COUNT_HW_BRANCH_MISSES]	    = -1,
199212188a5SHendrik Brueckner 	[PERF_COUNT_HW_BUS_CYCLES]	    = -1,
200212188a5SHendrik Brueckner };
201212188a5SHendrik Brueckner 
2026a82e23fSThomas Richter static int __hw_perf_event_init(struct perf_event *event, unsigned int type)
203212188a5SHendrik Brueckner {
204212188a5SHendrik Brueckner 	struct perf_event_attr *attr = &event->attr;
205212188a5SHendrik Brueckner 	struct hw_perf_event *hwc = &event->hw;
206ee699f32SHendrik Brueckner 	enum cpumf_ctr_set set;
20747b74785SThomas Richter 	int err = 0;
208212188a5SHendrik Brueckner 	u64 ev;
209212188a5SHendrik Brueckner 
2106a82e23fSThomas Richter 	switch (type) {
211212188a5SHendrik Brueckner 	case PERF_TYPE_RAW:
212212188a5SHendrik Brueckner 		/* Raw events are used to access counters directly,
213212188a5SHendrik Brueckner 		 * hence do not permit excludes */
214212188a5SHendrik Brueckner 		if (attr->exclude_kernel || attr->exclude_user ||
215212188a5SHendrik Brueckner 		    attr->exclude_hv)
216212188a5SHendrik Brueckner 			return -EOPNOTSUPP;
217212188a5SHendrik Brueckner 		ev = attr->config;
218212188a5SHendrik Brueckner 		break;
219212188a5SHendrik Brueckner 
220212188a5SHendrik Brueckner 	case PERF_TYPE_HARDWARE:
221613a41b0SThomas Richter 		if (is_sampling_event(event))	/* No sampling support */
222613a41b0SThomas Richter 			return -ENOENT;
223212188a5SHendrik Brueckner 		ev = attr->config;
224212188a5SHendrik Brueckner 		/* Count user space (problem-state) only */
225212188a5SHendrik Brueckner 		if (!attr->exclude_user && attr->exclude_kernel) {
226212188a5SHendrik Brueckner 			if (ev >= ARRAY_SIZE(cpumf_generic_events_user))
227212188a5SHendrik Brueckner 				return -EOPNOTSUPP;
228212188a5SHendrik Brueckner 			ev = cpumf_generic_events_user[ev];
229212188a5SHendrik Brueckner 
230212188a5SHendrik Brueckner 		/* No support for kernel space counters only */
231212188a5SHendrik Brueckner 		} else if (!attr->exclude_kernel && attr->exclude_user) {
232212188a5SHendrik Brueckner 			return -EOPNOTSUPP;
233*0cceeab5SThomas Richter 		} else {	/* Count user and kernel space */
234212188a5SHendrik Brueckner 			if (ev >= ARRAY_SIZE(cpumf_generic_events_basic))
235212188a5SHendrik Brueckner 				return -EOPNOTSUPP;
236212188a5SHendrik Brueckner 			ev = cpumf_generic_events_basic[ev];
237212188a5SHendrik Brueckner 		}
238212188a5SHendrik Brueckner 		break;
239212188a5SHendrik Brueckner 
240212188a5SHendrik Brueckner 	default:
241212188a5SHendrik Brueckner 		return -ENOENT;
242212188a5SHendrik Brueckner 	}
243212188a5SHendrik Brueckner 
244212188a5SHendrik Brueckner 	if (ev == -1)
245212188a5SHendrik Brueckner 		return -ENOENT;
246212188a5SHendrik Brueckner 
24720ba46daSHendrik Brueckner 	if (ev > PERF_CPUM_CF_MAX_CTR)
2480bb2ae1bSThomas Richter 		return -ENOENT;
249212188a5SHendrik Brueckner 
250ee699f32SHendrik Brueckner 	/* Obtain the counter set to which the specified counter belongs */
251ee699f32SHendrik Brueckner 	set = get_counter_set(ev);
252ee699f32SHendrik Brueckner 	switch (set) {
253ee699f32SHendrik Brueckner 	case CPUMF_CTR_SET_BASIC:
254ee699f32SHendrik Brueckner 	case CPUMF_CTR_SET_USER:
255ee699f32SHendrik Brueckner 	case CPUMF_CTR_SET_CRYPTO:
256ee699f32SHendrik Brueckner 	case CPUMF_CTR_SET_EXT:
257ee699f32SHendrik Brueckner 	case CPUMF_CTR_SET_MT_DIAG:
258ee699f32SHendrik Brueckner 		/*
259ee699f32SHendrik Brueckner 		 * Use the hardware perf event structure to store the
260ee699f32SHendrik Brueckner 		 * counter number in the 'config' member and the counter
261ee699f32SHendrik Brueckner 		 * set number in the 'config_base'.  The counter set number
262ee699f32SHendrik Brueckner 		 * is then later used to enable/disable the counter(s).
263212188a5SHendrik Brueckner 		 */
264212188a5SHendrik Brueckner 		hwc->config = ev;
265ee699f32SHendrik Brueckner 		hwc->config_base = set;
266ee699f32SHendrik Brueckner 		break;
267ee699f32SHendrik Brueckner 	case CPUMF_CTR_SET_MAX:
268ee699f32SHendrik Brueckner 		/* The counter could not be associated to a counter set */
269ee699f32SHendrik Brueckner 		return -EINVAL;
2701c0a9c79SJiapeng Chong 	}
271212188a5SHendrik Brueckner 
272212188a5SHendrik Brueckner 	/* Initialize for using the CPU-measurement counter facility */
273212188a5SHendrik Brueckner 	if (!atomic_inc_not_zero(&num_events)) {
274212188a5SHendrik Brueckner 		mutex_lock(&pmc_reserve_mutex);
2753d33345aSHendrik Brueckner 		if (atomic_read(&num_events) == 0 && __kernel_cpumcf_begin())
276212188a5SHendrik Brueckner 			err = -EBUSY;
277212188a5SHendrik Brueckner 		else
278212188a5SHendrik Brueckner 			atomic_inc(&num_events);
279212188a5SHendrik Brueckner 		mutex_unlock(&pmc_reserve_mutex);
280212188a5SHendrik Brueckner 	}
28147b74785SThomas Richter 	if (err)
28247b74785SThomas Richter 		return err;
283212188a5SHendrik Brueckner 	event->destroy = hw_perf_event_destroy;
284212188a5SHendrik Brueckner 
285212188a5SHendrik Brueckner 	/* Finally, validate version and authorization of the counter set */
286212188a5SHendrik Brueckner 	err = validate_ctr_auth(hwc);
287212188a5SHendrik Brueckner 	if (!err)
288212188a5SHendrik Brueckner 		err = validate_ctr_version(hwc);
289212188a5SHendrik Brueckner 
290212188a5SHendrik Brueckner 	return err;
291212188a5SHendrik Brueckner }
292212188a5SHendrik Brueckner 
293212188a5SHendrik Brueckner static int cpumf_pmu_event_init(struct perf_event *event)
294212188a5SHendrik Brueckner {
2956a82e23fSThomas Richter 	unsigned int type = event->attr.type;
296212188a5SHendrik Brueckner 	int err;
297212188a5SHendrik Brueckner 
2986a82e23fSThomas Richter 	if (type == PERF_TYPE_HARDWARE || type == PERF_TYPE_RAW)
2996a82e23fSThomas Richter 		err = __hw_perf_event_init(event, type);
3006a82e23fSThomas Richter 	else if (event->pmu->type == type)
3016a82e23fSThomas Richter 		/* Registered as unknown PMU */
3026a82e23fSThomas Richter 		err = __hw_perf_event_init(event, PERF_TYPE_RAW);
3036a82e23fSThomas Richter 	else
304212188a5SHendrik Brueckner 		return -ENOENT;
305212188a5SHendrik Brueckner 
306212188a5SHendrik Brueckner 	if (unlikely(err) && event->destroy)
307212188a5SHendrik Brueckner 		event->destroy(event);
308212188a5SHendrik Brueckner 
309212188a5SHendrik Brueckner 	return err;
310212188a5SHendrik Brueckner }
311212188a5SHendrik Brueckner 
312212188a5SHendrik Brueckner static int hw_perf_event_reset(struct perf_event *event)
313212188a5SHendrik Brueckner {
314212188a5SHendrik Brueckner 	u64 prev, new;
315212188a5SHendrik Brueckner 	int err;
316212188a5SHendrik Brueckner 
317212188a5SHendrik Brueckner 	do {
318212188a5SHendrik Brueckner 		prev = local64_read(&event->hw.prev_count);
319212188a5SHendrik Brueckner 		err = ecctr(event->hw.config, &new);
320212188a5SHendrik Brueckner 		if (err) {
321212188a5SHendrik Brueckner 			if (err != 3)
322212188a5SHendrik Brueckner 				break;
323212188a5SHendrik Brueckner 			/* The counter is not (yet) available. This
324212188a5SHendrik Brueckner 			 * might happen if the counter set to which
325212188a5SHendrik Brueckner 			 * this counter belongs is in the disabled
326212188a5SHendrik Brueckner 			 * state.
327212188a5SHendrik Brueckner 			 */
328212188a5SHendrik Brueckner 			new = 0;
329212188a5SHendrik Brueckner 		}
330212188a5SHendrik Brueckner 	} while (local64_cmpxchg(&event->hw.prev_count, prev, new) != prev);
331212188a5SHendrik Brueckner 
332212188a5SHendrik Brueckner 	return err;
333212188a5SHendrik Brueckner }
334212188a5SHendrik Brueckner 
335485527baSHendrik Brueckner static void hw_perf_event_update(struct perf_event *event)
336212188a5SHendrik Brueckner {
337212188a5SHendrik Brueckner 	u64 prev, new, delta;
338212188a5SHendrik Brueckner 	int err;
339212188a5SHendrik Brueckner 
340212188a5SHendrik Brueckner 	do {
341212188a5SHendrik Brueckner 		prev = local64_read(&event->hw.prev_count);
342212188a5SHendrik Brueckner 		err = ecctr(event->hw.config, &new);
343212188a5SHendrik Brueckner 		if (err)
344485527baSHendrik Brueckner 			return;
345212188a5SHendrik Brueckner 	} while (local64_cmpxchg(&event->hw.prev_count, prev, new) != prev);
346212188a5SHendrik Brueckner 
347212188a5SHendrik Brueckner 	delta = (prev <= new) ? new - prev
348212188a5SHendrik Brueckner 			      : (-1ULL - prev) + new + 1;	 /* overflow */
349212188a5SHendrik Brueckner 	local64_add(delta, &event->count);
350212188a5SHendrik Brueckner }
351212188a5SHendrik Brueckner 
352212188a5SHendrik Brueckner static void cpumf_pmu_read(struct perf_event *event)
353212188a5SHendrik Brueckner {
354212188a5SHendrik Brueckner 	if (event->hw.state & PERF_HES_STOPPED)
355212188a5SHendrik Brueckner 		return;
356212188a5SHendrik Brueckner 
357212188a5SHendrik Brueckner 	hw_perf_event_update(event);
358212188a5SHendrik Brueckner }
359212188a5SHendrik Brueckner 
360212188a5SHendrik Brueckner static void cpumf_pmu_start(struct perf_event *event, int flags)
361212188a5SHendrik Brueckner {
362f1c0b831SHendrik Brueckner 	struct cpu_cf_events *cpuhw = this_cpu_ptr(&cpu_cf_events);
363212188a5SHendrik Brueckner 	struct hw_perf_event *hwc = &event->hw;
364212188a5SHendrik Brueckner 
365212188a5SHendrik Brueckner 	if (WARN_ON_ONCE(!(hwc->state & PERF_HES_STOPPED)))
366212188a5SHendrik Brueckner 		return;
367212188a5SHendrik Brueckner 
368212188a5SHendrik Brueckner 	if (WARN_ON_ONCE(hwc->config == -1))
369212188a5SHendrik Brueckner 		return;
370212188a5SHendrik Brueckner 
371212188a5SHendrik Brueckner 	if (flags & PERF_EF_RELOAD)
372212188a5SHendrik Brueckner 		WARN_ON_ONCE(!(hwc->state & PERF_HES_UPTODATE));
373212188a5SHendrik Brueckner 
374212188a5SHendrik Brueckner 	hwc->state = 0;
375212188a5SHendrik Brueckner 
376212188a5SHendrik Brueckner 	/* (Re-)enable and activate the counter set */
377212188a5SHendrik Brueckner 	ctr_set_enable(&cpuhw->state, hwc->config_base);
378212188a5SHendrik Brueckner 	ctr_set_start(&cpuhw->state, hwc->config_base);
379212188a5SHendrik Brueckner 
380212188a5SHendrik Brueckner 	/* The counter set to which this counter belongs can be already active.
381212188a5SHendrik Brueckner 	 * Because all counters in a set are active, the event->hw.prev_count
382212188a5SHendrik Brueckner 	 * needs to be synchronized.  At this point, the counter set can be in
383212188a5SHendrik Brueckner 	 * the inactive or disabled state.
384212188a5SHendrik Brueckner 	 */
385212188a5SHendrik Brueckner 	hw_perf_event_reset(event);
386212188a5SHendrik Brueckner 
387212188a5SHendrik Brueckner 	/* increment refcount for this counter set */
388212188a5SHendrik Brueckner 	atomic_inc(&cpuhw->ctr_set[hwc->config_base]);
389212188a5SHendrik Brueckner }
390212188a5SHendrik Brueckner 
391212188a5SHendrik Brueckner static void cpumf_pmu_stop(struct perf_event *event, int flags)
392212188a5SHendrik Brueckner {
393f1c0b831SHendrik Brueckner 	struct cpu_cf_events *cpuhw = this_cpu_ptr(&cpu_cf_events);
394212188a5SHendrik Brueckner 	struct hw_perf_event *hwc = &event->hw;
395212188a5SHendrik Brueckner 
396212188a5SHendrik Brueckner 	if (!(hwc->state & PERF_HES_STOPPED)) {
397212188a5SHendrik Brueckner 		/* Decrement reference count for this counter set and if this
398212188a5SHendrik Brueckner 		 * is the last used counter in the set, clear activation
399212188a5SHendrik Brueckner 		 * control and set the counter set state to inactive.
400212188a5SHendrik Brueckner 		 */
401212188a5SHendrik Brueckner 		if (!atomic_dec_return(&cpuhw->ctr_set[hwc->config_base]))
402212188a5SHendrik Brueckner 			ctr_set_stop(&cpuhw->state, hwc->config_base);
403*0cceeab5SThomas Richter 		hwc->state |= PERF_HES_STOPPED;
404212188a5SHendrik Brueckner 	}
405212188a5SHendrik Brueckner 
406212188a5SHendrik Brueckner 	if ((flags & PERF_EF_UPDATE) && !(hwc->state & PERF_HES_UPTODATE)) {
407212188a5SHendrik Brueckner 		hw_perf_event_update(event);
408*0cceeab5SThomas Richter 		hwc->state |= PERF_HES_UPTODATE;
409212188a5SHendrik Brueckner 	}
410212188a5SHendrik Brueckner }
411212188a5SHendrik Brueckner 
412212188a5SHendrik Brueckner static int cpumf_pmu_add(struct perf_event *event, int flags)
413212188a5SHendrik Brueckner {
414f1c0b831SHendrik Brueckner 	struct cpu_cf_events *cpuhw = this_cpu_ptr(&cpu_cf_events);
415212188a5SHendrik Brueckner 
416212188a5SHendrik Brueckner 	/* Check authorization for the counter set to which this
417212188a5SHendrik Brueckner 	 * counter belongs.
418212188a5SHendrik Brueckner 	 * For group events transaction, the authorization check is
419212188a5SHendrik Brueckner 	 * done in cpumf_pmu_commit_txn().
420212188a5SHendrik Brueckner 	 */
4218f3e5684SSukadev Bhattiprolu 	if (!(cpuhw->txn_flags & PERF_PMU_TXN_ADD))
422212188a5SHendrik Brueckner 		if (validate_ctr_auth(&event->hw))
42358f8e9daSHendrik Brueckner 			return -ENOENT;
424212188a5SHendrik Brueckner 
425212188a5SHendrik Brueckner 	ctr_set_enable(&cpuhw->state, event->hw.config_base);
426212188a5SHendrik Brueckner 	event->hw.state = PERF_HES_UPTODATE | PERF_HES_STOPPED;
427212188a5SHendrik Brueckner 
428212188a5SHendrik Brueckner 	if (flags & PERF_EF_START)
429212188a5SHendrik Brueckner 		cpumf_pmu_start(event, PERF_EF_RELOAD);
430212188a5SHendrik Brueckner 
431212188a5SHendrik Brueckner 	perf_event_update_userpage(event);
432212188a5SHendrik Brueckner 
433212188a5SHendrik Brueckner 	return 0;
434212188a5SHendrik Brueckner }
435212188a5SHendrik Brueckner 
436212188a5SHendrik Brueckner static void cpumf_pmu_del(struct perf_event *event, int flags)
437212188a5SHendrik Brueckner {
438f1c0b831SHendrik Brueckner 	struct cpu_cf_events *cpuhw = this_cpu_ptr(&cpu_cf_events);
439212188a5SHendrik Brueckner 
440212188a5SHendrik Brueckner 	cpumf_pmu_stop(event, PERF_EF_UPDATE);
441212188a5SHendrik Brueckner 
442212188a5SHendrik Brueckner 	/* Check if any counter in the counter set is still used.  If not used,
443212188a5SHendrik Brueckner 	 * change the counter set to the disabled state.  This also clears the
444212188a5SHendrik Brueckner 	 * content of all counters in the set.
445212188a5SHendrik Brueckner 	 *
446212188a5SHendrik Brueckner 	 * When a new perf event has been added but not yet started, this can
447212188a5SHendrik Brueckner 	 * clear enable control and resets all counters in a set.  Therefore,
448212188a5SHendrik Brueckner 	 * cpumf_pmu_start() always has to reenable a counter set.
449212188a5SHendrik Brueckner 	 */
450212188a5SHendrik Brueckner 	if (!atomic_read(&cpuhw->ctr_set[event->hw.config_base]))
451212188a5SHendrik Brueckner 		ctr_set_disable(&cpuhw->state, event->hw.config_base);
452212188a5SHendrik Brueckner 
453212188a5SHendrik Brueckner 	perf_event_update_userpage(event);
454212188a5SHendrik Brueckner }
455212188a5SHendrik Brueckner 
456212188a5SHendrik Brueckner /*
457212188a5SHendrik Brueckner  * Start group events scheduling transaction.
458212188a5SHendrik Brueckner  * Set flags to perform a single test at commit time.
459fbbe0701SSukadev Bhattiprolu  *
460fbbe0701SSukadev Bhattiprolu  * We only support PERF_PMU_TXN_ADD transactions. Save the
461fbbe0701SSukadev Bhattiprolu  * transaction flags but otherwise ignore non-PERF_PMU_TXN_ADD
462fbbe0701SSukadev Bhattiprolu  * transactions.
463212188a5SHendrik Brueckner  */
464fbbe0701SSukadev Bhattiprolu static void cpumf_pmu_start_txn(struct pmu *pmu, unsigned int txn_flags)
465212188a5SHendrik Brueckner {
466f1c0b831SHendrik Brueckner 	struct cpu_cf_events *cpuhw = this_cpu_ptr(&cpu_cf_events);
467212188a5SHendrik Brueckner 
468fbbe0701SSukadev Bhattiprolu 	WARN_ON_ONCE(cpuhw->txn_flags);		/* txn already in flight */
469fbbe0701SSukadev Bhattiprolu 
470fbbe0701SSukadev Bhattiprolu 	cpuhw->txn_flags = txn_flags;
471fbbe0701SSukadev Bhattiprolu 	if (txn_flags & ~PERF_PMU_TXN_ADD)
472fbbe0701SSukadev Bhattiprolu 		return;
473fbbe0701SSukadev Bhattiprolu 
474212188a5SHendrik Brueckner 	perf_pmu_disable(pmu);
475212188a5SHendrik Brueckner 	cpuhw->tx_state = cpuhw->state;
476212188a5SHendrik Brueckner }
477212188a5SHendrik Brueckner 
478212188a5SHendrik Brueckner /*
479212188a5SHendrik Brueckner  * Stop and cancel a group events scheduling tranctions.
480212188a5SHendrik Brueckner  * Assumes cpumf_pmu_del() is called for each successful added
481212188a5SHendrik Brueckner  * cpumf_pmu_add() during the transaction.
482212188a5SHendrik Brueckner  */
483212188a5SHendrik Brueckner static void cpumf_pmu_cancel_txn(struct pmu *pmu)
484212188a5SHendrik Brueckner {
485fbbe0701SSukadev Bhattiprolu 	unsigned int txn_flags;
486f1c0b831SHendrik Brueckner 	struct cpu_cf_events *cpuhw = this_cpu_ptr(&cpu_cf_events);
487212188a5SHendrik Brueckner 
488fbbe0701SSukadev Bhattiprolu 	WARN_ON_ONCE(!cpuhw->txn_flags);	/* no txn in flight */
489fbbe0701SSukadev Bhattiprolu 
490fbbe0701SSukadev Bhattiprolu 	txn_flags = cpuhw->txn_flags;
491fbbe0701SSukadev Bhattiprolu 	cpuhw->txn_flags = 0;
492fbbe0701SSukadev Bhattiprolu 	if (txn_flags & ~PERF_PMU_TXN_ADD)
493fbbe0701SSukadev Bhattiprolu 		return;
494fbbe0701SSukadev Bhattiprolu 
495212188a5SHendrik Brueckner 	WARN_ON(cpuhw->tx_state != cpuhw->state);
496212188a5SHendrik Brueckner 
497212188a5SHendrik Brueckner 	perf_pmu_enable(pmu);
498212188a5SHendrik Brueckner }
499212188a5SHendrik Brueckner 
500212188a5SHendrik Brueckner /*
501212188a5SHendrik Brueckner  * Commit the group events scheduling transaction.  On success, the
502212188a5SHendrik Brueckner  * transaction is closed.   On error, the transaction is kept open
503212188a5SHendrik Brueckner  * until cpumf_pmu_cancel_txn() is called.
504212188a5SHendrik Brueckner  */
505212188a5SHendrik Brueckner static int cpumf_pmu_commit_txn(struct pmu *pmu)
506212188a5SHendrik Brueckner {
507f1c0b831SHendrik Brueckner 	struct cpu_cf_events *cpuhw = this_cpu_ptr(&cpu_cf_events);
508212188a5SHendrik Brueckner 	u64 state;
509212188a5SHendrik Brueckner 
510fbbe0701SSukadev Bhattiprolu 	WARN_ON_ONCE(!cpuhw->txn_flags);	/* no txn in flight */
511fbbe0701SSukadev Bhattiprolu 
512fbbe0701SSukadev Bhattiprolu 	if (cpuhw->txn_flags & ~PERF_PMU_TXN_ADD) {
513fbbe0701SSukadev Bhattiprolu 		cpuhw->txn_flags = 0;
514fbbe0701SSukadev Bhattiprolu 		return 0;
515fbbe0701SSukadev Bhattiprolu 	}
516fbbe0701SSukadev Bhattiprolu 
517212188a5SHendrik Brueckner 	/* check if the updated state can be scheduled */
518212188a5SHendrik Brueckner 	state = cpuhw->state & ~((1 << CPUMF_LCCTL_ENABLE_SHIFT) - 1);
519212188a5SHendrik Brueckner 	state >>= CPUMF_LCCTL_ENABLE_SHIFT;
520212188a5SHendrik Brueckner 	if ((state & cpuhw->info.auth_ctl) != state)
52158f8e9daSHendrik Brueckner 		return -ENOENT;
522212188a5SHendrik Brueckner 
523fbbe0701SSukadev Bhattiprolu 	cpuhw->txn_flags = 0;
524212188a5SHendrik Brueckner 	perf_pmu_enable(pmu);
525212188a5SHendrik Brueckner 	return 0;
526212188a5SHendrik Brueckner }
527212188a5SHendrik Brueckner 
528212188a5SHendrik Brueckner /* Performance monitoring unit for s390x */
529212188a5SHendrik Brueckner static struct pmu cpumf_pmu = {
5309254e70cSHendrik Brueckner 	.task_ctx_nr  = perf_sw_context,
5319254e70cSHendrik Brueckner 	.capabilities = PERF_PMU_CAP_NO_INTERRUPT,
532212188a5SHendrik Brueckner 	.pmu_enable   = cpumf_pmu_enable,
533212188a5SHendrik Brueckner 	.pmu_disable  = cpumf_pmu_disable,
534212188a5SHendrik Brueckner 	.event_init   = cpumf_pmu_event_init,
535212188a5SHendrik Brueckner 	.add	      = cpumf_pmu_add,
536212188a5SHendrik Brueckner 	.del	      = cpumf_pmu_del,
537212188a5SHendrik Brueckner 	.start	      = cpumf_pmu_start,
538212188a5SHendrik Brueckner 	.stop	      = cpumf_pmu_stop,
539212188a5SHendrik Brueckner 	.read	      = cpumf_pmu_read,
540212188a5SHendrik Brueckner 	.start_txn    = cpumf_pmu_start_txn,
541212188a5SHendrik Brueckner 	.commit_txn   = cpumf_pmu_commit_txn,
542212188a5SHendrik Brueckner 	.cancel_txn   = cpumf_pmu_cancel_txn,
543212188a5SHendrik Brueckner };
544212188a5SHendrik Brueckner 
545212188a5SHendrik Brueckner static int __init cpumf_pmu_init(void)
546212188a5SHendrik Brueckner {
547212188a5SHendrik Brueckner 	int rc;
548212188a5SHendrik Brueckner 
5497f5ac1a0SHendrik Brueckner 	if (!kernel_cpumcf_avail())
550212188a5SHendrik Brueckner 		return -ENODEV;
551212188a5SHendrik Brueckner 
552c7168325SHendrik Brueckner 	cpumf_pmu.attr_groups = cpumf_cf_event_group();
5536a82e23fSThomas Richter 	rc = perf_pmu_register(&cpumf_pmu, "cpum_cf", -1);
5547f5ac1a0SHendrik Brueckner 	if (rc)
555212188a5SHendrik Brueckner 		pr_err("Registering the cpum_cf PMU failed with rc=%i\n", rc);
556212188a5SHendrik Brueckner 	return rc;
557212188a5SHendrik Brueckner }
5587f5ac1a0SHendrik Brueckner subsys_initcall(cpumf_pmu_init);
559