Commit | Line | Data |
---|---|---|
1da177e4 LT |
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> | |
1da177e4 LT |
43 | #include <linux/dmi.h> |
44 | #include <linux/moduleparam.h> | |
4f86d3a8 | 45 | #include <linux/cpuidle.h> |
5a0e3ad6 | 46 | #include <linux/slab.h> |
1da177e4 LT |
47 | |
48 | #include <asm/io.h> | |
49 | #include <asm/system.h> | |
50 | #include <asm/cpu.h> | |
51 | #include <asm/delay.h> | |
52 | #include <asm/uaccess.h> | |
53 | #include <asm/processor.h> | |
54 | #include <asm/smp.h> | |
55 | #include <asm/acpi.h> | |
56 | ||
57 | #include <acpi/acpi_bus.h> | |
58 | #include <acpi/acpi_drivers.h> | |
59 | #include <acpi/processor.h> | |
60 | ||
a192a958 LB |
61 | #define PREFIX "ACPI: " |
62 | ||
1da177e4 | 63 | #define ACPI_PROCESSOR_CLASS "processor" |
1da177e4 LT |
64 | #define ACPI_PROCESSOR_DEVICE_NAME "Processor" |
65 | #define ACPI_PROCESSOR_FILE_INFO "info" | |
66 | #define ACPI_PROCESSOR_FILE_THROTTLING "throttling" | |
67 | #define ACPI_PROCESSOR_FILE_LIMIT "limit" | |
68 | #define ACPI_PROCESSOR_NOTIFY_PERFORMANCE 0x80 | |
69 | #define ACPI_PROCESSOR_NOTIFY_POWER 0x81 | |
01854e69 | 70 | #define ACPI_PROCESSOR_NOTIFY_THROTTLING 0x82 |
1da177e4 LT |
71 | |
72 | #define ACPI_PROCESSOR_LIMIT_USER 0 | |
73 | #define ACPI_PROCESSOR_LIMIT_THERMAL 1 | |
74 | ||
1da177e4 | 75 | #define _COMPONENT ACPI_PROCESSOR_COMPONENT |
0131aa3d | 76 | ACPI_MODULE_NAME("processor_driver"); |
1da177e4 | 77 | |
f52fd66d | 78 | MODULE_AUTHOR("Paul Diefenbaugh"); |
7cda93e0 | 79 | MODULE_DESCRIPTION("ACPI Processor Driver"); |
1da177e4 LT |
80 | MODULE_LICENSE("GPL"); |
81 | ||
4be44fcd | 82 | static int acpi_processor_add(struct acpi_device *device); |
4be44fcd | 83 | static int acpi_processor_remove(struct acpi_device *device, int type); |
7ec0a729 | 84 | static void acpi_processor_notify(struct acpi_device *device, u32 event); |
3bd81a87 | 85 | static acpi_status acpi_processor_hotadd_init(struct acpi_processor *pr); |
1da177e4 | 86 | static int acpi_processor_handle_eject(struct acpi_processor *pr); |
01854e69 | 87 | |
1da177e4 | 88 | |
1ba90e3a | 89 | static const struct acpi_device_id processor_device_ids[] = { |
ad93a765 | 90 | {ACPI_PROCESSOR_OBJECT_HID, 0}, |
9eccbc2f | 91 | {"ACPI0007", 0}, |
1ba90e3a TR |
92 | {"", 0}, |
93 | }; | |
94 | MODULE_DEVICE_TABLE(acpi, processor_device_ids); | |
95 | ||
1da177e4 | 96 | static struct acpi_driver acpi_processor_driver = { |
c2b6705b | 97 | .name = "processor", |
4be44fcd | 98 | .class = ACPI_PROCESSOR_CLASS, |
1ba90e3a | 99 | .ids = processor_device_ids, |
4be44fcd LB |
100 | .ops = { |
101 | .add = acpi_processor_add, | |
102 | .remove = acpi_processor_remove, | |
b04e7bdb TG |
103 | .suspend = acpi_processor_suspend, |
104 | .resume = acpi_processor_resume, | |
7ec0a729 | 105 | .notify = acpi_processor_notify, |
4be44fcd | 106 | }, |
1da177e4 LT |
107 | }; |
108 | ||
109 | #define INSTALL_NOTIFY_HANDLER 1 | |
110 | #define UNINSTALL_NOTIFY_HANDLER 2 | |
1da177e4 | 111 | |
706546d0 | 112 | DEFINE_PER_CPU(struct acpi_processor *, processors); |
0f1d683f NC |
113 | EXPORT_PER_CPU_SYMBOL(processors); |
114 | ||
9f222718 | 115 | struct acpi_processor_errata errata __read_mostly; |
1da177e4 | 116 | |
1da177e4 LT |
117 | /* -------------------------------------------------------------------------- |
118 | Errata Handling | |
119 | -------------------------------------------------------------------------- */ | |
120 | ||
4be44fcd | 121 | static int acpi_processor_errata_piix4(struct pci_dev *dev) |
1da177e4 | 122 | { |
4be44fcd LB |
123 | u8 value1 = 0; |
124 | u8 value2 = 0; | |
1da177e4 | 125 | |
1da177e4 LT |
126 | |
127 | if (!dev) | |
d550d98d | 128 | return -EINVAL; |
1da177e4 LT |
129 | |
130 | /* | |
131 | * Note that 'dev' references the PIIX4 ACPI Controller. | |
132 | */ | |
133 | ||
44c10138 | 134 | switch (dev->revision) { |
1da177e4 LT |
135 | case 0: |
136 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found PIIX4 A-step\n")); | |
137 | break; | |
138 | case 1: | |
139 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found PIIX4 B-step\n")); | |
140 | break; | |
141 | case 2: | |
142 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found PIIX4E\n")); | |
143 | break; | |
144 | case 3: | |
145 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found PIIX4M\n")); | |
146 | break; | |
147 | default: | |
148 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found unknown PIIX4\n")); | |
149 | break; | |
150 | } | |
151 | ||
44c10138 | 152 | switch (dev->revision) { |
1da177e4 LT |
153 | |
154 | case 0: /* PIIX4 A-step */ | |
155 | case 1: /* PIIX4 B-step */ | |
156 | /* | |
157 | * See specification changes #13 ("Manual Throttle Duty Cycle") | |
158 | * and #14 ("Enabling and Disabling Manual Throttle"), plus | |
159 | * erratum #5 ("STPCLK# Deassertion Time") from the January | |
160 | * 2002 PIIX4 specification update. Applies to only older | |
161 | * PIIX4 models. | |
162 | */ | |
163 | errata.piix4.throttle = 1; | |
164 | ||
165 | case 2: /* PIIX4E */ | |
166 | case 3: /* PIIX4M */ | |
167 | /* | |
168 | * See erratum #18 ("C3 Power State/BMIDE and Type-F DMA | |
169 | * Livelock") from the January 2002 PIIX4 specification update. | |
170 | * Applies to all PIIX4 models. | |
171 | */ | |
172 | ||
173 | /* | |
174 | * BM-IDE | |
175 | * ------ | |
176 | * Find the PIIX4 IDE Controller and get the Bus Master IDE | |
177 | * Status register address. We'll use this later to read | |
178 | * each IDE controller's DMA status to make sure we catch all | |
179 | * DMA activity. | |
180 | */ | |
181 | dev = pci_get_subsys(PCI_VENDOR_ID_INTEL, | |
4be44fcd LB |
182 | PCI_DEVICE_ID_INTEL_82371AB, |
183 | PCI_ANY_ID, PCI_ANY_ID, NULL); | |
1da177e4 LT |
184 | if (dev) { |
185 | errata.piix4.bmisx = pci_resource_start(dev, 4); | |
186 | pci_dev_put(dev); | |
187 | } | |
188 | ||
189 | /* | |
190 | * Type-F DMA | |
191 | * ---------- | |
192 | * Find the PIIX4 ISA Controller and read the Motherboard | |
193 | * DMA controller's status to see if Type-F (Fast) DMA mode | |
194 | * is enabled (bit 7) on either channel. Note that we'll | |
195 | * disable C3 support if this is enabled, as some legacy | |
196 | * devices won't operate well if fast DMA is disabled. | |
197 | */ | |
198 | dev = pci_get_subsys(PCI_VENDOR_ID_INTEL, | |
4be44fcd LB |
199 | PCI_DEVICE_ID_INTEL_82371AB_0, |
200 | PCI_ANY_ID, PCI_ANY_ID, NULL); | |
1da177e4 LT |
201 | if (dev) { |
202 | pci_read_config_byte(dev, 0x76, &value1); | |
203 | pci_read_config_byte(dev, 0x77, &value2); | |
204 | if ((value1 & 0x80) || (value2 & 0x80)) | |
205 | errata.piix4.fdma = 1; | |
206 | pci_dev_put(dev); | |
207 | } | |
208 | ||
209 | break; | |
210 | } | |
211 | ||
212 | if (errata.piix4.bmisx) | |
213 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, | |
4be44fcd | 214 | "Bus master activity detection (BM-IDE) erratum enabled\n")); |
1da177e4 LT |
215 | if (errata.piix4.fdma) |
216 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, | |
4be44fcd | 217 | "Type-F DMA livelock erratum (C3 disabled)\n")); |
1da177e4 | 218 | |
d550d98d | 219 | return 0; |
1da177e4 LT |
220 | } |
221 | ||
8713cbef | 222 | static int acpi_processor_errata(struct acpi_processor *pr) |
1da177e4 | 223 | { |
4be44fcd LB |
224 | int result = 0; |
225 | struct pci_dev *dev = NULL; | |
1da177e4 | 226 | |
1da177e4 LT |
227 | |
228 | if (!pr) | |
d550d98d | 229 | return -EINVAL; |
1da177e4 LT |
230 | |
231 | /* | |
232 | * PIIX4 | |
233 | */ | |
234 | dev = pci_get_subsys(PCI_VENDOR_ID_INTEL, | |
4be44fcd LB |
235 | PCI_DEVICE_ID_INTEL_82371AB_3, PCI_ANY_ID, |
236 | PCI_ANY_ID, NULL); | |
1da177e4 LT |
237 | if (dev) { |
238 | result = acpi_processor_errata_piix4(dev); | |
239 | pci_dev_put(dev); | |
240 | } | |
241 | ||
d550d98d | 242 | return result; |
1da177e4 LT |
243 | } |
244 | ||
1da177e4 LT |
245 | /* -------------------------------------------------------------------------- |
246 | Driver Interface | |
247 | -------------------------------------------------------------------------- */ | |
248 | ||
b26e9286 | 249 | static int acpi_processor_get_info(struct acpi_device *device) |
1da177e4 | 250 | { |
4be44fcd LB |
251 | acpi_status status = 0; |
252 | union acpi_object object = { 0 }; | |
253 | struct acpi_buffer buffer = { sizeof(union acpi_object), &object }; | |
b26e9286 MS |
254 | struct acpi_processor *pr; |
255 | int cpu_index, device_declaration = 0; | |
4be44fcd | 256 | static int cpu0_initialized; |
1da177e4 | 257 | |
b26e9286 | 258 | pr = acpi_driver_data(device); |
1da177e4 | 259 | if (!pr) |
d550d98d | 260 | return -EINVAL; |
1da177e4 LT |
261 | |
262 | if (num_online_cpus() > 1) | |
263 | errata.smp = TRUE; | |
264 | ||
265 | acpi_processor_errata(pr); | |
266 | ||
267 | /* | |
268 | * Check to see if we have bus mastering arbitration control. This | |
269 | * is required for proper C3 usage (to maintain cache coherency). | |
270 | */ | |
cee324b1 | 271 | if (acpi_gbl_FADT.pm2_control_block && acpi_gbl_FADT.pm2_control_length) { |
1da177e4 LT |
272 | pr->flags.bm_control = 1; |
273 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, | |
4be44fcd LB |
274 | "Bus mastering arbitration control present\n")); |
275 | } else | |
1da177e4 | 276 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, |
4be44fcd | 277 | "No bus mastering arbitration control\n")); |
1da177e4 | 278 | |
6cc73b48 BH |
279 | if (!strcmp(acpi_device_hid(device), ACPI_PROCESSOR_OBJECT_HID)) { |
280 | /* Declared with "Processor" statement; match ProcessorID */ | |
281 | status = acpi_evaluate_object(pr->handle, NULL, NULL, &buffer); | |
282 | if (ACPI_FAILURE(status)) { | |
283 | printk(KERN_ERR PREFIX "Evaluating processor object\n"); | |
284 | return -ENODEV; | |
285 | } | |
286 | ||
287 | /* | |
288 | * TBD: Synch processor ID (via LAPIC/LSAPIC structures) on SMP. | |
289 | * >>> 'acpi_get_processor_id(acpi_id, &id)' in | |
290 | * arch/xxx/acpi.c | |
291 | */ | |
292 | pr->acpi_id = object.processor.proc_id; | |
293 | } else { | |
b26e9286 MS |
294 | /* |
295 | * Declared with "Device" statement; match _UID. | |
296 | * Note that we don't handle string _UIDs yet. | |
297 | */ | |
27663c58 | 298 | unsigned long long value; |
11bf04c4 AS |
299 | status = acpi_evaluate_integer(pr->handle, METHOD_NAME__UID, |
300 | NULL, &value); | |
301 | if (ACPI_FAILURE(status)) { | |
b26e9286 MS |
302 | printk(KERN_ERR PREFIX |
303 | "Evaluating processor _UID [%#x]\n", status); | |
11bf04c4 AS |
304 | return -ENODEV; |
305 | } | |
b26e9286 | 306 | device_declaration = 1; |
11bf04c4 | 307 | pr->acpi_id = value; |
11bf04c4 | 308 | } |
2e9d5e4e | 309 | cpu_index = acpi_get_cpuid(pr->handle, device_declaration, pr->acpi_id); |
1da177e4 | 310 | |
4be44fcd | 311 | /* Handle UP system running SMP kernel, with no LAPIC in MADT */ |
df42baa0 | 312 | if (!cpu0_initialized && (cpu_index == -1) && |
4be44fcd LB |
313 | (num_online_cpus() == 1)) { |
314 | cpu_index = 0; | |
315 | } | |
316 | ||
317 | cpu0_initialized = 1; | |
318 | ||
319 | pr->id = cpu_index; | |
320 | ||
321 | /* | |
322 | * Extra Processor objects may be enumerated on MP systems with | |
323 | * less than the max # of CPUs. They should be ignored _iff | |
324 | * they are physically not present. | |
325 | */ | |
f18c5a08 | 326 | if (pr->id == -1) { |
3bd81a87 | 327 | if (ACPI_FAILURE(acpi_processor_hotadd_init(pr))) |
d550d98d | 328 | return -ENODEV; |
4be44fcd | 329 | } |
7a04b849 ZY |
330 | /* |
331 | * On some boxes several processors use the same processor bus id. | |
332 | * But they are located in different scope. For example: | |
333 | * \_SB.SCK0.CPU0 | |
334 | * \_SB.SCK1.CPU0 | |
335 | * Rename the processor device bus id. And the new bus id will be | |
336 | * generated as the following format: | |
337 | * CPU+CPU ID. | |
338 | */ | |
339 | sprintf(acpi_device_bid(device), "CPU%X", pr->id); | |
1da177e4 | 340 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Processor [%d:%d]\n", pr->id, |
4be44fcd | 341 | pr->acpi_id)); |
1da177e4 LT |
342 | |
343 | if (!object.processor.pblk_address) | |
344 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "No PBLK (NULL address)\n")); | |
345 | else if (object.processor.pblk_length != 6) | |
6468463a LB |
346 | printk(KERN_ERR PREFIX "Invalid PBLK length [%d]\n", |
347 | object.processor.pblk_length); | |
1da177e4 LT |
348 | else { |
349 | pr->throttling.address = object.processor.pblk_address; | |
cee324b1 AS |
350 | pr->throttling.duty_offset = acpi_gbl_FADT.duty_offset; |
351 | pr->throttling.duty_width = acpi_gbl_FADT.duty_width; | |
1da177e4 LT |
352 | |
353 | pr->pblk = object.processor.pblk_address; | |
354 | ||
355 | /* | |
356 | * We don't care about error returns - we just try to mark | |
357 | * these reserved so that nobody else is confused into thinking | |
358 | * that this region might be unused.. | |
359 | * | |
360 | * (In particular, allocating the IO range for Cardbus) | |
361 | */ | |
362 | request_region(pr->throttling.address, 6, "ACPI CPU throttle"); | |
363 | } | |
364 | ||
fe086a7b AC |
365 | /* |
366 | * If ACPI describes a slot number for this CPU, we can use it | |
367 | * ensure we get the right value in the "physical id" field | |
368 | * of /proc/cpuinfo | |
369 | */ | |
370 | status = acpi_evaluate_object(pr->handle, "_SUN", NULL, &buffer); | |
371 | if (ACPI_SUCCESS(status)) | |
372 | arch_fix_phys_package_id(pr->id, object.integer.value); | |
373 | ||
d550d98d | 374 | return 0; |
1da177e4 LT |
375 | } |
376 | ||
706546d0 | 377 | static DEFINE_PER_CPU(void *, processor_device_array); |
cd8e2b48 | 378 | |
7ec0a729 | 379 | static void acpi_processor_notify(struct acpi_device *device, u32 event) |
1da177e4 | 380 | { |
7ec0a729 | 381 | struct acpi_processor *pr = acpi_driver_data(device); |
e790cc8b | 382 | int saved; |
1da177e4 LT |
383 | |
384 | if (!pr) | |
d550d98d | 385 | return; |
1da177e4 | 386 | |
1da177e4 LT |
387 | switch (event) { |
388 | case ACPI_PROCESSOR_NOTIFY_PERFORMANCE: | |
e790cc8b | 389 | saved = pr->performance_platform_limit; |
d81c45e1 | 390 | acpi_processor_ppc_has_changed(pr, 1); |
e790cc8b AS |
391 | if (saved == pr->performance_platform_limit) |
392 | break; | |
14e04fb3 | 393 | acpi_bus_generate_proc_event(device, event, |
4be44fcd | 394 | pr->performance_platform_limit); |
962ce8ca | 395 | acpi_bus_generate_netlink_event(device->pnp.device_class, |
0794469d | 396 | dev_name(&device->dev), event, |
962ce8ca | 397 | pr->performance_platform_limit); |
1da177e4 LT |
398 | break; |
399 | case ACPI_PROCESSOR_NOTIFY_POWER: | |
400 | acpi_processor_cst_has_changed(pr); | |
14e04fb3 | 401 | acpi_bus_generate_proc_event(device, event, 0); |
962ce8ca | 402 | acpi_bus_generate_netlink_event(device->pnp.device_class, |
0794469d | 403 | dev_name(&device->dev), event, 0); |
1da177e4 | 404 | break; |
01854e69 LY |
405 | case ACPI_PROCESSOR_NOTIFY_THROTTLING: |
406 | acpi_processor_tstate_has_changed(pr); | |
14e04fb3 | 407 | acpi_bus_generate_proc_event(device, event, 0); |
962ce8ca | 408 | acpi_bus_generate_netlink_event(device->pnp.device_class, |
0794469d | 409 | dev_name(&device->dev), event, 0); |
1da177e4 LT |
410 | default: |
411 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, | |
4be44fcd | 412 | "Unsupported event [0x%x]\n", event)); |
1da177e4 LT |
413 | break; |
414 | } | |
415 | ||
d550d98d | 416 | return; |
1da177e4 LT |
417 | } |
418 | ||
729c6ba3 VP |
419 | static int acpi_cpu_soft_notify(struct notifier_block *nfb, |
420 | unsigned long action, void *hcpu) | |
421 | { | |
422 | unsigned int cpu = (unsigned long)hcpu; | |
706546d0 | 423 | struct acpi_processor *pr = per_cpu(processors, cpu); |
729c6ba3 VP |
424 | |
425 | if (action == CPU_ONLINE && pr) { | |
d81c45e1 | 426 | acpi_processor_ppc_has_changed(pr, 0); |
46bcfad7 | 427 | acpi_processor_hotplug(pr); |
5a344a50 | 428 | acpi_processor_reevaluate_tstate(pr, action); |
729c6ba3 VP |
429 | acpi_processor_tstate_has_changed(pr); |
430 | } | |
5a344a50 ZY |
431 | if (action == CPU_DEAD && pr) { |
432 | /* invalidate the flag.throttling after one CPU is offline */ | |
433 | acpi_processor_reevaluate_tstate(pr, action); | |
434 | } | |
729c6ba3 VP |
435 | return NOTIFY_OK; |
436 | } | |
437 | ||
438 | static struct notifier_block acpi_cpu_notifier = | |
439 | { | |
440 | .notifier_call = acpi_cpu_soft_notify, | |
441 | }; | |
442 | ||
54d5dcc4 TR |
443 | static int __cpuinit acpi_processor_start(struct acpi_processor *pr) |
444 | { | |
445 | struct acpi_device *device = per_cpu(processor_device_array, pr->id); | |
446 | int result = 0; | |
447 | ||
448 | #ifdef CONFIG_CPU_FREQ | |
449 | acpi_processor_ppc_has_changed(pr, 0); | |
450 | #endif | |
451 | acpi_processor_get_throttling_info(pr); | |
452 | acpi_processor_get_limit_info(pr); | |
453 | ||
454 | if (!cpuidle_get_driver() || cpuidle_get_driver() == &acpi_idle_driver) | |
455 | acpi_processor_power_init(pr, device); | |
456 | ||
457 | pr->cdev = thermal_cooling_device_register("Processor", device, | |
458 | &processor_cooling_ops); | |
459 | if (IS_ERR(pr->cdev)) { | |
460 | result = PTR_ERR(pr->cdev); | |
461 | goto err_power_exit; | |
462 | } | |
463 | ||
464 | dev_dbg(&device->dev, "registered as cooling_device%d\n", | |
465 | pr->cdev->id); | |
466 | ||
467 | result = sysfs_create_link(&device->dev.kobj, | |
468 | &pr->cdev->device.kobj, | |
469 | "thermal_cooling"); | |
470 | if (result) { | |
471 | printk(KERN_ERR PREFIX "Create sysfs link\n"); | |
472 | goto err_thermal_unregister; | |
473 | } | |
474 | result = sysfs_create_link(&pr->cdev->device.kobj, | |
475 | &device->dev.kobj, | |
476 | "device"); | |
477 | if (result) { | |
478 | printk(KERN_ERR PREFIX "Create sysfs link\n"); | |
479 | goto err_remove_sysfs_thermal; | |
480 | } | |
481 | ||
482 | return 0; | |
483 | ||
484 | err_remove_sysfs_thermal: | |
485 | sysfs_remove_link(&device->dev.kobj, "thermal_cooling"); | |
486 | err_thermal_unregister: | |
487 | thermal_cooling_device_unregister(pr->cdev); | |
488 | err_power_exit: | |
489 | acpi_processor_power_exit(pr, device); | |
490 | ||
491 | return result; | |
492 | } | |
493 | ||
494 | ||
941b10fa | 495 | static int __cpuinit acpi_processor_add(struct acpi_device *device) |
1da177e4 | 496 | { |
4be44fcd | 497 | struct acpi_processor *pr = NULL; |
970b0492 | 498 | int result = 0; |
8a25a2fd | 499 | struct device *dev; |
1da177e4 | 500 | |
36bcbec7 | 501 | pr = kzalloc(sizeof(struct acpi_processor), GFP_KERNEL); |
1da177e4 | 502 | if (!pr) |
d550d98d | 503 | return -ENOMEM; |
1da177e4 | 504 | |
eaa95840 | 505 | if (!zalloc_cpumask_var(&pr->throttling.shared_cpu_map, GFP_KERNEL)) { |
2fdf66b4 RR |
506 | kfree(pr); |
507 | return -ENOMEM; | |
508 | } | |
509 | ||
1da177e4 LT |
510 | pr->handle = device->handle; |
511 | strcpy(acpi_device_name(device), ACPI_PROCESSOR_DEVICE_NAME); | |
512 | strcpy(acpi_device_class(device), ACPI_PROCESSOR_CLASS); | |
db89b4f0 | 513 | device->driver_data = pr; |
1da177e4 | 514 | |
b26e9286 | 515 | result = acpi_processor_get_info(device); |
1da177e4 LT |
516 | if (result) { |
517 | /* Processor is physically not present */ | |
d550d98d | 518 | return 0; |
1da177e4 LT |
519 | } |
520 | ||
75cbfb97 TR |
521 | #ifdef CONFIG_SMP |
522 | if (pr->id >= setup_max_cpus && pr->id != 0) | |
523 | return 0; | |
524 | #endif | |
525 | ||
fbb43ab0 | 526 | BUG_ON((pr->id >= nr_cpu_ids) || (pr->id < 0)); |
1da177e4 | 527 | |
cd8e2b48 VP |
528 | /* |
529 | * Buggy BIOS check | |
530 | * ACPI id of processors can be reported wrongly by the BIOS. | |
531 | * Don't trust it blindly | |
532 | */ | |
706546d0 MT |
533 | if (per_cpu(processor_device_array, pr->id) != NULL && |
534 | per_cpu(processor_device_array, pr->id) != device) { | |
4fdb2a05 | 535 | printk(KERN_WARNING "BIOS reported wrong ACPI id " |
0eacee58 | 536 | "for the processor\n"); |
970b0492 BH |
537 | result = -ENODEV; |
538 | goto err_free_cpumask; | |
cd8e2b48 | 539 | } |
706546d0 | 540 | per_cpu(processor_device_array, pr->id) = device; |
cd8e2b48 | 541 | |
706546d0 | 542 | per_cpu(processors, pr->id) = pr; |
1da177e4 | 543 | |
8a25a2fd KS |
544 | dev = get_cpu_device(pr->id); |
545 | if (sysfs_create_link(&device->dev.kobj, &dev->kobj, "sysdev")) { | |
d4e05261 | 546 | result = -EFAULT; |
cef6e8a3 | 547 | goto err_free_cpumask; |
d4e05261 | 548 | } |
54d5dcc4 TR |
549 | result = acpi_processor_start(pr); |
550 | if (result) | |
d4e05261 | 551 | goto err_remove_sysfs; |
d9460fd2 | 552 | |
d550d98d | 553 | return 0; |
d4e05261 BH |
554 | |
555 | err_remove_sysfs: | |
3333ea78 | 556 | sysfs_remove_link(&device->dev.kobj, "sysdev"); |
970b0492 BH |
557 | err_free_cpumask: |
558 | free_cpumask_var(pr->throttling.shared_cpu_map); | |
1da177e4 | 559 | |
d550d98d | 560 | return result; |
1da177e4 LT |
561 | } |
562 | ||
4be44fcd | 563 | static int acpi_processor_remove(struct acpi_device *device, int type) |
1da177e4 | 564 | { |
4be44fcd | 565 | struct acpi_processor *pr = NULL; |
1da177e4 | 566 | |
1da177e4 LT |
567 | |
568 | if (!device || !acpi_driver_data(device)) | |
d550d98d | 569 | return -EINVAL; |
1da177e4 | 570 | |
50dd0969 | 571 | pr = acpi_driver_data(device); |
1da177e4 | 572 | |
2fdf66b4 RR |
573 | if (pr->id >= nr_cpu_ids) |
574 | goto free; | |
1da177e4 LT |
575 | |
576 | if (type == ACPI_BUS_REMOVAL_EJECT) { | |
577 | if (acpi_processor_handle_eject(pr)) | |
d550d98d | 578 | return -EINVAL; |
1da177e4 LT |
579 | } |
580 | ||
581 | acpi_processor_power_exit(pr, device); | |
582 | ||
9f1eb99c ZR |
583 | sysfs_remove_link(&device->dev.kobj, "sysdev"); |
584 | ||
f28bb45e ZY |
585 | if (pr->cdev) { |
586 | sysfs_remove_link(&device->dev.kobj, "thermal_cooling"); | |
587 | sysfs_remove_link(&pr->cdev->device.kobj, "device"); | |
588 | thermal_cooling_device_unregister(pr->cdev); | |
589 | pr->cdev = NULL; | |
590 | } | |
d9460fd2 | 591 | |
706546d0 MT |
592 | per_cpu(processors, pr->id) = NULL; |
593 | per_cpu(processor_device_array, pr->id) = NULL; | |
2fdf66b4 RR |
594 | |
595 | free: | |
596 | free_cpumask_var(pr->throttling.shared_cpu_map); | |
1da177e4 LT |
597 | kfree(pr); |
598 | ||
d550d98d | 599 | return 0; |
1da177e4 LT |
600 | } |
601 | ||
602 | #ifdef CONFIG_ACPI_HOTPLUG_CPU | |
603 | /**************************************************************************** | |
604 | * Acpi processor hotplug support * | |
605 | ****************************************************************************/ | |
606 | ||
4be44fcd | 607 | static int is_processor_present(acpi_handle handle) |
1da177e4 | 608 | { |
4be44fcd | 609 | acpi_status status; |
27663c58 | 610 | unsigned long long sta = 0; |
1da177e4 | 611 | |
1da177e4 LT |
612 | |
613 | status = acpi_evaluate_integer(handle, "_STA", NULL, &sta); | |
cfaf3747 ZR |
614 | |
615 | if (ACPI_SUCCESS(status) && (sta & ACPI_STA_DEVICE_PRESENT)) | |
616 | return 1; | |
617 | ||
d0ce46f5 ZR |
618 | /* |
619 | * _STA is mandatory for a processor that supports hot plug | |
620 | */ | |
621 | if (status == AE_NOT_FOUND) | |
622 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, | |
623 | "Processor does not support hot plug\n")); | |
624 | else | |
625 | ACPI_EXCEPTION((AE_INFO, status, | |
626 | "Processor Device is not present")); | |
cfaf3747 | 627 | return 0; |
1da177e4 LT |
628 | } |
629 | ||
1da177e4 | 630 | static |
4be44fcd | 631 | int acpi_processor_device_add(acpi_handle handle, struct acpi_device **device) |
1da177e4 | 632 | { |
4be44fcd LB |
633 | acpi_handle phandle; |
634 | struct acpi_device *pdev; | |
1da177e4 | 635 | |
1da177e4 LT |
636 | |
637 | if (acpi_get_parent(handle, &phandle)) { | |
d550d98d | 638 | return -ENODEV; |
1da177e4 LT |
639 | } |
640 | ||
641 | if (acpi_bus_get_device(phandle, &pdev)) { | |
d550d98d | 642 | return -ENODEV; |
1da177e4 LT |
643 | } |
644 | ||
645 | if (acpi_bus_add(device, pdev, handle, ACPI_BUS_TYPE_PROCESSOR)) { | |
d550d98d | 646 | return -ENODEV; |
1da177e4 LT |
647 | } |
648 | ||
d550d98d | 649 | return 0; |
1da177e4 LT |
650 | } |
651 | ||
6430c9c1 JB |
652 | static void acpi_processor_hotplug_notify(acpi_handle handle, |
653 | u32 event, void *data) | |
1da177e4 | 654 | { |
4be44fcd LB |
655 | struct acpi_processor *pr; |
656 | struct acpi_device *device = NULL; | |
1da177e4 LT |
657 | int result; |
658 | ||
1da177e4 LT |
659 | |
660 | switch (event) { | |
661 | case ACPI_NOTIFY_BUS_CHECK: | |
662 | case ACPI_NOTIFY_DEVICE_CHECK: | |
d6f882e1 GC |
663 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, |
664 | "Processor driver received %s event\n", | |
4be44fcd | 665 | (event == ACPI_NOTIFY_BUS_CHECK) ? |
d6f882e1 | 666 | "ACPI_NOTIFY_BUS_CHECK" : "ACPI_NOTIFY_DEVICE_CHECK")); |
1da177e4 LT |
667 | |
668 | if (!is_processor_present(handle)) | |
669 | break; | |
670 | ||
671 | if (acpi_bus_get_device(handle, &device)) { | |
672 | result = acpi_processor_device_add(handle, &device); | |
673 | if (result) | |
6468463a LB |
674 | printk(KERN_ERR PREFIX |
675 | "Unable to add the device\n"); | |
1da177e4 LT |
676 | break; |
677 | } | |
4be44fcd | 678 | break; |
1da177e4 | 679 | case ACPI_NOTIFY_EJECT_REQUEST: |
4be44fcd LB |
680 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, |
681 | "received ACPI_NOTIFY_EJECT_REQUEST\n")); | |
1da177e4 LT |
682 | |
683 | if (acpi_bus_get_device(handle, &device)) { | |
6468463a LB |
684 | printk(KERN_ERR PREFIX |
685 | "Device don't exist, dropping EJECT\n"); | |
1da177e4 LT |
686 | break; |
687 | } | |
688 | pr = acpi_driver_data(device); | |
689 | if (!pr) { | |
6468463a LB |
690 | printk(KERN_ERR PREFIX |
691 | "Driver data is NULL, dropping EJECT\n"); | |
d550d98d | 692 | return; |
1da177e4 | 693 | } |
1da177e4 LT |
694 | break; |
695 | default: | |
696 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, | |
4be44fcd | 697 | "Unsupported event [0x%x]\n", event)); |
1da177e4 LT |
698 | break; |
699 | } | |
700 | ||
d550d98d | 701 | return; |
1da177e4 LT |
702 | } |
703 | ||
704 | static acpi_status | |
705 | processor_walk_namespace_cb(acpi_handle handle, | |
4be44fcd | 706 | u32 lvl, void *context, void **rv) |
1da177e4 | 707 | { |
4be44fcd | 708 | acpi_status status; |
1da177e4 | 709 | int *action = context; |
4be44fcd | 710 | acpi_object_type type = 0; |
1da177e4 LT |
711 | |
712 | status = acpi_get_type(handle, &type); | |
713 | if (ACPI_FAILURE(status)) | |
4be44fcd | 714 | return (AE_OK); |
1da177e4 LT |
715 | |
716 | if (type != ACPI_TYPE_PROCESSOR) | |
4be44fcd | 717 | return (AE_OK); |
1da177e4 | 718 | |
4be44fcd | 719 | switch (*action) { |
1da177e4 LT |
720 | case INSTALL_NOTIFY_HANDLER: |
721 | acpi_install_notify_handler(handle, | |
4be44fcd LB |
722 | ACPI_SYSTEM_NOTIFY, |
723 | acpi_processor_hotplug_notify, | |
724 | NULL); | |
1da177e4 LT |
725 | break; |
726 | case UNINSTALL_NOTIFY_HANDLER: | |
727 | acpi_remove_notify_handler(handle, | |
4be44fcd LB |
728 | ACPI_SYSTEM_NOTIFY, |
729 | acpi_processor_hotplug_notify); | |
1da177e4 LT |
730 | break; |
731 | default: | |
732 | break; | |
733 | } | |
734 | ||
4be44fcd | 735 | return (AE_OK); |
1da177e4 LT |
736 | } |
737 | ||
3bd81a87 | 738 | static acpi_status acpi_processor_hotadd_init(struct acpi_processor *pr) |
1da177e4 | 739 | { |
3bd81a87 | 740 | acpi_handle handle = pr->handle; |
1da177e4 LT |
741 | |
742 | if (!is_processor_present(handle)) { | |
d550d98d | 743 | return AE_ERROR; |
1da177e4 LT |
744 | } |
745 | ||
3bd81a87 | 746 | if (acpi_map_lsapic(handle, &pr->id)) |
d550d98d | 747 | return AE_ERROR; |
1da177e4 | 748 | |
3bd81a87 TR |
749 | if (arch_register_cpu(pr->id)) { |
750 | acpi_unmap_lsapic(pr->id); | |
d550d98d | 751 | return AE_ERROR; |
1da177e4 LT |
752 | } |
753 | ||
d550d98d | 754 | return AE_OK; |
1da177e4 LT |
755 | } |
756 | ||
4be44fcd | 757 | static int acpi_processor_handle_eject(struct acpi_processor *pr) |
1da177e4 | 758 | { |
b62b8ef9 ZR |
759 | if (cpu_online(pr->id)) |
760 | cpu_down(pr->id); | |
761 | ||
1da177e4 LT |
762 | arch_unregister_cpu(pr->id); |
763 | acpi_unmap_lsapic(pr->id); | |
4be44fcd | 764 | return (0); |
1da177e4 LT |
765 | } |
766 | #else | |
3bd81a87 | 767 | static acpi_status acpi_processor_hotadd_init(struct acpi_processor *pr) |
1da177e4 LT |
768 | { |
769 | return AE_ERROR; | |
770 | } | |
4be44fcd | 771 | static int acpi_processor_handle_eject(struct acpi_processor *pr) |
1da177e4 | 772 | { |
4be44fcd | 773 | return (-EINVAL); |
1da177e4 LT |
774 | } |
775 | #endif | |
776 | ||
1da177e4 LT |
777 | static |
778 | void acpi_processor_install_hotplug_notify(void) | |
779 | { | |
780 | #ifdef CONFIG_ACPI_HOTPLUG_CPU | |
781 | int action = INSTALL_NOTIFY_HANDLER; | |
782 | acpi_walk_namespace(ACPI_TYPE_PROCESSOR, | |
4be44fcd LB |
783 | ACPI_ROOT_OBJECT, |
784 | ACPI_UINT32_MAX, | |
2263576c | 785 | processor_walk_namespace_cb, NULL, &action, NULL); |
1da177e4 | 786 | #endif |
729c6ba3 | 787 | register_hotcpu_notifier(&acpi_cpu_notifier); |
1da177e4 LT |
788 | } |
789 | ||
1da177e4 LT |
790 | static |
791 | void acpi_processor_uninstall_hotplug_notify(void) | |
792 | { | |
793 | #ifdef CONFIG_ACPI_HOTPLUG_CPU | |
794 | int action = UNINSTALL_NOTIFY_HANDLER; | |
795 | acpi_walk_namespace(ACPI_TYPE_PROCESSOR, | |
4be44fcd LB |
796 | ACPI_ROOT_OBJECT, |
797 | ACPI_UINT32_MAX, | |
2263576c | 798 | processor_walk_namespace_cb, NULL, &action, NULL); |
1da177e4 | 799 | #endif |
729c6ba3 | 800 | unregister_hotcpu_notifier(&acpi_cpu_notifier); |
1da177e4 LT |
801 | } |
802 | ||
803 | /* | |
804 | * We keep the driver loaded even when ACPI is not running. | |
805 | * This is needed for the powernow-k8 driver, that works even without | |
806 | * ACPI, but needs symbols from this driver | |
807 | */ | |
808 | ||
4be44fcd | 809 | static int __init acpi_processor_init(void) |
1da177e4 | 810 | { |
4be44fcd | 811 | int result = 0; |
1da177e4 | 812 | |
ce8442b5 YL |
813 | if (acpi_disabled) |
814 | return 0; | |
815 | ||
1da177e4 LT |
816 | memset(&errata, 0, sizeof(errata)); |
817 | ||
1da177e4 | 818 | result = acpi_bus_register_driver(&acpi_processor_driver); |
4f86d3a8 | 819 | if (result < 0) |
46bcfad7 | 820 | return result; |
1da177e4 LT |
821 | |
822 | acpi_processor_install_hotplug_notify(); | |
823 | ||
824 | acpi_thermal_cpufreq_init(); | |
825 | ||
826 | acpi_processor_ppc_init(); | |
827 | ||
1180509f ZY |
828 | acpi_processor_throttling_init(); |
829 | ||
d550d98d | 830 | return 0; |
1da177e4 LT |
831 | } |
832 | ||
4be44fcd | 833 | static void __exit acpi_processor_exit(void) |
1da177e4 | 834 | { |
ce8442b5 YL |
835 | if (acpi_disabled) |
836 | return; | |
837 | ||
1da177e4 LT |
838 | acpi_processor_ppc_exit(); |
839 | ||
840 | acpi_thermal_cpufreq_exit(); | |
841 | ||
842 | acpi_processor_uninstall_hotplug_notify(); | |
843 | ||
844 | acpi_bus_unregister_driver(&acpi_processor_driver); | |
845 | ||
d550d98d | 846 | return; |
1da177e4 LT |
847 | } |
848 | ||
1da177e4 LT |
849 | module_init(acpi_processor_init); |
850 | module_exit(acpi_processor_exit); | |
851 | ||
1da177e4 | 852 | MODULE_ALIAS("processor"); |