Root/
1 | /* |
2 | * acpi_processor.c - ACPI Processor Driver ($Revision: 71 $) |
3 | * |
4 | * Copyright (C) 2001, 2002 Andy Grover <andrew.grover@intel.com> |
5 | * Copyright (C) 2001, 2002 Paul Diefenbaugh <paul.s.diefenbaugh@intel.com> |
6 | * Copyright (C) 2004 Dominik Brodowski <linux@brodo.de> |
7 | * Copyright (C) 2004 Anil S Keshavamurthy <anil.s.keshavamurthy@intel.com> |
8 | * - Added processor hotplug support |
9 | * |
10 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ |
11 | * |
12 | * This program is free software; you can redistribute it and/or modify |
13 | * it under the terms of the GNU General Public License as published by |
14 | * the Free Software Foundation; either version 2 of the License, or (at |
15 | * your option) any later version. |
16 | * |
17 | * This program is distributed in the hope that it will be useful, but |
18 | * WITHOUT ANY WARRANTY; without even the implied warranty of |
19 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
20 | * General Public License for more details. |
21 | * |
22 | * You should have received a copy of the GNU General Public License along |
23 | * with this program; if not, write to the Free Software Foundation, Inc., |
24 | * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA. |
25 | * |
26 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ |
27 | * TBD: |
28 | * 1. Make # power states dynamic. |
29 | * 2. Support duty_cycle values that span bit 4. |
30 | * 3. Optimize by having scheduler determine business instead of |
31 | * having us try to calculate it here. |
32 | * 4. Need C1 timing -- must modify kernel (IRQ handler) to get this. |
33 | */ |
34 | |
35 | #include <linux/kernel.h> |
36 | #include <linux/module.h> |
37 | #include <linux/init.h> |
38 | #include <linux/types.h> |
39 | #include <linux/pci.h> |
40 | #include <linux/pm.h> |
41 | #include <linux/cpufreq.h> |
42 | #include <linux/cpu.h> |
43 | #include <linux/dmi.h> |
44 | #include <linux/moduleparam.h> |
45 | #include <linux/cpuidle.h> |
46 | #include <linux/slab.h> |
47 | #include <linux/acpi.h> |
48 | #include <linux/memory_hotplug.h> |
49 | |
50 | #include <asm/io.h> |
51 | #include <asm/cpu.h> |
52 | #include <asm/delay.h> |
53 | #include <asm/uaccess.h> |
54 | #include <asm/processor.h> |
55 | #include <asm/smp.h> |
56 | #include <asm/acpi.h> |
57 | |
58 | #include <acpi/acpi_bus.h> |
59 | #include <acpi/acpi_drivers.h> |
60 | #include <acpi/processor.h> |
61 | |
62 | #define PREFIX "ACPI: " |
63 | |
64 | #define ACPI_PROCESSOR_CLASS "processor" |
65 | #define ACPI_PROCESSOR_DEVICE_NAME "Processor" |
66 | #define ACPI_PROCESSOR_FILE_INFO "info" |
67 | #define ACPI_PROCESSOR_FILE_THROTTLING "throttling" |
68 | #define ACPI_PROCESSOR_FILE_LIMIT "limit" |
69 | #define ACPI_PROCESSOR_NOTIFY_PERFORMANCE 0x80 |
70 | #define ACPI_PROCESSOR_NOTIFY_POWER 0x81 |
71 | #define ACPI_PROCESSOR_NOTIFY_THROTTLING 0x82 |
72 | #define ACPI_PROCESSOR_DEVICE_HID "ACPI0007" |
73 | |
74 | #define ACPI_PROCESSOR_LIMIT_USER 0 |
75 | #define ACPI_PROCESSOR_LIMIT_THERMAL 1 |
76 | |
77 | #define _COMPONENT ACPI_PROCESSOR_COMPONENT |
78 | ACPI_MODULE_NAME("processor_driver"); |
79 | |
80 | MODULE_AUTHOR("Paul Diefenbaugh"); |
81 | MODULE_DESCRIPTION("ACPI Processor Driver"); |
82 | MODULE_LICENSE("GPL"); |
83 | |
84 | static int acpi_processor_add(struct acpi_device *device); |
85 | static int acpi_processor_remove(struct acpi_device *device); |
86 | static void acpi_processor_notify(struct acpi_device *device, u32 event); |
87 | static acpi_status acpi_processor_hotadd_init(struct acpi_processor *pr); |
88 | static int acpi_processor_handle_eject(struct acpi_processor *pr); |
89 | static int acpi_processor_start(struct acpi_processor *pr); |
90 | |
91 | static const struct acpi_device_id processor_device_ids[] = { |
92 | {ACPI_PROCESSOR_OBJECT_HID, 0}, |
93 | {ACPI_PROCESSOR_DEVICE_HID, 0}, |
94 | {"", 0}, |
95 | }; |
96 | MODULE_DEVICE_TABLE(acpi, processor_device_ids); |
97 | |
98 | static SIMPLE_DEV_PM_OPS(acpi_processor_pm, |
99 | acpi_processor_suspend, acpi_processor_resume); |
100 | |
101 | static struct acpi_driver acpi_processor_driver = { |
102 | .name = "processor", |
103 | .class = ACPI_PROCESSOR_CLASS, |
104 | .ids = processor_device_ids, |
105 | .ops = { |
106 | .add = acpi_processor_add, |
107 | .remove = acpi_processor_remove, |
108 | .notify = acpi_processor_notify, |
109 | }, |
110 | .drv.pm = &acpi_processor_pm, |
111 | }; |
112 | |
113 | #define INSTALL_NOTIFY_HANDLER 1 |
114 | #define UNINSTALL_NOTIFY_HANDLER 2 |
115 | |
116 | DEFINE_PER_CPU(struct acpi_processor *, processors); |
117 | EXPORT_PER_CPU_SYMBOL(processors); |
118 | |
119 | struct acpi_processor_errata errata __read_mostly; |
120 | |
121 | /* -------------------------------------------------------------------------- |
122 | Errata Handling |
123 | -------------------------------------------------------------------------- */ |
124 | |
125 | static int acpi_processor_errata_piix4(struct pci_dev *dev) |
126 | { |
127 | u8 value1 = 0; |
128 | u8 value2 = 0; |
129 | |
130 | |
131 | if (!dev) |
132 | return -EINVAL; |
133 | |
134 | /* |
135 | * Note that 'dev' references the PIIX4 ACPI Controller. |
136 | */ |
137 | |
138 | switch (dev->revision) { |
139 | case 0: |
140 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found PIIX4 A-step\n")); |
141 | break; |
142 | case 1: |
143 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found PIIX4 B-step\n")); |
144 | break; |
145 | case 2: |
146 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found PIIX4E\n")); |
147 | break; |
148 | case 3: |
149 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found PIIX4M\n")); |
150 | break; |
151 | default: |
152 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found unknown PIIX4\n")); |
153 | break; |
154 | } |
155 | |
156 | switch (dev->revision) { |
157 | |
158 | case 0: /* PIIX4 A-step */ |
159 | case 1: /* PIIX4 B-step */ |
160 | /* |
161 | * See specification changes #13 ("Manual Throttle Duty Cycle") |
162 | * and #14 ("Enabling and Disabling Manual Throttle"), plus |
163 | * erratum #5 ("STPCLK# Deassertion Time") from the January |
164 | * 2002 PIIX4 specification update. Applies to only older |
165 | * PIIX4 models. |
166 | */ |
167 | errata.piix4.throttle = 1; |
168 | |
169 | case 2: /* PIIX4E */ |
170 | case 3: /* PIIX4M */ |
171 | /* |
172 | * See erratum #18 ("C3 Power State/BMIDE and Type-F DMA |
173 | * Livelock") from the January 2002 PIIX4 specification update. |
174 | * Applies to all PIIX4 models. |
175 | */ |
176 | |
177 | /* |
178 | * BM-IDE |
179 | * ------ |
180 | * Find the PIIX4 IDE Controller and get the Bus Master IDE |
181 | * Status register address. We'll use this later to read |
182 | * each IDE controller's DMA status to make sure we catch all |
183 | * DMA activity. |
184 | */ |
185 | dev = pci_get_subsys(PCI_VENDOR_ID_INTEL, |
186 | PCI_DEVICE_ID_INTEL_82371AB, |
187 | PCI_ANY_ID, PCI_ANY_ID, NULL); |
188 | if (dev) { |
189 | errata.piix4.bmisx = pci_resource_start(dev, 4); |
190 | pci_dev_put(dev); |
191 | } |
192 | |
193 | /* |
194 | * Type-F DMA |
195 | * ---------- |
196 | * Find the PIIX4 ISA Controller and read the Motherboard |
197 | * DMA controller's status to see if Type-F (Fast) DMA mode |
198 | * is enabled (bit 7) on either channel. Note that we'll |
199 | * disable C3 support if this is enabled, as some legacy |
200 | * devices won't operate well if fast DMA is disabled. |
201 | */ |
202 | dev = pci_get_subsys(PCI_VENDOR_ID_INTEL, |
203 | PCI_DEVICE_ID_INTEL_82371AB_0, |
204 | PCI_ANY_ID, PCI_ANY_ID, NULL); |
205 | if (dev) { |
206 | pci_read_config_byte(dev, 0x76, &value1); |
207 | pci_read_config_byte(dev, 0x77, &value2); |
208 | if ((value1 & 0x80) || (value2 & 0x80)) |
209 | errata.piix4.fdma = 1; |
210 | pci_dev_put(dev); |
211 | } |
212 | |
213 | break; |
214 | } |
215 | |
216 | if (errata.piix4.bmisx) |
217 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, |
218 | "Bus master activity detection (BM-IDE) erratum enabled\n")); |
219 | if (errata.piix4.fdma) |
220 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, |
221 | "Type-F DMA livelock erratum (C3 disabled)\n")); |
222 | |
223 | return 0; |
224 | } |
225 | |
226 | static int acpi_processor_errata(struct acpi_processor *pr) |
227 | { |
228 | int result = 0; |
229 | struct pci_dev *dev = NULL; |
230 | |
231 | |
232 | if (!pr) |
233 | return -EINVAL; |
234 | |
235 | /* |
236 | * PIIX4 |
237 | */ |
238 | dev = pci_get_subsys(PCI_VENDOR_ID_INTEL, |
239 | PCI_DEVICE_ID_INTEL_82371AB_3, PCI_ANY_ID, |
240 | PCI_ANY_ID, NULL); |
241 | if (dev) { |
242 | result = acpi_processor_errata_piix4(dev); |
243 | pci_dev_put(dev); |
244 | } |
245 | |
246 | return result; |
247 | } |
248 | |
249 | /* -------------------------------------------------------------------------- |
250 | Driver Interface |
251 | -------------------------------------------------------------------------- */ |
252 | |
253 | static int acpi_processor_get_info(struct acpi_device *device) |
254 | { |
255 | acpi_status status = 0; |
256 | union acpi_object object = { 0 }; |
257 | struct acpi_buffer buffer = { sizeof(union acpi_object), &object }; |
258 | struct acpi_processor *pr; |
259 | int cpu_index, device_declaration = 0; |
260 | static int cpu0_initialized; |
261 | |
262 | pr = acpi_driver_data(device); |
263 | if (!pr) |
264 | return -EINVAL; |
265 | |
266 | if (num_online_cpus() > 1) |
267 | errata.smp = TRUE; |
268 | |
269 | acpi_processor_errata(pr); |
270 | |
271 | /* |
272 | * Check to see if we have bus mastering arbitration control. This |
273 | * is required for proper C3 usage (to maintain cache coherency). |
274 | */ |
275 | if (acpi_gbl_FADT.pm2_control_block && acpi_gbl_FADT.pm2_control_length) { |
276 | pr->flags.bm_control = 1; |
277 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, |
278 | "Bus mastering arbitration control present\n")); |
279 | } else |
280 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, |
281 | "No bus mastering arbitration control\n")); |
282 | |
283 | if (!strcmp(acpi_device_hid(device), ACPI_PROCESSOR_OBJECT_HID)) { |
284 | /* Declared with "Processor" statement; match ProcessorID */ |
285 | status = acpi_evaluate_object(pr->handle, NULL, NULL, &buffer); |
286 | if (ACPI_FAILURE(status)) { |
287 | dev_err(&device->dev, |
288 | "Failed to evaluate processor object (0x%x)\n", |
289 | status); |
290 | return -ENODEV; |
291 | } |
292 | |
293 | /* |
294 | * TBD: Synch processor ID (via LAPIC/LSAPIC structures) on SMP. |
295 | * >>> 'acpi_get_processor_id(acpi_id, &id)' in |
296 | * arch/xxx/acpi.c |
297 | */ |
298 | pr->acpi_id = object.processor.proc_id; |
299 | } else { |
300 | /* |
301 | * Declared with "Device" statement; match _UID. |
302 | * Note that we don't handle string _UIDs yet. |
303 | */ |
304 | unsigned long long value; |
305 | status = acpi_evaluate_integer(pr->handle, METHOD_NAME__UID, |
306 | NULL, &value); |
307 | if (ACPI_FAILURE(status)) { |
308 | dev_err(&device->dev, |
309 | "Failed to evaluate processor _UID (0x%x)\n", |
310 | status); |
311 | return -ENODEV; |
312 | } |
313 | device_declaration = 1; |
314 | pr->acpi_id = value; |
315 | } |
316 | cpu_index = acpi_get_cpuid(pr->handle, device_declaration, pr->acpi_id); |
317 | |
318 | /* Handle UP system running SMP kernel, with no LAPIC in MADT */ |
319 | if (!cpu0_initialized && (cpu_index == -1) && |
320 | (num_online_cpus() == 1)) { |
321 | cpu_index = 0; |
322 | } |
323 | |
324 | cpu0_initialized = 1; |
325 | |
326 | pr->id = cpu_index; |
327 | |
328 | /* |
329 | * Extra Processor objects may be enumerated on MP systems with |
330 | * less than the max # of CPUs. They should be ignored _iff |
331 | * they are physically not present. |
332 | */ |
333 | if (pr->id == -1) { |
334 | if (ACPI_FAILURE(acpi_processor_hotadd_init(pr))) |
335 | return -ENODEV; |
336 | } |
337 | /* |
338 | * On some boxes several processors use the same processor bus id. |
339 | * But they are located in different scope. For example: |
340 | * \_SB.SCK0.CPU0 |
341 | * \_SB.SCK1.CPU0 |
342 | * Rename the processor device bus id. And the new bus id will be |
343 | * generated as the following format: |
344 | * CPU+CPU ID. |
345 | */ |
346 | sprintf(acpi_device_bid(device), "CPU%X", pr->id); |
347 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Processor [%d:%d]\n", pr->id, |
348 | pr->acpi_id)); |
349 | |
350 | if (!object.processor.pblk_address) |
351 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "No PBLK (NULL address)\n")); |
352 | else if (object.processor.pblk_length != 6) |
353 | dev_err(&device->dev, "Invalid PBLK length [%d]\n", |
354 | object.processor.pblk_length); |
355 | else { |
356 | pr->throttling.address = object.processor.pblk_address; |
357 | pr->throttling.duty_offset = acpi_gbl_FADT.duty_offset; |
358 | pr->throttling.duty_width = acpi_gbl_FADT.duty_width; |
359 | |
360 | pr->pblk = object.processor.pblk_address; |
361 | |
362 | /* |
363 | * We don't care about error returns - we just try to mark |
364 | * these reserved so that nobody else is confused into thinking |
365 | * that this region might be unused.. |
366 | * |
367 | * (In particular, allocating the IO range for Cardbus) |
368 | */ |
369 | request_region(pr->throttling.address, 6, "ACPI CPU throttle"); |
370 | } |
371 | |
372 | /* |
373 | * If ACPI describes a slot number for this CPU, we can use it |
374 | * ensure we get the right value in the "physical id" field |
375 | * of /proc/cpuinfo |
376 | */ |
377 | status = acpi_evaluate_object(pr->handle, "_SUN", NULL, &buffer); |
378 | if (ACPI_SUCCESS(status)) |
379 | arch_fix_phys_package_id(pr->id, object.integer.value); |
380 | |
381 | return 0; |
382 | } |
383 | |
384 | static DEFINE_PER_CPU(void *, processor_device_array); |
385 | |
386 | static void acpi_processor_notify(struct acpi_device *device, u32 event) |
387 | { |
388 | struct acpi_processor *pr = acpi_driver_data(device); |
389 | int saved; |
390 | |
391 | if (!pr) |
392 | return; |
393 | |
394 | switch (event) { |
395 | case ACPI_PROCESSOR_NOTIFY_PERFORMANCE: |
396 | saved = pr->performance_platform_limit; |
397 | acpi_processor_ppc_has_changed(pr, 1); |
398 | if (saved == pr->performance_platform_limit) |
399 | break; |
400 | acpi_bus_generate_proc_event(device, event, |
401 | pr->performance_platform_limit); |
402 | acpi_bus_generate_netlink_event(device->pnp.device_class, |
403 | dev_name(&device->dev), event, |
404 | pr->performance_platform_limit); |
405 | break; |
406 | case ACPI_PROCESSOR_NOTIFY_POWER: |
407 | acpi_processor_cst_has_changed(pr); |
408 | acpi_bus_generate_proc_event(device, event, 0); |
409 | acpi_bus_generate_netlink_event(device->pnp.device_class, |
410 | dev_name(&device->dev), event, 0); |
411 | break; |
412 | case ACPI_PROCESSOR_NOTIFY_THROTTLING: |
413 | acpi_processor_tstate_has_changed(pr); |
414 | acpi_bus_generate_proc_event(device, event, 0); |
415 | acpi_bus_generate_netlink_event(device->pnp.device_class, |
416 | dev_name(&device->dev), event, 0); |
417 | break; |
418 | default: |
419 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, |
420 | "Unsupported event [0x%x]\n", event)); |
421 | break; |
422 | } |
423 | |
424 | return; |
425 | } |
426 | |
427 | static int acpi_cpu_soft_notify(struct notifier_block *nfb, |
428 | unsigned long action, void *hcpu) |
429 | { |
430 | unsigned int cpu = (unsigned long)hcpu; |
431 | struct acpi_processor *pr = per_cpu(processors, cpu); |
432 | |
433 | if (action == CPU_ONLINE && pr) { |
434 | /* CPU got physically hotplugged and onlined the first time: |
435 | * Initialize missing things |
436 | */ |
437 | if (pr->flags.need_hotplug_init) { |
438 | pr_info("Will online and init hotplugged CPU: %d\n", |
439 | pr->id); |
440 | WARN(acpi_processor_start(pr), "Failed to start CPU:" |
441 | " %d\n", pr->id); |
442 | pr->flags.need_hotplug_init = 0; |
443 | /* Normal CPU soft online event */ |
444 | } else { |
445 | acpi_processor_ppc_has_changed(pr, 0); |
446 | acpi_processor_hotplug(pr); |
447 | acpi_processor_reevaluate_tstate(pr, action); |
448 | acpi_processor_tstate_has_changed(pr); |
449 | } |
450 | } |
451 | if (action == CPU_DEAD && pr) { |
452 | /* invalidate the flag.throttling after one CPU is offline */ |
453 | acpi_processor_reevaluate_tstate(pr, action); |
454 | } |
455 | return NOTIFY_OK; |
456 | } |
457 | |
458 | static struct notifier_block acpi_cpu_notifier = |
459 | { |
460 | .notifier_call = acpi_cpu_soft_notify, |
461 | }; |
462 | |
463 | /* |
464 | * acpi_processor_start() is called by the cpu_hotplug_notifier func: |
465 | * acpi_cpu_soft_notify(). Getting it __cpuinit{data} is difficult, the |
466 | * root cause seem to be that acpi_processor_uninstall_hotplug_notify() |
467 | * is in the module_exit (__exit) func. Allowing acpi_processor_start() |
468 | * to not be in __cpuinit section, but being called from __cpuinit funcs |
469 | * via __ref looks like the right thing to do here. |
470 | */ |
471 | static __ref int acpi_processor_start(struct acpi_processor *pr) |
472 | { |
473 | struct acpi_device *device = per_cpu(processor_device_array, pr->id); |
474 | int result = 0; |
475 | |
476 | #ifdef CONFIG_CPU_FREQ |
477 | acpi_processor_ppc_has_changed(pr, 0); |
478 | acpi_processor_load_module(pr); |
479 | #endif |
480 | acpi_processor_get_throttling_info(pr); |
481 | acpi_processor_get_limit_info(pr); |
482 | |
483 | if (!cpuidle_get_driver() || cpuidle_get_driver() == &acpi_idle_driver) |
484 | acpi_processor_power_init(pr); |
485 | |
486 | pr->cdev = thermal_cooling_device_register("Processor", device, |
487 | &processor_cooling_ops); |
488 | if (IS_ERR(pr->cdev)) { |
489 | result = PTR_ERR(pr->cdev); |
490 | goto err_power_exit; |
491 | } |
492 | |
493 | dev_dbg(&device->dev, "registered as cooling_device%d\n", |
494 | pr->cdev->id); |
495 | |
496 | result = sysfs_create_link(&device->dev.kobj, |
497 | &pr->cdev->device.kobj, |
498 | "thermal_cooling"); |
499 | if (result) { |
500 | dev_err(&device->dev, |
501 | "Failed to create sysfs link 'thermal_cooling'\n"); |
502 | goto err_thermal_unregister; |
503 | } |
504 | result = sysfs_create_link(&pr->cdev->device.kobj, |
505 | &device->dev.kobj, |
506 | "device"); |
507 | if (result) { |
508 | dev_err(&pr->cdev->device, |
509 | "Failed to create sysfs link 'device'\n"); |
510 | goto err_remove_sysfs_thermal; |
511 | } |
512 | |
513 | return 0; |
514 | |
515 | err_remove_sysfs_thermal: |
516 | sysfs_remove_link(&device->dev.kobj, "thermal_cooling"); |
517 | err_thermal_unregister: |
518 | thermal_cooling_device_unregister(pr->cdev); |
519 | err_power_exit: |
520 | acpi_processor_power_exit(pr); |
521 | |
522 | return result; |
523 | } |
524 | |
525 | /* |
526 | * Do not put anything in here which needs the core to be online. |
527 | * For example MSR access or setting up things which check for cpuinfo_x86 |
528 | * (cpu_data(cpu)) values, like CPU feature flags, family, model, etc. |
529 | * Such things have to be put in and set up above in acpi_processor_start() |
530 | */ |
531 | static int __cpuinit acpi_processor_add(struct acpi_device *device) |
532 | { |
533 | struct acpi_processor *pr = NULL; |
534 | int result = 0; |
535 | struct device *dev; |
536 | |
537 | pr = kzalloc(sizeof(struct acpi_processor), GFP_KERNEL); |
538 | if (!pr) |
539 | return -ENOMEM; |
540 | |
541 | if (!zalloc_cpumask_var(&pr->throttling.shared_cpu_map, GFP_KERNEL)) { |
542 | result = -ENOMEM; |
543 | goto err_free_pr; |
544 | } |
545 | |
546 | pr->handle = device->handle; |
547 | strcpy(acpi_device_name(device), ACPI_PROCESSOR_DEVICE_NAME); |
548 | strcpy(acpi_device_class(device), ACPI_PROCESSOR_CLASS); |
549 | device->driver_data = pr; |
550 | |
551 | result = acpi_processor_get_info(device); |
552 | if (result) { |
553 | /* Processor is physically not present */ |
554 | return 0; |
555 | } |
556 | |
557 | #ifdef CONFIG_SMP |
558 | if (pr->id >= setup_max_cpus && pr->id != 0) |
559 | return 0; |
560 | #endif |
561 | |
562 | BUG_ON(pr->id >= nr_cpu_ids); |
563 | |
564 | /* |
565 | * Buggy BIOS check |
566 | * ACPI id of processors can be reported wrongly by the BIOS. |
567 | * Don't trust it blindly |
568 | */ |
569 | if (per_cpu(processor_device_array, pr->id) != NULL && |
570 | per_cpu(processor_device_array, pr->id) != device) { |
571 | dev_warn(&device->dev, |
572 | "BIOS reported wrong ACPI id %d for the processor\n", |
573 | pr->id); |
574 | result = -ENODEV; |
575 | goto err_free_cpumask; |
576 | } |
577 | per_cpu(processor_device_array, pr->id) = device; |
578 | |
579 | per_cpu(processors, pr->id) = pr; |
580 | |
581 | dev = get_cpu_device(pr->id); |
582 | if (sysfs_create_link(&device->dev.kobj, &dev->kobj, "sysdev")) { |
583 | result = -EFAULT; |
584 | goto err_clear_processor; |
585 | } |
586 | |
587 | /* |
588 | * Do not start hotplugged CPUs now, but when they |
589 | * are onlined the first time |
590 | */ |
591 | if (pr->flags.need_hotplug_init) |
592 | return 0; |
593 | |
594 | result = acpi_processor_start(pr); |
595 | if (result) |
596 | goto err_remove_sysfs; |
597 | |
598 | return 0; |
599 | |
600 | err_remove_sysfs: |
601 | sysfs_remove_link(&device->dev.kobj, "sysdev"); |
602 | err_clear_processor: |
603 | /* |
604 | * processor_device_array is not cleared to allow checks for buggy BIOS |
605 | */ |
606 | per_cpu(processors, pr->id) = NULL; |
607 | err_free_cpumask: |
608 | free_cpumask_var(pr->throttling.shared_cpu_map); |
609 | err_free_pr: |
610 | kfree(pr); |
611 | return result; |
612 | } |
613 | |
614 | static int acpi_processor_remove(struct acpi_device *device) |
615 | { |
616 | struct acpi_processor *pr = NULL; |
617 | |
618 | |
619 | if (!device || !acpi_driver_data(device)) |
620 | return -EINVAL; |
621 | |
622 | pr = acpi_driver_data(device); |
623 | |
624 | if (pr->id >= nr_cpu_ids) |
625 | goto free; |
626 | |
627 | if (device->removal_type == ACPI_BUS_REMOVAL_EJECT) { |
628 | if (acpi_processor_handle_eject(pr)) |
629 | return -EINVAL; |
630 | } |
631 | |
632 | acpi_processor_power_exit(pr); |
633 | |
634 | sysfs_remove_link(&device->dev.kobj, "sysdev"); |
635 | |
636 | if (pr->cdev) { |
637 | sysfs_remove_link(&device->dev.kobj, "thermal_cooling"); |
638 | sysfs_remove_link(&pr->cdev->device.kobj, "device"); |
639 | thermal_cooling_device_unregister(pr->cdev); |
640 | pr->cdev = NULL; |
641 | } |
642 | |
643 | per_cpu(processors, pr->id) = NULL; |
644 | per_cpu(processor_device_array, pr->id) = NULL; |
645 | try_offline_node(cpu_to_node(pr->id)); |
646 | |
647 | free: |
648 | free_cpumask_var(pr->throttling.shared_cpu_map); |
649 | kfree(pr); |
650 | |
651 | return 0; |
652 | } |
653 | |
654 | #ifdef CONFIG_ACPI_HOTPLUG_CPU |
655 | /**************************************************************************** |
656 | * Acpi processor hotplug support * |
657 | ****************************************************************************/ |
658 | |
659 | static int is_processor_present(acpi_handle handle) |
660 | { |
661 | acpi_status status; |
662 | unsigned long long sta = 0; |
663 | |
664 | |
665 | status = acpi_evaluate_integer(handle, "_STA", NULL, &sta); |
666 | |
667 | if (ACPI_SUCCESS(status) && (sta & ACPI_STA_DEVICE_PRESENT)) |
668 | return 1; |
669 | |
670 | /* |
671 | * _STA is mandatory for a processor that supports hot plug |
672 | */ |
673 | if (status == AE_NOT_FOUND) |
674 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, |
675 | "Processor does not support hot plug\n")); |
676 | else |
677 | ACPI_EXCEPTION((AE_INFO, status, |
678 | "Processor Device is not present")); |
679 | return 0; |
680 | } |
681 | |
682 | static void acpi_processor_hotplug_notify(acpi_handle handle, |
683 | u32 event, void *data) |
684 | { |
685 | struct acpi_device *device = NULL; |
686 | struct acpi_eject_event *ej_event = NULL; |
687 | u32 ost_code = ACPI_OST_SC_NON_SPECIFIC_FAILURE; /* default */ |
688 | acpi_status status; |
689 | int result; |
690 | |
691 | acpi_scan_lock_acquire(); |
692 | |
693 | switch (event) { |
694 | case ACPI_NOTIFY_BUS_CHECK: |
695 | case ACPI_NOTIFY_DEVICE_CHECK: |
696 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, |
697 | "Processor driver received %s event\n", |
698 | (event == ACPI_NOTIFY_BUS_CHECK) ? |
699 | "ACPI_NOTIFY_BUS_CHECK" : "ACPI_NOTIFY_DEVICE_CHECK")); |
700 | |
701 | if (!is_processor_present(handle)) |
702 | break; |
703 | |
704 | if (!acpi_bus_get_device(handle, &device)) |
705 | break; |
706 | |
707 | result = acpi_bus_scan(handle); |
708 | if (result) { |
709 | acpi_handle_err(handle, "Unable to add the device\n"); |
710 | break; |
711 | } |
712 | result = acpi_bus_get_device(handle, &device); |
713 | if (result) { |
714 | acpi_handle_err(handle, "Missing device object\n"); |
715 | break; |
716 | } |
717 | ost_code = ACPI_OST_SC_SUCCESS; |
718 | break; |
719 | |
720 | case ACPI_NOTIFY_EJECT_REQUEST: |
721 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, |
722 | "received ACPI_NOTIFY_EJECT_REQUEST\n")); |
723 | |
724 | if (acpi_bus_get_device(handle, &device)) { |
725 | acpi_handle_err(handle, |
726 | "Device don't exist, dropping EJECT\n"); |
727 | break; |
728 | } |
729 | if (!acpi_driver_data(device)) { |
730 | acpi_handle_err(handle, |
731 | "Driver data is NULL, dropping EJECT\n"); |
732 | break; |
733 | } |
734 | |
735 | ej_event = kmalloc(sizeof(*ej_event), GFP_KERNEL); |
736 | if (!ej_event) { |
737 | acpi_handle_err(handle, "No memory, dropping EJECT\n"); |
738 | break; |
739 | } |
740 | |
741 | get_device(&device->dev); |
742 | ej_event->device = device; |
743 | ej_event->event = ACPI_NOTIFY_EJECT_REQUEST; |
744 | /* The eject is carried out asynchronously. */ |
745 | status = acpi_os_hotplug_execute(acpi_bus_hot_remove_device, |
746 | ej_event); |
747 | if (ACPI_FAILURE(status)) { |
748 | put_device(&device->dev); |
749 | kfree(ej_event); |
750 | break; |
751 | } |
752 | goto out; |
753 | |
754 | default: |
755 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, |
756 | "Unsupported event [0x%x]\n", event)); |
757 | |
758 | /* non-hotplug event; possibly handled by other handler */ |
759 | goto out; |
760 | } |
761 | |
762 | /* Inform firmware that the hotplug operation has completed */ |
763 | (void) acpi_evaluate_hotplug_ost(handle, event, ost_code, NULL); |
764 | |
765 | out: |
766 | acpi_scan_lock_release(); |
767 | } |
768 | |
769 | static acpi_status is_processor_device(acpi_handle handle) |
770 | { |
771 | struct acpi_device_info *info; |
772 | char *hid; |
773 | acpi_status status; |
774 | |
775 | status = acpi_get_object_info(handle, &info); |
776 | if (ACPI_FAILURE(status)) |
777 | return status; |
778 | |
779 | if (info->type == ACPI_TYPE_PROCESSOR) { |
780 | kfree(info); |
781 | return AE_OK; /* found a processor object */ |
782 | } |
783 | |
784 | if (!(info->valid & ACPI_VALID_HID)) { |
785 | kfree(info); |
786 | return AE_ERROR; |
787 | } |
788 | |
789 | hid = info->hardware_id.string; |
790 | if ((hid == NULL) || strcmp(hid, ACPI_PROCESSOR_DEVICE_HID)) { |
791 | kfree(info); |
792 | return AE_ERROR; |
793 | } |
794 | |
795 | kfree(info); |
796 | return AE_OK; /* found a processor device object */ |
797 | } |
798 | |
799 | static acpi_status |
800 | processor_walk_namespace_cb(acpi_handle handle, |
801 | u32 lvl, void *context, void **rv) |
802 | { |
803 | acpi_status status; |
804 | int *action = context; |
805 | |
806 | status = is_processor_device(handle); |
807 | if (ACPI_FAILURE(status)) |
808 | return AE_OK; /* not a processor; continue to walk */ |
809 | |
810 | switch (*action) { |
811 | case INSTALL_NOTIFY_HANDLER: |
812 | acpi_install_notify_handler(handle, |
813 | ACPI_SYSTEM_NOTIFY, |
814 | acpi_processor_hotplug_notify, |
815 | NULL); |
816 | break; |
817 | case UNINSTALL_NOTIFY_HANDLER: |
818 | acpi_remove_notify_handler(handle, |
819 | ACPI_SYSTEM_NOTIFY, |
820 | acpi_processor_hotplug_notify); |
821 | break; |
822 | default: |
823 | break; |
824 | } |
825 | |
826 | /* found a processor; skip walking underneath */ |
827 | return AE_CTRL_DEPTH; |
828 | } |
829 | |
830 | static acpi_status acpi_processor_hotadd_init(struct acpi_processor *pr) |
831 | { |
832 | acpi_handle handle = pr->handle; |
833 | |
834 | if (!is_processor_present(handle)) { |
835 | return AE_ERROR; |
836 | } |
837 | |
838 | if (acpi_map_lsapic(handle, &pr->id)) |
839 | return AE_ERROR; |
840 | |
841 | if (arch_register_cpu(pr->id)) { |
842 | acpi_unmap_lsapic(pr->id); |
843 | return AE_ERROR; |
844 | } |
845 | |
846 | /* CPU got hot-plugged, but cpu_data is not initialized yet |
847 | * Set flag to delay cpu_idle/throttling initialization |
848 | * in: |
849 | * acpi_processor_add() |
850 | * acpi_processor_get_info() |
851 | * and do it when the CPU gets online the first time |
852 | * TBD: Cleanup above functions and try to do this more elegant. |
853 | */ |
854 | pr_info("CPU %d got hotplugged\n", pr->id); |
855 | pr->flags.need_hotplug_init = 1; |
856 | |
857 | return AE_OK; |
858 | } |
859 | |
860 | static int acpi_processor_handle_eject(struct acpi_processor *pr) |
861 | { |
862 | if (cpu_online(pr->id)) |
863 | cpu_down(pr->id); |
864 | |
865 | get_online_cpus(); |
866 | /* |
867 | * The cpu might become online again at this point. So we check whether |
868 | * the cpu has been onlined or not. If the cpu became online, it means |
869 | * that someone wants to use the cpu. So acpi_processor_handle_eject() |
870 | * returns -EAGAIN. |
871 | */ |
872 | if (unlikely(cpu_online(pr->id))) { |
873 | put_online_cpus(); |
874 | pr_warn("Failed to remove CPU %d, because other task " |
875 | "brought the CPU back online\n", pr->id); |
876 | return -EAGAIN; |
877 | } |
878 | arch_unregister_cpu(pr->id); |
879 | acpi_unmap_lsapic(pr->id); |
880 | put_online_cpus(); |
881 | return (0); |
882 | } |
883 | #else |
884 | static acpi_status acpi_processor_hotadd_init(struct acpi_processor *pr) |
885 | { |
886 | return AE_ERROR; |
887 | } |
888 | static int acpi_processor_handle_eject(struct acpi_processor *pr) |
889 | { |
890 | return (-EINVAL); |
891 | } |
892 | #endif |
893 | |
894 | static |
895 | void acpi_processor_install_hotplug_notify(void) |
896 | { |
897 | #ifdef CONFIG_ACPI_HOTPLUG_CPU |
898 | int action = INSTALL_NOTIFY_HANDLER; |
899 | acpi_walk_namespace(ACPI_TYPE_ANY, |
900 | ACPI_ROOT_OBJECT, |
901 | ACPI_UINT32_MAX, |
902 | processor_walk_namespace_cb, NULL, &action, NULL); |
903 | #endif |
904 | register_hotcpu_notifier(&acpi_cpu_notifier); |
905 | } |
906 | |
907 | static |
908 | void acpi_processor_uninstall_hotplug_notify(void) |
909 | { |
910 | #ifdef CONFIG_ACPI_HOTPLUG_CPU |
911 | int action = UNINSTALL_NOTIFY_HANDLER; |
912 | acpi_walk_namespace(ACPI_TYPE_ANY, |
913 | ACPI_ROOT_OBJECT, |
914 | ACPI_UINT32_MAX, |
915 | processor_walk_namespace_cb, NULL, &action, NULL); |
916 | #endif |
917 | unregister_hotcpu_notifier(&acpi_cpu_notifier); |
918 | } |
919 | |
920 | /* |
921 | * We keep the driver loaded even when ACPI is not running. |
922 | * This is needed for the powernow-k8 driver, that works even without |
923 | * ACPI, but needs symbols from this driver |
924 | */ |
925 | |
926 | static int __init acpi_processor_init(void) |
927 | { |
928 | int result = 0; |
929 | |
930 | if (acpi_disabled) |
931 | return 0; |
932 | |
933 | result = acpi_bus_register_driver(&acpi_processor_driver); |
934 | if (result < 0) |
935 | return result; |
936 | |
937 | acpi_processor_install_hotplug_notify(); |
938 | |
939 | acpi_thermal_cpufreq_init(); |
940 | |
941 | acpi_processor_ppc_init(); |
942 | |
943 | acpi_processor_throttling_init(); |
944 | |
945 | return 0; |
946 | } |
947 | |
948 | static void __exit acpi_processor_exit(void) |
949 | { |
950 | if (acpi_disabled) |
951 | return; |
952 | |
953 | acpi_processor_ppc_exit(); |
954 | |
955 | acpi_thermal_cpufreq_exit(); |
956 | |
957 | acpi_processor_uninstall_hotplug_notify(); |
958 | |
959 | acpi_bus_unregister_driver(&acpi_processor_driver); |
960 | |
961 | return; |
962 | } |
963 | |
964 | module_init(acpi_processor_init); |
965 | module_exit(acpi_processor_exit); |
966 | |
967 | MODULE_ALIAS("processor"); |
968 |
Branches:
ben-wpan
ben-wpan-stefan
javiroman/ks7010
jz-2.6.34
jz-2.6.34-rc5
jz-2.6.34-rc6
jz-2.6.34-rc7
jz-2.6.35
jz-2.6.36
jz-2.6.37
jz-2.6.38
jz-2.6.39
jz-3.0
jz-3.1
jz-3.11
jz-3.12
jz-3.13
jz-3.15
jz-3.16
jz-3.18-dt
jz-3.2
jz-3.3
jz-3.4
jz-3.5
jz-3.6
jz-3.6-rc2-pwm
jz-3.9
jz-3.9-clk
jz-3.9-rc8
jz47xx
jz47xx-2.6.38
master
Tags:
od-2011-09-04
od-2011-09-18
v2.6.34-rc5
v2.6.34-rc6
v2.6.34-rc7
v3.9