Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | #include <linux/config.h> |
2 | #include <linux/sysdev.h> | |
3 | #include <linux/cpu.h> | |
4 | #include <linux/smp.h> | |
5 | #include <linux/percpu.h> | |
6 | #include <linux/init.h> | |
7 | #include <linux/sched.h> | |
8 | #include <linux/module.h> | |
9 | #include <linux/nodemask.h> | |
10 | #include <linux/cpumask.h> | |
11 | #include <linux/notifier.h> | |
12 | ||
13 | #include <asm/current.h> | |
14 | #include <asm/processor.h> | |
15 | #include <asm/cputable.h> | |
1ababe11 | 16 | #include <asm/firmware.h> |
1da177e4 LT |
17 | #include <asm/hvcall.h> |
18 | #include <asm/prom.h> | |
19 | #include <asm/systemcfg.h> | |
20 | #include <asm/paca.h> | |
21 | #include <asm/lppaca.h> | |
22 | #include <asm/machdep.h> | |
23 | ||
24 | static DEFINE_PER_CPU(struct cpu, cpu_devices); | |
25 | ||
26 | /* SMT stuff */ | |
27 | ||
28 | #ifdef CONFIG_PPC_MULTIPLATFORM | |
29 | /* default to snooze disabled */ | |
30 | DEFINE_PER_CPU(unsigned long, smt_snooze_delay); | |
31 | ||
32 | static ssize_t store_smt_snooze_delay(struct sys_device *dev, const char *buf, | |
33 | size_t count) | |
34 | { | |
35 | struct cpu *cpu = container_of(dev, struct cpu, sysdev); | |
36 | ssize_t ret; | |
37 | unsigned long snooze; | |
38 | ||
39 | ret = sscanf(buf, "%lu", &snooze); | |
40 | if (ret != 1) | |
41 | return -EINVAL; | |
42 | ||
43 | per_cpu(smt_snooze_delay, cpu->sysdev.id) = snooze; | |
44 | ||
45 | return count; | |
46 | } | |
47 | ||
48 | static ssize_t show_smt_snooze_delay(struct sys_device *dev, char *buf) | |
49 | { | |
50 | struct cpu *cpu = container_of(dev, struct cpu, sysdev); | |
51 | ||
52 | return sprintf(buf, "%lu\n", per_cpu(smt_snooze_delay, cpu->sysdev.id)); | |
53 | } | |
54 | ||
55 | static SYSDEV_ATTR(smt_snooze_delay, 0644, show_smt_snooze_delay, | |
56 | store_smt_snooze_delay); | |
57 | ||
58 | /* Only parse OF options if the matching cmdline option was not specified */ | |
59 | static int smt_snooze_cmdline; | |
60 | ||
61 | static int __init smt_setup(void) | |
62 | { | |
63 | struct device_node *options; | |
64 | unsigned int *val; | |
65 | unsigned int cpu; | |
66 | ||
67 | if (!cpu_has_feature(CPU_FTR_SMT)) | |
68 | return 1; | |
69 | ||
70 | options = find_path_device("/options"); | |
71 | if (!options) | |
72 | return 1; | |
73 | ||
74 | val = (unsigned int *)get_property(options, "ibm,smt-snooze-delay", | |
75 | NULL); | |
76 | if (!smt_snooze_cmdline && val) { | |
77 | for_each_cpu(cpu) | |
78 | per_cpu(smt_snooze_delay, cpu) = *val; | |
79 | } | |
80 | ||
81 | return 1; | |
82 | } | |
83 | __initcall(smt_setup); | |
84 | ||
85 | static int __init setup_smt_snooze_delay(char *str) | |
86 | { | |
87 | unsigned int cpu; | |
88 | int snooze; | |
89 | ||
90 | if (!cpu_has_feature(CPU_FTR_SMT)) | |
91 | return 1; | |
92 | ||
93 | smt_snooze_cmdline = 1; | |
94 | ||
95 | if (get_option(&str, &snooze)) { | |
96 | for_each_cpu(cpu) | |
97 | per_cpu(smt_snooze_delay, cpu) = snooze; | |
98 | } | |
99 | ||
100 | return 1; | |
101 | } | |
102 | __setup("smt-snooze-delay=", setup_smt_snooze_delay); | |
103 | ||
180a3362 ME |
104 | #endif /* CONFIG_PPC_MULTIPLATFORM */ |
105 | ||
1da177e4 LT |
106 | /* |
107 | * Enabling PMCs will slow partition context switch times so we only do | |
108 | * it the first time we write to the PMCs. | |
109 | */ | |
110 | ||
111 | static DEFINE_PER_CPU(char, pmcs_enabled); | |
112 | ||
113 | void ppc64_enable_pmcs(void) | |
114 | { | |
1da177e4 LT |
115 | /* Only need to enable them once */ |
116 | if (__get_cpu_var(pmcs_enabled)) | |
117 | return; | |
118 | ||
119 | __get_cpu_var(pmcs_enabled) = 1; | |
120 | ||
180a3362 ME |
121 | if (ppc_md.enable_pmcs) |
122 | ppc_md.enable_pmcs(); | |
1da177e4 | 123 | } |
1da177e4 LT |
124 | EXPORT_SYMBOL(ppc64_enable_pmcs); |
125 | ||
126 | /* XXX convert to rusty's on_one_cpu */ | |
127 | static unsigned long run_on_cpu(unsigned long cpu, | |
128 | unsigned long (*func)(unsigned long), | |
129 | unsigned long arg) | |
130 | { | |
131 | cpumask_t old_affinity = current->cpus_allowed; | |
132 | unsigned long ret; | |
133 | ||
134 | /* should return -EINVAL to userspace */ | |
135 | if (set_cpus_allowed(current, cpumask_of_cpu(cpu))) | |
136 | return 0; | |
137 | ||
138 | ret = func(arg); | |
139 | ||
140 | set_cpus_allowed(current, old_affinity); | |
141 | ||
142 | return ret; | |
143 | } | |
144 | ||
145 | #define SYSFS_PMCSETUP(NAME, ADDRESS) \ | |
146 | static unsigned long read_##NAME(unsigned long junk) \ | |
147 | { \ | |
148 | return mfspr(ADDRESS); \ | |
149 | } \ | |
150 | static unsigned long write_##NAME(unsigned long val) \ | |
151 | { \ | |
152 | ppc64_enable_pmcs(); \ | |
153 | mtspr(ADDRESS, val); \ | |
154 | return 0; \ | |
155 | } \ | |
156 | static ssize_t show_##NAME(struct sys_device *dev, char *buf) \ | |
157 | { \ | |
158 | struct cpu *cpu = container_of(dev, struct cpu, sysdev); \ | |
159 | unsigned long val = run_on_cpu(cpu->sysdev.id, read_##NAME, 0); \ | |
160 | return sprintf(buf, "%lx\n", val); \ | |
161 | } \ | |
162 | static ssize_t __attribute_used__ \ | |
163 | store_##NAME(struct sys_device *dev, const char *buf, size_t count) \ | |
164 | { \ | |
165 | struct cpu *cpu = container_of(dev, struct cpu, sysdev); \ | |
166 | unsigned long val; \ | |
167 | int ret = sscanf(buf, "%lx", &val); \ | |
168 | if (ret != 1) \ | |
169 | return -EINVAL; \ | |
170 | run_on_cpu(cpu->sysdev.id, write_##NAME, val); \ | |
171 | return count; \ | |
172 | } | |
173 | ||
174 | SYSFS_PMCSETUP(mmcr0, SPRN_MMCR0); | |
175 | SYSFS_PMCSETUP(mmcr1, SPRN_MMCR1); | |
176 | SYSFS_PMCSETUP(mmcra, SPRN_MMCRA); | |
177 | SYSFS_PMCSETUP(pmc1, SPRN_PMC1); | |
178 | SYSFS_PMCSETUP(pmc2, SPRN_PMC2); | |
179 | SYSFS_PMCSETUP(pmc3, SPRN_PMC3); | |
180 | SYSFS_PMCSETUP(pmc4, SPRN_PMC4); | |
181 | SYSFS_PMCSETUP(pmc5, SPRN_PMC5); | |
182 | SYSFS_PMCSETUP(pmc6, SPRN_PMC6); | |
183 | SYSFS_PMCSETUP(pmc7, SPRN_PMC7); | |
184 | SYSFS_PMCSETUP(pmc8, SPRN_PMC8); | |
185 | SYSFS_PMCSETUP(purr, SPRN_PURR); | |
186 | ||
187 | static SYSDEV_ATTR(mmcr0, 0600, show_mmcr0, store_mmcr0); | |
188 | static SYSDEV_ATTR(mmcr1, 0600, show_mmcr1, store_mmcr1); | |
189 | static SYSDEV_ATTR(mmcra, 0600, show_mmcra, store_mmcra); | |
190 | static SYSDEV_ATTR(pmc1, 0600, show_pmc1, store_pmc1); | |
191 | static SYSDEV_ATTR(pmc2, 0600, show_pmc2, store_pmc2); | |
192 | static SYSDEV_ATTR(pmc3, 0600, show_pmc3, store_pmc3); | |
193 | static SYSDEV_ATTR(pmc4, 0600, show_pmc4, store_pmc4); | |
194 | static SYSDEV_ATTR(pmc5, 0600, show_pmc5, store_pmc5); | |
195 | static SYSDEV_ATTR(pmc6, 0600, show_pmc6, store_pmc6); | |
196 | static SYSDEV_ATTR(pmc7, 0600, show_pmc7, store_pmc7); | |
197 | static SYSDEV_ATTR(pmc8, 0600, show_pmc8, store_pmc8); | |
198 | static SYSDEV_ATTR(purr, 0600, show_purr, NULL); | |
199 | ||
200 | static void register_cpu_online(unsigned int cpu) | |
201 | { | |
202 | struct cpu *c = &per_cpu(cpu_devices, cpu); | |
203 | struct sys_device *s = &c->sysdev; | |
204 | ||
205 | #ifndef CONFIG_PPC_ISERIES | |
206 | if (cpu_has_feature(CPU_FTR_SMT)) | |
207 | sysdev_create_file(s, &attr_smt_snooze_delay); | |
208 | #endif | |
209 | ||
210 | /* PMC stuff */ | |
211 | ||
212 | sysdev_create_file(s, &attr_mmcr0); | |
213 | sysdev_create_file(s, &attr_mmcr1); | |
214 | ||
215 | if (cpu_has_feature(CPU_FTR_MMCRA)) | |
216 | sysdev_create_file(s, &attr_mmcra); | |
217 | ||
218 | sysdev_create_file(s, &attr_pmc1); | |
219 | sysdev_create_file(s, &attr_pmc2); | |
220 | sysdev_create_file(s, &attr_pmc3); | |
221 | sysdev_create_file(s, &attr_pmc4); | |
222 | sysdev_create_file(s, &attr_pmc5); | |
223 | sysdev_create_file(s, &attr_pmc6); | |
224 | ||
225 | if (cpu_has_feature(CPU_FTR_PMC8)) { | |
226 | sysdev_create_file(s, &attr_pmc7); | |
227 | sysdev_create_file(s, &attr_pmc8); | |
228 | } | |
229 | ||
230 | if (cpu_has_feature(CPU_FTR_SMT)) | |
231 | sysdev_create_file(s, &attr_purr); | |
232 | } | |
233 | ||
234 | #ifdef CONFIG_HOTPLUG_CPU | |
235 | static void unregister_cpu_online(unsigned int cpu) | |
236 | { | |
237 | struct cpu *c = &per_cpu(cpu_devices, cpu); | |
238 | struct sys_device *s = &c->sysdev; | |
239 | ||
240 | BUG_ON(c->no_control); | |
241 | ||
242 | #ifndef CONFIG_PPC_ISERIES | |
243 | if (cpu_has_feature(CPU_FTR_SMT)) | |
244 | sysdev_remove_file(s, &attr_smt_snooze_delay); | |
245 | #endif | |
246 | ||
247 | /* PMC stuff */ | |
248 | ||
249 | sysdev_remove_file(s, &attr_mmcr0); | |
250 | sysdev_remove_file(s, &attr_mmcr1); | |
251 | ||
252 | if (cpu_has_feature(CPU_FTR_MMCRA)) | |
253 | sysdev_remove_file(s, &attr_mmcra); | |
254 | ||
255 | sysdev_remove_file(s, &attr_pmc1); | |
256 | sysdev_remove_file(s, &attr_pmc2); | |
257 | sysdev_remove_file(s, &attr_pmc3); | |
258 | sysdev_remove_file(s, &attr_pmc4); | |
259 | sysdev_remove_file(s, &attr_pmc5); | |
260 | sysdev_remove_file(s, &attr_pmc6); | |
261 | ||
262 | if (cpu_has_feature(CPU_FTR_PMC8)) { | |
263 | sysdev_remove_file(s, &attr_pmc7); | |
264 | sysdev_remove_file(s, &attr_pmc8); | |
265 | } | |
266 | ||
267 | if (cpu_has_feature(CPU_FTR_SMT)) | |
268 | sysdev_remove_file(s, &attr_purr); | |
269 | } | |
270 | #endif /* CONFIG_HOTPLUG_CPU */ | |
271 | ||
272 | static int __devinit sysfs_cpu_notify(struct notifier_block *self, | |
273 | unsigned long action, void *hcpu) | |
274 | { | |
275 | unsigned int cpu = (unsigned int)(long)hcpu; | |
276 | ||
277 | switch (action) { | |
278 | case CPU_ONLINE: | |
279 | register_cpu_online(cpu); | |
280 | break; | |
281 | #ifdef CONFIG_HOTPLUG_CPU | |
282 | case CPU_DEAD: | |
283 | unregister_cpu_online(cpu); | |
284 | break; | |
285 | #endif | |
286 | } | |
287 | return NOTIFY_OK; | |
288 | } | |
289 | ||
290 | static struct notifier_block __devinitdata sysfs_cpu_nb = { | |
291 | .notifier_call = sysfs_cpu_notify, | |
292 | }; | |
293 | ||
294 | /* NUMA stuff */ | |
295 | ||
296 | #ifdef CONFIG_NUMA | |
297 | static struct node node_devices[MAX_NUMNODES]; | |
298 | ||
299 | static void register_nodes(void) | |
300 | { | |
301 | int i; | |
302 | ||
303 | for (i = 0; i < MAX_NUMNODES; i++) { | |
304 | if (node_online(i)) { | |
305 | int p_node = parent_node(i); | |
306 | struct node *parent = NULL; | |
307 | ||
308 | if (p_node != i) | |
309 | parent = &node_devices[p_node]; | |
310 | ||
311 | register_node(&node_devices[i], i, parent); | |
312 | } | |
313 | } | |
314 | } | |
315 | #else | |
316 | static void register_nodes(void) | |
317 | { | |
318 | return; | |
319 | } | |
320 | #endif | |
321 | ||
322 | /* Only valid if CPU is present. */ | |
323 | static ssize_t show_physical_id(struct sys_device *dev, char *buf) | |
324 | { | |
325 | struct cpu *cpu = container_of(dev, struct cpu, sysdev); | |
326 | ||
327 | return sprintf(buf, "%d\n", get_hard_smp_processor_id(cpu->sysdev.id)); | |
328 | } | |
329 | static SYSDEV_ATTR(physical_id, 0444, show_physical_id, NULL); | |
330 | ||
331 | static int __init topology_init(void) | |
332 | { | |
333 | int cpu; | |
334 | struct node *parent = NULL; | |
335 | ||
336 | register_nodes(); | |
337 | ||
338 | register_cpu_notifier(&sysfs_cpu_nb); | |
339 | ||
340 | for_each_cpu(cpu) { | |
341 | struct cpu *c = &per_cpu(cpu_devices, cpu); | |
342 | ||
343 | #ifdef CONFIG_NUMA | |
f5f1cc54 NL |
344 | /* The node to which a cpu belongs can't be known |
345 | * until the cpu is made present. | |
346 | */ | |
347 | parent = NULL; | |
348 | if (cpu_present(cpu)) | |
349 | parent = &node_devices[cpu_to_node(cpu)]; | |
1da177e4 LT |
350 | #endif |
351 | /* | |
352 | * For now, we just see if the system supports making | |
353 | * the RTAS calls for CPU hotplug. But, there may be a | |
354 | * more comprehensive way to do this for an individual | |
355 | * CPU. For instance, the boot cpu might never be valid | |
356 | * for hotplugging. | |
357 | */ | |
358 | if (!ppc_md.cpu_die) | |
359 | c->no_control = 1; | |
360 | ||
361 | if (cpu_online(cpu) || (c->no_control == 0)) { | |
362 | register_cpu(c, cpu, parent); | |
363 | ||
364 | sysdev_create_file(&c->sysdev, &attr_physical_id); | |
365 | } | |
366 | ||
367 | if (cpu_online(cpu)) | |
368 | register_cpu_online(cpu); | |
369 | } | |
370 | ||
371 | return 0; | |
372 | } | |
373 | __initcall(topology_init); |