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); |
1da177e4 LT |
85 | static acpi_status acpi_processor_hotadd_init(acpi_handle handle, int *p_cpu); |
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) { |
4be44fcd LB |
327 | if (ACPI_FAILURE |
328 | (acpi_processor_hotadd_init(pr->handle, &pr->id))) { | |
d550d98d | 329 | return -ENODEV; |
4be44fcd LB |
330 | } |
331 | } | |
7a04b849 ZY |
332 | /* |
333 | * On some boxes several processors use the same processor bus id. | |
334 | * But they are located in different scope. For example: | |
335 | * \_SB.SCK0.CPU0 | |
336 | * \_SB.SCK1.CPU0 | |
337 | * Rename the processor device bus id. And the new bus id will be | |
338 | * generated as the following format: | |
339 | * CPU+CPU ID. | |
340 | */ | |
341 | sprintf(acpi_device_bid(device), "CPU%X", pr->id); | |
1da177e4 | 342 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Processor [%d:%d]\n", pr->id, |
4be44fcd | 343 | pr->acpi_id)); |
1da177e4 LT |
344 | |
345 | if (!object.processor.pblk_address) | |
346 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "No PBLK (NULL address)\n")); | |
347 | else if (object.processor.pblk_length != 6) | |
6468463a LB |
348 | printk(KERN_ERR PREFIX "Invalid PBLK length [%d]\n", |
349 | object.processor.pblk_length); | |
1da177e4 LT |
350 | else { |
351 | pr->throttling.address = object.processor.pblk_address; | |
cee324b1 AS |
352 | pr->throttling.duty_offset = acpi_gbl_FADT.duty_offset; |
353 | pr->throttling.duty_width = acpi_gbl_FADT.duty_width; | |
1da177e4 LT |
354 | |
355 | pr->pblk = object.processor.pblk_address; | |
356 | ||
357 | /* | |
358 | * We don't care about error returns - we just try to mark | |
359 | * these reserved so that nobody else is confused into thinking | |
360 | * that this region might be unused.. | |
361 | * | |
362 | * (In particular, allocating the IO range for Cardbus) | |
363 | */ | |
364 | request_region(pr->throttling.address, 6, "ACPI CPU throttle"); | |
365 | } | |
366 | ||
fe086a7b AC |
367 | /* |
368 | * If ACPI describes a slot number for this CPU, we can use it | |
369 | * ensure we get the right value in the "physical id" field | |
370 | * of /proc/cpuinfo | |
371 | */ | |
372 | status = acpi_evaluate_object(pr->handle, "_SUN", NULL, &buffer); | |
373 | if (ACPI_SUCCESS(status)) | |
374 | arch_fix_phys_package_id(pr->id, object.integer.value); | |
375 | ||
d550d98d | 376 | return 0; |
1da177e4 LT |
377 | } |
378 | ||
706546d0 | 379 | static DEFINE_PER_CPU(void *, processor_device_array); |
cd8e2b48 | 380 | |
7ec0a729 | 381 | static void acpi_processor_notify(struct acpi_device *device, u32 event) |
1da177e4 | 382 | { |
7ec0a729 | 383 | struct acpi_processor *pr = acpi_driver_data(device); |
e790cc8b | 384 | int saved; |
1da177e4 LT |
385 | |
386 | if (!pr) | |
d550d98d | 387 | return; |
1da177e4 | 388 | |
1da177e4 LT |
389 | switch (event) { |
390 | case ACPI_PROCESSOR_NOTIFY_PERFORMANCE: | |
e790cc8b | 391 | saved = pr->performance_platform_limit; |
d81c45e1 | 392 | acpi_processor_ppc_has_changed(pr, 1); |
e790cc8b AS |
393 | if (saved == pr->performance_platform_limit) |
394 | break; | |
14e04fb3 | 395 | acpi_bus_generate_proc_event(device, event, |
4be44fcd | 396 | pr->performance_platform_limit); |
962ce8ca | 397 | acpi_bus_generate_netlink_event(device->pnp.device_class, |
0794469d | 398 | dev_name(&device->dev), event, |
962ce8ca | 399 | pr->performance_platform_limit); |
1da177e4 LT |
400 | break; |
401 | case ACPI_PROCESSOR_NOTIFY_POWER: | |
402 | acpi_processor_cst_has_changed(pr); | |
14e04fb3 | 403 | acpi_bus_generate_proc_event(device, event, 0); |
962ce8ca | 404 | acpi_bus_generate_netlink_event(device->pnp.device_class, |
0794469d | 405 | dev_name(&device->dev), event, 0); |
1da177e4 | 406 | break; |
01854e69 LY |
407 | case ACPI_PROCESSOR_NOTIFY_THROTTLING: |
408 | acpi_processor_tstate_has_changed(pr); | |
14e04fb3 | 409 | acpi_bus_generate_proc_event(device, event, 0); |
962ce8ca | 410 | acpi_bus_generate_netlink_event(device->pnp.device_class, |
0794469d | 411 | dev_name(&device->dev), event, 0); |
1da177e4 LT |
412 | default: |
413 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, | |
4be44fcd | 414 | "Unsupported event [0x%x]\n", event)); |
1da177e4 LT |
415 | break; |
416 | } | |
417 | ||
d550d98d | 418 | return; |
1da177e4 LT |
419 | } |
420 | ||
729c6ba3 VP |
421 | static int acpi_cpu_soft_notify(struct notifier_block *nfb, |
422 | unsigned long action, void *hcpu) | |
423 | { | |
424 | unsigned int cpu = (unsigned long)hcpu; | |
706546d0 | 425 | struct acpi_processor *pr = per_cpu(processors, cpu); |
729c6ba3 VP |
426 | |
427 | if (action == CPU_ONLINE && pr) { | |
d81c45e1 | 428 | acpi_processor_ppc_has_changed(pr, 0); |
729c6ba3 | 429 | acpi_processor_cst_has_changed(pr); |
5a344a50 | 430 | acpi_processor_reevaluate_tstate(pr, action); |
729c6ba3 VP |
431 | acpi_processor_tstate_has_changed(pr); |
432 | } | |
5a344a50 ZY |
433 | if (action == CPU_DEAD && pr) { |
434 | /* invalidate the flag.throttling after one CPU is offline */ | |
435 | acpi_processor_reevaluate_tstate(pr, action); | |
436 | } | |
729c6ba3 VP |
437 | return NOTIFY_OK; |
438 | } | |
439 | ||
440 | static struct notifier_block acpi_cpu_notifier = | |
441 | { | |
442 | .notifier_call = acpi_cpu_soft_notify, | |
443 | }; | |
444 | ||
941b10fa | 445 | static int __cpuinit acpi_processor_add(struct acpi_device *device) |
1da177e4 | 446 | { |
4be44fcd | 447 | struct acpi_processor *pr = NULL; |
970b0492 BH |
448 | int result = 0; |
449 | struct sys_device *sysdev; | |
1da177e4 | 450 | |
36bcbec7 | 451 | pr = kzalloc(sizeof(struct acpi_processor), GFP_KERNEL); |
1da177e4 | 452 | if (!pr) |
d550d98d | 453 | return -ENOMEM; |
1da177e4 | 454 | |
eaa95840 | 455 | if (!zalloc_cpumask_var(&pr->throttling.shared_cpu_map, GFP_KERNEL)) { |
2fdf66b4 RR |
456 | kfree(pr); |
457 | return -ENOMEM; | |
458 | } | |
459 | ||
1da177e4 LT |
460 | pr->handle = device->handle; |
461 | strcpy(acpi_device_name(device), ACPI_PROCESSOR_DEVICE_NAME); | |
462 | strcpy(acpi_device_class(device), ACPI_PROCESSOR_CLASS); | |
db89b4f0 | 463 | device->driver_data = pr; |
1da177e4 | 464 | |
b26e9286 | 465 | result = acpi_processor_get_info(device); |
1da177e4 LT |
466 | if (result) { |
467 | /* Processor is physically not present */ | |
d550d98d | 468 | return 0; |
1da177e4 LT |
469 | } |
470 | ||
75cbfb97 TR |
471 | #ifdef CONFIG_SMP |
472 | if (pr->id >= setup_max_cpus && pr->id != 0) | |
473 | return 0; | |
474 | #endif | |
475 | ||
fbb43ab0 | 476 | BUG_ON((pr->id >= nr_cpu_ids) || (pr->id < 0)); |
1da177e4 | 477 | |
cd8e2b48 VP |
478 | /* |
479 | * Buggy BIOS check | |
480 | * ACPI id of processors can be reported wrongly by the BIOS. | |
481 | * Don't trust it blindly | |
482 | */ | |
706546d0 MT |
483 | if (per_cpu(processor_device_array, pr->id) != NULL && |
484 | per_cpu(processor_device_array, pr->id) != device) { | |
4fdb2a05 | 485 | printk(KERN_WARNING "BIOS reported wrong ACPI id " |
0eacee58 | 486 | "for the processor\n"); |
970b0492 BH |
487 | result = -ENODEV; |
488 | goto err_free_cpumask; | |
cd8e2b48 | 489 | } |
706546d0 | 490 | per_cpu(processor_device_array, pr->id) = device; |
cd8e2b48 | 491 | |
706546d0 | 492 | per_cpu(processors, pr->id) = pr; |
1da177e4 | 493 | |
9f1eb99c | 494 | sysdev = get_cpu_sysdev(pr->id); |
d4e05261 BH |
495 | if (sysfs_create_link(&device->dev.kobj, &sysdev->kobj, "sysdev")) { |
496 | result = -EFAULT; | |
cef6e8a3 | 497 | goto err_free_cpumask; |
d4e05261 | 498 | } |
9f1eb99c | 499 | |
0ac3c571 | 500 | #ifdef CONFIG_CPU_FREQ |
d81c45e1 | 501 | acpi_processor_ppc_has_changed(pr, 0); |
0ac3c571 ZY |
502 | #endif |
503 | acpi_processor_get_throttling_info(pr); | |
504 | acpi_processor_get_limit_info(pr); | |
505 | ||
05131ecc | 506 | |
541adf7c LB |
507 | if (cpuidle_get_driver() == &acpi_idle_driver) |
508 | acpi_processor_power_init(pr, device); | |
1da177e4 | 509 | |
d9460fd2 ZR |
510 | pr->cdev = thermal_cooling_device_register("Processor", device, |
511 | &processor_cooling_ops); | |
d76628c6 TS |
512 | if (IS_ERR(pr->cdev)) { |
513 | result = PTR_ERR(pr->cdev); | |
d4e05261 | 514 | goto err_power_exit; |
d76628c6 | 515 | } |
9030062f | 516 | |
13c41157 | 517 | dev_dbg(&device->dev, "registered as cooling_device%d\n", |
fc3a8828 | 518 | pr->cdev->id); |
9030062f JL |
519 | |
520 | result = sysfs_create_link(&device->dev.kobj, | |
521 | &pr->cdev->device.kobj, | |
522 | "thermal_cooling"); | |
d4e05261 | 523 | if (result) { |
9030062f | 524 | printk(KERN_ERR PREFIX "Create sysfs link\n"); |
d4e05261 BH |
525 | goto err_thermal_unregister; |
526 | } | |
9030062f JL |
527 | result = sysfs_create_link(&pr->cdev->device.kobj, |
528 | &device->dev.kobj, | |
529 | "device"); | |
d4e05261 | 530 | if (result) { |
9030062f | 531 | printk(KERN_ERR PREFIX "Create sysfs link\n"); |
d4e05261 BH |
532 | goto err_remove_sysfs; |
533 | } | |
d9460fd2 | 534 | |
d550d98d | 535 | return 0; |
d4e05261 BH |
536 | |
537 | err_remove_sysfs: | |
538 | sysfs_remove_link(&device->dev.kobj, "thermal_cooling"); | |
539 | err_thermal_unregister: | |
540 | thermal_cooling_device_unregister(pr->cdev); | |
541 | err_power_exit: | |
542 | acpi_processor_power_exit(pr, device); | |
970b0492 BH |
543 | err_free_cpumask: |
544 | free_cpumask_var(pr->throttling.shared_cpu_map); | |
1da177e4 | 545 | |
d550d98d | 546 | return result; |
1da177e4 LT |
547 | } |
548 | ||
4be44fcd | 549 | static int acpi_processor_remove(struct acpi_device *device, int type) |
1da177e4 | 550 | { |
4be44fcd | 551 | struct acpi_processor *pr = NULL; |
1da177e4 | 552 | |
1da177e4 LT |
553 | |
554 | if (!device || !acpi_driver_data(device)) | |
d550d98d | 555 | return -EINVAL; |
1da177e4 | 556 | |
50dd0969 | 557 | pr = acpi_driver_data(device); |
1da177e4 | 558 | |
2fdf66b4 RR |
559 | if (pr->id >= nr_cpu_ids) |
560 | goto free; | |
1da177e4 LT |
561 | |
562 | if (type == ACPI_BUS_REMOVAL_EJECT) { | |
563 | if (acpi_processor_handle_eject(pr)) | |
d550d98d | 564 | return -EINVAL; |
1da177e4 LT |
565 | } |
566 | ||
567 | acpi_processor_power_exit(pr, device); | |
568 | ||
9f1eb99c ZR |
569 | sysfs_remove_link(&device->dev.kobj, "sysdev"); |
570 | ||
f28bb45e ZY |
571 | if (pr->cdev) { |
572 | sysfs_remove_link(&device->dev.kobj, "thermal_cooling"); | |
573 | sysfs_remove_link(&pr->cdev->device.kobj, "device"); | |
574 | thermal_cooling_device_unregister(pr->cdev); | |
575 | pr->cdev = NULL; | |
576 | } | |
d9460fd2 | 577 | |
706546d0 MT |
578 | per_cpu(processors, pr->id) = NULL; |
579 | per_cpu(processor_device_array, pr->id) = NULL; | |
2fdf66b4 RR |
580 | |
581 | free: | |
582 | free_cpumask_var(pr->throttling.shared_cpu_map); | |
1da177e4 LT |
583 | kfree(pr); |
584 | ||
d550d98d | 585 | return 0; |
1da177e4 LT |
586 | } |
587 | ||
588 | #ifdef CONFIG_ACPI_HOTPLUG_CPU | |
589 | /**************************************************************************** | |
590 | * Acpi processor hotplug support * | |
591 | ****************************************************************************/ | |
592 | ||
4be44fcd | 593 | static int is_processor_present(acpi_handle handle) |
1da177e4 | 594 | { |
4be44fcd | 595 | acpi_status status; |
27663c58 | 596 | unsigned long long sta = 0; |
1da177e4 | 597 | |
1da177e4 LT |
598 | |
599 | status = acpi_evaluate_integer(handle, "_STA", NULL, &sta); | |
cfaf3747 ZR |
600 | |
601 | if (ACPI_SUCCESS(status) && (sta & ACPI_STA_DEVICE_PRESENT)) | |
602 | return 1; | |
603 | ||
d0ce46f5 ZR |
604 | /* |
605 | * _STA is mandatory for a processor that supports hot plug | |
606 | */ | |
607 | if (status == AE_NOT_FOUND) | |
608 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, | |
609 | "Processor does not support hot plug\n")); | |
610 | else | |
611 | ACPI_EXCEPTION((AE_INFO, status, | |
612 | "Processor Device is not present")); | |
cfaf3747 | 613 | return 0; |
1da177e4 LT |
614 | } |
615 | ||
1da177e4 | 616 | static |
4be44fcd | 617 | int acpi_processor_device_add(acpi_handle handle, struct acpi_device **device) |
1da177e4 | 618 | { |
4be44fcd LB |
619 | acpi_handle phandle; |
620 | struct acpi_device *pdev; | |
1da177e4 | 621 | |
1da177e4 LT |
622 | |
623 | if (acpi_get_parent(handle, &phandle)) { | |
d550d98d | 624 | return -ENODEV; |
1da177e4 LT |
625 | } |
626 | ||
627 | if (acpi_bus_get_device(phandle, &pdev)) { | |
d550d98d | 628 | return -ENODEV; |
1da177e4 LT |
629 | } |
630 | ||
631 | if (acpi_bus_add(device, pdev, handle, ACPI_BUS_TYPE_PROCESSOR)) { | |
d550d98d | 632 | return -ENODEV; |
1da177e4 LT |
633 | } |
634 | ||
d550d98d | 635 | return 0; |
1da177e4 LT |
636 | } |
637 | ||
b95e9e8d SR |
638 | static void __ref acpi_processor_hotplug_notify(acpi_handle handle, |
639 | u32 event, void *data) | |
1da177e4 | 640 | { |
4be44fcd LB |
641 | struct acpi_processor *pr; |
642 | struct acpi_device *device = NULL; | |
1da177e4 LT |
643 | int result; |
644 | ||
1da177e4 LT |
645 | |
646 | switch (event) { | |
647 | case ACPI_NOTIFY_BUS_CHECK: | |
648 | case ACPI_NOTIFY_DEVICE_CHECK: | |
d6f882e1 GC |
649 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, |
650 | "Processor driver received %s event\n", | |
4be44fcd | 651 | (event == ACPI_NOTIFY_BUS_CHECK) ? |
d6f882e1 | 652 | "ACPI_NOTIFY_BUS_CHECK" : "ACPI_NOTIFY_DEVICE_CHECK")); |
1da177e4 LT |
653 | |
654 | if (!is_processor_present(handle)) | |
655 | break; | |
656 | ||
657 | if (acpi_bus_get_device(handle, &device)) { | |
658 | result = acpi_processor_device_add(handle, &device); | |
659 | if (result) | |
6468463a LB |
660 | printk(KERN_ERR PREFIX |
661 | "Unable to add the device\n"); | |
1da177e4 LT |
662 | break; |
663 | } | |
4be44fcd | 664 | break; |
1da177e4 | 665 | case ACPI_NOTIFY_EJECT_REQUEST: |
4be44fcd LB |
666 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, |
667 | "received ACPI_NOTIFY_EJECT_REQUEST\n")); | |
1da177e4 LT |
668 | |
669 | if (acpi_bus_get_device(handle, &device)) { | |
6468463a LB |
670 | printk(KERN_ERR PREFIX |
671 | "Device don't exist, dropping EJECT\n"); | |
1da177e4 LT |
672 | break; |
673 | } | |
674 | pr = acpi_driver_data(device); | |
675 | if (!pr) { | |
6468463a LB |
676 | printk(KERN_ERR PREFIX |
677 | "Driver data is NULL, dropping EJECT\n"); | |
d550d98d | 678 | return; |
1da177e4 | 679 | } |
1da177e4 LT |
680 | break; |
681 | default: | |
682 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, | |
4be44fcd | 683 | "Unsupported event [0x%x]\n", event)); |
1da177e4 LT |
684 | break; |
685 | } | |
686 | ||
d550d98d | 687 | return; |
1da177e4 LT |
688 | } |
689 | ||
690 | static acpi_status | |
691 | processor_walk_namespace_cb(acpi_handle handle, | |
4be44fcd | 692 | u32 lvl, void *context, void **rv) |
1da177e4 | 693 | { |
4be44fcd | 694 | acpi_status status; |
1da177e4 | 695 | int *action = context; |
4be44fcd | 696 | acpi_object_type type = 0; |
1da177e4 LT |
697 | |
698 | status = acpi_get_type(handle, &type); | |
699 | if (ACPI_FAILURE(status)) | |
4be44fcd | 700 | return (AE_OK); |
1da177e4 LT |
701 | |
702 | if (type != ACPI_TYPE_PROCESSOR) | |
4be44fcd | 703 | return (AE_OK); |
1da177e4 | 704 | |
4be44fcd | 705 | switch (*action) { |
1da177e4 LT |
706 | case INSTALL_NOTIFY_HANDLER: |
707 | acpi_install_notify_handler(handle, | |
4be44fcd LB |
708 | ACPI_SYSTEM_NOTIFY, |
709 | acpi_processor_hotplug_notify, | |
710 | NULL); | |
1da177e4 LT |
711 | break; |
712 | case UNINSTALL_NOTIFY_HANDLER: | |
713 | acpi_remove_notify_handler(handle, | |
4be44fcd LB |
714 | ACPI_SYSTEM_NOTIFY, |
715 | acpi_processor_hotplug_notify); | |
1da177e4 LT |
716 | break; |
717 | default: | |
718 | break; | |
719 | } | |
720 | ||
4be44fcd | 721 | return (AE_OK); |
1da177e4 LT |
722 | } |
723 | ||
4be44fcd | 724 | static acpi_status acpi_processor_hotadd_init(acpi_handle handle, int *p_cpu) |
1da177e4 | 725 | { |
1da177e4 LT |
726 | |
727 | if (!is_processor_present(handle)) { | |
d550d98d | 728 | return AE_ERROR; |
1da177e4 LT |
729 | } |
730 | ||
731 | if (acpi_map_lsapic(handle, p_cpu)) | |
d550d98d | 732 | return AE_ERROR; |
1da177e4 LT |
733 | |
734 | if (arch_register_cpu(*p_cpu)) { | |
735 | acpi_unmap_lsapic(*p_cpu); | |
d550d98d | 736 | return AE_ERROR; |
1da177e4 LT |
737 | } |
738 | ||
d550d98d | 739 | return AE_OK; |
1da177e4 LT |
740 | } |
741 | ||
4be44fcd | 742 | static int acpi_processor_handle_eject(struct acpi_processor *pr) |
1da177e4 | 743 | { |
b62b8ef9 ZR |
744 | if (cpu_online(pr->id)) |
745 | cpu_down(pr->id); | |
746 | ||
1da177e4 LT |
747 | arch_unregister_cpu(pr->id); |
748 | acpi_unmap_lsapic(pr->id); | |
4be44fcd | 749 | return (0); |
1da177e4 LT |
750 | } |
751 | #else | |
4be44fcd | 752 | static acpi_status acpi_processor_hotadd_init(acpi_handle handle, int *p_cpu) |
1da177e4 LT |
753 | { |
754 | return AE_ERROR; | |
755 | } | |
4be44fcd | 756 | static int acpi_processor_handle_eject(struct acpi_processor *pr) |
1da177e4 | 757 | { |
4be44fcd | 758 | return (-EINVAL); |
1da177e4 LT |
759 | } |
760 | #endif | |
761 | ||
1da177e4 LT |
762 | static |
763 | void acpi_processor_install_hotplug_notify(void) | |
764 | { | |
765 | #ifdef CONFIG_ACPI_HOTPLUG_CPU | |
766 | int action = INSTALL_NOTIFY_HANDLER; | |
767 | acpi_walk_namespace(ACPI_TYPE_PROCESSOR, | |
4be44fcd LB |
768 | ACPI_ROOT_OBJECT, |
769 | ACPI_UINT32_MAX, | |
2263576c | 770 | processor_walk_namespace_cb, NULL, &action, NULL); |
1da177e4 | 771 | #endif |
729c6ba3 | 772 | register_hotcpu_notifier(&acpi_cpu_notifier); |
1da177e4 LT |
773 | } |
774 | ||
1da177e4 LT |
775 | static |
776 | void acpi_processor_uninstall_hotplug_notify(void) | |
777 | { | |
778 | #ifdef CONFIG_ACPI_HOTPLUG_CPU | |
779 | int action = UNINSTALL_NOTIFY_HANDLER; | |
780 | acpi_walk_namespace(ACPI_TYPE_PROCESSOR, | |
4be44fcd LB |
781 | ACPI_ROOT_OBJECT, |
782 | ACPI_UINT32_MAX, | |
2263576c | 783 | processor_walk_namespace_cb, NULL, &action, NULL); |
1da177e4 | 784 | #endif |
729c6ba3 | 785 | unregister_hotcpu_notifier(&acpi_cpu_notifier); |
1da177e4 LT |
786 | } |
787 | ||
788 | /* | |
789 | * We keep the driver loaded even when ACPI is not running. | |
790 | * This is needed for the powernow-k8 driver, that works even without | |
791 | * ACPI, but needs symbols from this driver | |
792 | */ | |
793 | ||
4be44fcd | 794 | static int __init acpi_processor_init(void) |
1da177e4 | 795 | { |
4be44fcd | 796 | int result = 0; |
1da177e4 | 797 | |
ce8442b5 YL |
798 | if (acpi_disabled) |
799 | return 0; | |
800 | ||
1da177e4 LT |
801 | memset(&errata, 0, sizeof(errata)); |
802 | ||
26717172 | 803 | if (!cpuidle_register_driver(&acpi_idle_driver)) { |
541adf7c LB |
804 | printk(KERN_DEBUG "ACPI: %s registered with cpuidle\n", |
805 | acpi_idle_driver.name); | |
26717172 | 806 | } else { |
e9a64ed4 | 807 | printk(KERN_DEBUG "ACPI: acpi_idle yielding to %s\n", |
26717172 LB |
808 | cpuidle_get_driver()->name); |
809 | } | |
4f86d3a8 | 810 | |
1da177e4 | 811 | result = acpi_bus_register_driver(&acpi_processor_driver); |
4f86d3a8 LB |
812 | if (result < 0) |
813 | goto out_cpuidle; | |
1da177e4 LT |
814 | |
815 | acpi_processor_install_hotplug_notify(); | |
816 | ||
817 | acpi_thermal_cpufreq_init(); | |
818 | ||
819 | acpi_processor_ppc_init(); | |
820 | ||
1180509f ZY |
821 | acpi_processor_throttling_init(); |
822 | ||
d550d98d | 823 | return 0; |
4f86d3a8 LB |
824 | |
825 | out_cpuidle: | |
826 | cpuidle_unregister_driver(&acpi_idle_driver); | |
827 | ||
4f86d3a8 | 828 | return result; |
1da177e4 LT |
829 | } |
830 | ||
4be44fcd | 831 | static void __exit acpi_processor_exit(void) |
1da177e4 | 832 | { |
ce8442b5 YL |
833 | if (acpi_disabled) |
834 | return; | |
835 | ||
1da177e4 LT |
836 | acpi_processor_ppc_exit(); |
837 | ||
838 | acpi_thermal_cpufreq_exit(); | |
839 | ||
840 | acpi_processor_uninstall_hotplug_notify(); | |
841 | ||
842 | acpi_bus_unregister_driver(&acpi_processor_driver); | |
843 | ||
4f86d3a8 LB |
844 | cpuidle_unregister_driver(&acpi_idle_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"); |