1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * CPU-Measurement Counter Facility Support - Common Layer
4 *
5 * Copyright IBM Corp. 2019
6 * Author(s): Hendrik Brueckner <brueckner@linux.ibm.com>
7 */
8 #define KMSG_COMPONENT "cpum_cf_common"
9 #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
10
11 #include <linux/kernel.h>
12 #include <linux/kernel_stat.h>
13 #include <linux/percpu.h>
14 #include <linux/notifier.h>
15 #include <linux/init.h>
16 #include <linux/export.h>
17 #include <asm/ctl_reg.h>
18 #include <asm/irq.h>
19 #include <asm/cpu_mcf.h>
20
21 /* Per-CPU event structure for the counter facility */
22 DEFINE_PER_CPU(struct cpu_cf_events, cpu_cf_events) = {
23 .ctr_set = {
24 [CPUMF_CTR_SET_BASIC] = ATOMIC_INIT(0),
25 [CPUMF_CTR_SET_USER] = ATOMIC_INIT(0),
26 [CPUMF_CTR_SET_CRYPTO] = ATOMIC_INIT(0),
27 [CPUMF_CTR_SET_EXT] = ATOMIC_INIT(0),
28 [CPUMF_CTR_SET_MT_DIAG] = ATOMIC_INIT(0),
29 },
30 .alert = ATOMIC64_INIT(0),
31 .state = 0,
32 .flags = 0,
33 .txn_flags = 0,
34 };
35 /* Indicator whether the CPU-Measurement Counter Facility Support is ready */
36 static bool cpum_cf_initalized;
37
38 /* CPU-measurement alerts for the counter facility */
cpumf_measurement_alert(struct ext_code ext_code,unsigned int alert,unsigned long unused)39 static void cpumf_measurement_alert(struct ext_code ext_code,
40 unsigned int alert, unsigned long unused)
41 {
42 struct cpu_cf_events *cpuhw;
43
44 if (!(alert & CPU_MF_INT_CF_MASK))
45 return;
46
47 inc_irq_stat(IRQEXT_CMC);
48 cpuhw = this_cpu_ptr(&cpu_cf_events);
49
50 /* Measurement alerts are shared and might happen when the PMU
51 * is not reserved. Ignore these alerts in this case. */
52 if (!(cpuhw->flags & PMU_F_RESERVED))
53 return;
54
55 /* counter authorization change alert */
56 if (alert & CPU_MF_INT_CF_CACA)
57 qctri(&cpuhw->info);
58
59 /* loss of counter data alert */
60 if (alert & CPU_MF_INT_CF_LCDA)
61 pr_err("CPU[%i] Counter data was lost\n", smp_processor_id());
62
63 /* loss of MT counter data alert */
64 if (alert & CPU_MF_INT_CF_MTDA)
65 pr_warn("CPU[%i] MT counter data was lost\n",
66 smp_processor_id());
67
68 /* store alert for special handling by in-kernel users */
69 atomic64_or(alert, &cpuhw->alert);
70 }
71
72 #define PMC_INIT 0
73 #define PMC_RELEASE 1
cpum_cf_setup_cpu(void * flags)74 static void cpum_cf_setup_cpu(void *flags)
75 {
76 struct cpu_cf_events *cpuhw = this_cpu_ptr(&cpu_cf_events);
77
78 switch (*((int *) flags)) {
79 case PMC_INIT:
80 memset(&cpuhw->info, 0, sizeof(cpuhw->info));
81 qctri(&cpuhw->info);
82 cpuhw->flags |= PMU_F_RESERVED;
83 break;
84
85 case PMC_RELEASE:
86 cpuhw->flags &= ~PMU_F_RESERVED;
87 break;
88 }
89
90 /* Disable CPU counter sets */
91 lcctl(0);
92 }
93
kernel_cpumcf_avail(void)94 bool kernel_cpumcf_avail(void)
95 {
96 return cpum_cf_initalized;
97 }
98 EXPORT_SYMBOL(kernel_cpumcf_avail);
99
100
101 /* Reserve/release functions for sharing perf hardware */
102 static DEFINE_SPINLOCK(cpumcf_owner_lock);
103 static void *cpumcf_owner;
104
105 /* Initialize the CPU-measurement counter facility */
__kernel_cpumcf_begin(void)106 int __kernel_cpumcf_begin(void)
107 {
108 int flags = PMC_INIT;
109 int err = 0;
110
111 spin_lock(&cpumcf_owner_lock);
112 if (cpumcf_owner)
113 err = -EBUSY;
114 else
115 cpumcf_owner = __builtin_return_address(0);
116 spin_unlock(&cpumcf_owner_lock);
117 if (err)
118 return err;
119
120 on_each_cpu(cpum_cf_setup_cpu, &flags, 1);
121 irq_subclass_register(IRQ_SUBCLASS_MEASUREMENT_ALERT);
122
123 return 0;
124 }
125 EXPORT_SYMBOL(__kernel_cpumcf_begin);
126
127 /* Obtain the CPU-measurement alerts for the counter facility */
kernel_cpumcf_alert(int clear)128 unsigned long kernel_cpumcf_alert(int clear)
129 {
130 struct cpu_cf_events *cpuhw = this_cpu_ptr(&cpu_cf_events);
131 unsigned long alert;
132
133 alert = atomic64_read(&cpuhw->alert);
134 if (clear)
135 atomic64_set(&cpuhw->alert, 0);
136
137 return alert;
138 }
139 EXPORT_SYMBOL(kernel_cpumcf_alert);
140
141 /* Release the CPU-measurement counter facility */
__kernel_cpumcf_end(void)142 void __kernel_cpumcf_end(void)
143 {
144 int flags = PMC_RELEASE;
145
146 on_each_cpu(cpum_cf_setup_cpu, &flags, 1);
147 irq_subclass_unregister(IRQ_SUBCLASS_MEASUREMENT_ALERT);
148
149 spin_lock(&cpumcf_owner_lock);
150 cpumcf_owner = NULL;
151 spin_unlock(&cpumcf_owner_lock);
152 }
153 EXPORT_SYMBOL(__kernel_cpumcf_end);
154
cpum_cf_setup(unsigned int cpu,int flags)155 static int cpum_cf_setup(unsigned int cpu, int flags)
156 {
157 local_irq_disable();
158 cpum_cf_setup_cpu(&flags);
159 local_irq_enable();
160 return 0;
161 }
162
cpum_cf_online_cpu(unsigned int cpu)163 static int cpum_cf_online_cpu(unsigned int cpu)
164 {
165 return cpum_cf_setup(cpu, PMC_INIT);
166 }
167
cpum_cf_offline_cpu(unsigned int cpu)168 static int cpum_cf_offline_cpu(unsigned int cpu)
169 {
170 return cpum_cf_setup(cpu, PMC_RELEASE);
171 }
172
cpum_cf_init(void)173 static int __init cpum_cf_init(void)
174 {
175 int rc;
176
177 if (!cpum_cf_avail())
178 return -ENODEV;
179
180 /* clear bit 15 of cr0 to unauthorize problem-state to
181 * extract measurement counters */
182 ctl_clear_bit(0, 48);
183
184 /* register handler for measurement-alert interruptions */
185 rc = register_external_irq(EXT_IRQ_MEASURE_ALERT,
186 cpumf_measurement_alert);
187 if (rc) {
188 pr_err("Registering for CPU-measurement alerts "
189 "failed with rc=%i\n", rc);
190 return rc;
191 }
192
193 rc = cpuhp_setup_state(CPUHP_AP_PERF_S390_CF_ONLINE,
194 "perf/s390/cf:online",
195 cpum_cf_online_cpu, cpum_cf_offline_cpu);
196 if (!rc)
197 cpum_cf_initalized = true;
198
199 return rc;
200 }
201 early_initcall(cpum_cf_init);
202