?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Linux 2.6.26-rc5
[linux-2.6/openmoko-kernel/knife-kernel.git] / drivers / acpi / processor_core.c
blob386e5aa48834cc087ccf2e2ac6757bc14ee5a566
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/proc_fs.h>
44 #include <linux/seq_file.h>
45 #include <linux/dmi.h>
46 #include <linux/moduleparam.h>
47 #include <linux/cpuidle.h>
48
49 #include <asm/io.h>
50 #include <asm/system.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 ACPI_PROCESSOR_COMPONENT 0x01000000
63 #define ACPI_PROCESSOR_CLASS "processor"
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
70 #define ACPI_PROCESSOR_NOTIFY_THROTTLING 0x82
71
72 #define ACPI_PROCESSOR_LIMIT_USER 0
73 #define ACPI_PROCESSOR_LIMIT_THERMAL 1
74
75 #define _COMPONENT ACPI_PROCESSOR_COMPONENT
76 ACPI_MODULE_NAME("processor_core");
77
78 MODULE_AUTHOR("Paul Diefenbaugh");
79 MODULE_DESCRIPTION("ACPI Processor Driver");
80 MODULE_LICENSE("GPL");
81
82 static int acpi_processor_add(struct acpi_device *device);
83 static int acpi_processor_start(struct acpi_device *device);
84 static int acpi_processor_remove(struct acpi_device *device, int type);
85 static int acpi_processor_info_open_fs(struct inode *inode, struct file *file);
86 static void acpi_processor_notify(acpi_handle handle, u32 event, void *data);
87 static acpi_status acpi_processor_hotadd_init(acpi_handle handle, int *p_cpu);
88 static int acpi_processor_handle_eject(struct acpi_processor *pr);
89 extern int acpi_processor_tstate_has_changed(struct acpi_processor *pr);
90
91
92 static const struct acpi_device_id processor_device_ids[] = {
93 {ACPI_PROCESSOR_HID, 0},
94 {"", 0},
95 };
96 MODULE_DEVICE_TABLE(acpi, processor_device_ids);
97
98 static struct acpi_driver acpi_processor_driver = {
99 .name = "processor",
100 .class = ACPI_PROCESSOR_CLASS,
101 .ids = processor_device_ids,
102 .ops = {
103 .add = acpi_processor_add,
104 .remove = acpi_processor_remove,
105 .start = acpi_processor_start,
106 .suspend = acpi_processor_suspend,
107 .resume = acpi_processor_resume,
108 },
109 };
110
111 #define INSTALL_NOTIFY_HANDLER 1
112 #define UNINSTALL_NOTIFY_HANDLER 2
113
114 static const struct file_operations acpi_processor_info_fops = {
115 .owner = THIS_MODULE,
116 .open = acpi_processor_info_open_fs,
117 .read = seq_read,
118 .llseek = seq_lseek,
119 .release = single_release,
120 };
121
122 struct acpi_processor *processors[NR_CPUS];
123 struct acpi_processor_errata errata __read_mostly;
124
125 /* --------------------------------------------------------------------------
126 Errata Handling
127 -------------------------------------------------------------------------- */
128
129 static int acpi_processor_errata_piix4(struct pci_dev *dev)
130 {
131 u8 value1 = 0;
132 u8 value2 = 0;
133
134
135 if (!dev)
136 return -EINVAL;
137
138 /*
139 * Note that 'dev' references the PIIX4 ACPI Controller.
140 */
141
142 switch (dev->revision) {
143 case 0:
144 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found PIIX4 A-step\n"));
145 break;
146 case 1:
147 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found PIIX4 B-step\n"));
148 break;
149 case 2:
150 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found PIIX4E\n"));
151 break;
152 case 3:
153 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found PIIX4M\n"));
154 break;
155 default:
156 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found unknown PIIX4\n"));
157 break;
158 }
159
160 switch (dev->revision) {
161
162 case 0: /* PIIX4 A-step */
163 case 1: /* PIIX4 B-step */
164 /*
165 * See specification changes #13 ("Manual Throttle Duty Cycle")
166 * and #14 ("Enabling and Disabling Manual Throttle"), plus
167 * erratum #5 ("STPCLK# Deassertion Time") from the January
168 * 2002 PIIX4 specification update. Applies to only older
169 * PIIX4 models.
170 */
171 errata.piix4.throttle = 1;
172
173 case 2: /* PIIX4E */
174 case 3: /* PIIX4M */
175 /*
176 * See erratum #18 ("C3 Power State/BMIDE and Type-F DMA
177 * Livelock") from the January 2002 PIIX4 specification update.
178 * Applies to all PIIX4 models.
179 */
180
181 /*
182 * BM-IDE
183 * ------
184 * Find the PIIX4 IDE Controller and get the Bus Master IDE
185 * Status register address. We'll use this later to read
186 * each IDE controller's DMA status to make sure we catch all
187 * DMA activity.
188 */
189 dev = pci_get_subsys(PCI_VENDOR_ID_INTEL,
190 PCI_DEVICE_ID_INTEL_82371AB,
191 PCI_ANY_ID, PCI_ANY_ID, NULL);
192 if (dev) {
193 errata.piix4.bmisx = pci_resource_start(dev, 4);
194 pci_dev_put(dev);
195 }
196
197 /*
198 * Type-F DMA
199 * ----------
200 * Find the PIIX4 ISA Controller and read the Motherboard
201 * DMA controller's status to see if Type-F (Fast) DMA mode
202 * is enabled (bit 7) on either channel. Note that we'll
203 * disable C3 support if this is enabled, as some legacy
204 * devices won't operate well if fast DMA is disabled.
205 */
206 dev = pci_get_subsys(PCI_VENDOR_ID_INTEL,
207 PCI_DEVICE_ID_INTEL_82371AB_0,
208 PCI_ANY_ID, PCI_ANY_ID, NULL);
209 if (dev) {
210 pci_read_config_byte(dev, 0x76, &value1);
211 pci_read_config_byte(dev, 0x77, &value2);
212 if ((value1 & 0x80) || (value2 & 0x80))
213 errata.piix4.fdma = 1;
214 pci_dev_put(dev);
215 }
216
217 break;
218 }
219
220 if (errata.piix4.bmisx)
221 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
222 "Bus master activity detection (BM-IDE) erratum enabled\n"));
223 if (errata.piix4.fdma)
224 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
225 "Type-F DMA livelock erratum (C3 disabled)\n"));
226
227 return 0;
228 }
229
230 static int acpi_processor_errata(struct acpi_processor *pr)
231 {
232 int result = 0;
233 struct pci_dev *dev = NULL;
234
235
236 if (!pr)
237 return -EINVAL;
238
239 /*
240 * PIIX4
241 */
242 dev = pci_get_subsys(PCI_VENDOR_ID_INTEL,
243 PCI_DEVICE_ID_INTEL_82371AB_3, PCI_ANY_ID,
244 PCI_ANY_ID, NULL);
245 if (dev) {
246 result = acpi_processor_errata_piix4(dev);
247 pci_dev_put(dev);
248 }
249
250 return result;
251 }
252
253 /* --------------------------------------------------------------------------
254 Common ACPI processor functions
255 -------------------------------------------------------------------------- */
256
257 /*
258 * _PDC is required for a BIOS-OS handshake for most of the newer
259 * ACPI processor features.
260 */
261 static int acpi_processor_set_pdc(struct acpi_processor *pr)
262 {
263 struct acpi_object_list *pdc_in = pr->pdc;
264 acpi_status status = AE_OK;
265
266
267 if (!pdc_in)
268 return status;
269
270 status = acpi_evaluate_object(pr->handle, "_PDC", pdc_in, NULL);
271
272 if (ACPI_FAILURE(status))
273 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
274 "Could not evaluate _PDC, using legacy perf. control...\n"));
275
276 return status;
277 }
278
279 /* --------------------------------------------------------------------------
280 FS Interface (/proc)
281 -------------------------------------------------------------------------- */
282
283 static struct proc_dir_entry *acpi_processor_dir = NULL;
284
285 static int acpi_processor_info_seq_show(struct seq_file *seq, void *offset)
286 {
287 struct acpi_processor *pr = seq->private;
288
289
290 if (!pr)
291 goto end;
292
293 seq_printf(seq, "processor id: %d\n"
294 "acpi id: %d\n"
295 "bus mastering control: %s\n"
296 "power management: %s\n"
297 "throttling control: %s\n"
298 "limit interface: %s\n",
299 pr->id,
300 pr->acpi_id,
301 pr->flags.bm_control ? "yes" : "no",
302 pr->flags.power ? "yes" : "no",
303 pr->flags.throttling ? "yes" : "no",
304 pr->flags.limit ? "yes" : "no");
305
306 end:
307 return 0;
308 }
309
310 static int acpi_processor_info_open_fs(struct inode *inode, struct file *file)
311 {
312 return single_open(file, acpi_processor_info_seq_show,
313 PDE(inode)->data);
314 }
315
316 static int acpi_processor_add_fs(struct acpi_device *device)
317 {
318 struct proc_dir_entry *entry = NULL;
319
320
321 if (!acpi_device_dir(device)) {
322 acpi_device_dir(device) = proc_mkdir(acpi_device_bid(device),
323 acpi_processor_dir);
324 if (!acpi_device_dir(device))
325 return -ENODEV;
326 }
327 acpi_device_dir(device)->owner = THIS_MODULE;
328
329 /* 'info' [R] */
330 entry = proc_create_data(ACPI_PROCESSOR_FILE_INFO,
331 S_IRUGO, acpi_device_dir(device),
332 &acpi_processor_info_fops,
333 acpi_driver_data(device));
334 if (!entry)
335 return -EIO;
336
337 /* 'throttling' [R/W] */
338 entry = proc_create_data(ACPI_PROCESSOR_FILE_THROTTLING,
339 S_IFREG | S_IRUGO | S_IWUSR,
340 acpi_device_dir(device),
341 &acpi_processor_throttling_fops,
342 acpi_driver_data(device));
343 if (!entry)
344 return -EIO;
345
346 /* 'limit' [R/W] */
347 entry = proc_create_data(ACPI_PROCESSOR_FILE_LIMIT,
348 S_IFREG | S_IRUGO | S_IWUSR,
349 acpi_device_dir(device),
350 &acpi_processor_limit_fops,
351 acpi_driver_data(device));
352 if (!entry)
353 return -EIO;
354 return 0;
355 }
356
357 static int acpi_processor_remove_fs(struct acpi_device *device)
358 {
359
360 if (acpi_device_dir(device)) {
361 remove_proc_entry(ACPI_PROCESSOR_FILE_INFO,
362 acpi_device_dir(device));
363 remove_proc_entry(ACPI_PROCESSOR_FILE_THROTTLING,
364 acpi_device_dir(device));
365 remove_proc_entry(ACPI_PROCESSOR_FILE_LIMIT,
366 acpi_device_dir(device));
367 remove_proc_entry(acpi_device_bid(device), acpi_processor_dir);
368 acpi_device_dir(device) = NULL;
369 }
370
371 return 0;
372 }
373
374 /* Use the acpiid in MADT to map cpus in case of SMP */
375
376 #ifndef CONFIG_SMP
377 static int get_cpu_id(acpi_handle handle, u32 acpi_id) {return -1;}
378 #else
379
380 static struct acpi_table_madt *madt;
381
382 static int map_lapic_id(struct acpi_subtable_header *entry,
383 u32 acpi_id, int *apic_id)
384 {
385 struct acpi_madt_local_apic *lapic =
386 (struct acpi_madt_local_apic *)entry;
387 if ((lapic->lapic_flags & ACPI_MADT_ENABLED) &&
388 lapic->processor_id == acpi_id) {
389 *apic_id = lapic->id;
390 return 1;
391 }
392 return 0;
393 }
394
395 static int map_lsapic_id(struct acpi_subtable_header *entry,
396 u32 acpi_id, int *apic_id)
397 {
398 struct acpi_madt_local_sapic *lsapic =
399 (struct acpi_madt_local_sapic *)entry;
400 /* Only check enabled APICs*/
401 if (lsapic->lapic_flags & ACPI_MADT_ENABLED) {
402 /* First check against id */
403 if (lsapic->processor_id == acpi_id) {
404 *apic_id = (lsapic->id << 8) | lsapic->eid;
405 return 1;
406 /* Check against optional uid */
407 } else if (entry->length >= 16 &&
408 lsapic->uid == acpi_id) {
409 *apic_id = lsapic->uid;
410 return 1;
411 }
412 }
413 return 0;
414 }
415
416 static int map_madt_entry(u32 acpi_id)
417 {
418 unsigned long madt_end, entry;
419 int apic_id = -1;
420
421 if (!madt)
422 return apic_id;
423
424 entry = (unsigned long)madt;
425 madt_end = entry + madt->header.length;
426
427 /* Parse all entries looking for a match. */
428
429 entry += sizeof(struct acpi_table_madt);
430 while (entry + sizeof(struct acpi_subtable_header) < madt_end) {
431 struct acpi_subtable_header *header =
432 (struct acpi_subtable_header *)entry;
433 if (header->type == ACPI_MADT_TYPE_LOCAL_APIC) {
434 if (map_lapic_id(header, acpi_id, &apic_id))
435 break;
436 } else if (header->type == ACPI_MADT_TYPE_LOCAL_SAPIC) {
437 if (map_lsapic_id(header, acpi_id, &apic_id))
438 break;
439 }
440 entry += header->length;
441 }
442 return apic_id;
443 }
444
445 static int map_mat_entry(acpi_handle handle, u32 acpi_id)
446 {
447 struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
448 union acpi_object *obj;
449 struct acpi_subtable_header *header;
450 int apic_id = -1;
451
452 if (ACPI_FAILURE(acpi_evaluate_object(handle, "_MAT", NULL, &buffer)))
453 goto exit;
454
455 if (!buffer.length || !buffer.pointer)
456 goto exit;
457
458 obj = buffer.pointer;
459 if (obj->type != ACPI_TYPE_BUFFER ||
460 obj->buffer.length < sizeof(struct acpi_subtable_header)) {
461 goto exit;
462 }
463
464 header = (struct acpi_subtable_header *)obj->buffer.pointer;
465 if (header->type == ACPI_MADT_TYPE_LOCAL_APIC) {
466 map_lapic_id(header, acpi_id, &apic_id);
467 } else if (header->type == ACPI_MADT_TYPE_LOCAL_SAPIC) {
468 map_lsapic_id(header, acpi_id, &apic_id);
469 }
470
471 exit:
472 if (buffer.pointer)
473 kfree(buffer.pointer);
474 return apic_id;
475 }
476
477 static int get_cpu_id(acpi_handle handle, u32 acpi_id)
478 {
479 int i;
480 int apic_id = -1;
481
482 apic_id = map_mat_entry(handle, acpi_id);
483 if (apic_id == -1)
484 apic_id = map_madt_entry(acpi_id);
485 if (apic_id == -1)
486 return apic_id;
487
488 for_each_possible_cpu(i) {
489 if (cpu_physical_id(i) == apic_id)
490 return i;
491 }
492 return -1;
493 }
494 #endif
495
496 /* --------------------------------------------------------------------------
497 Driver Interface
498 -------------------------------------------------------------------------- */
499
500 static int acpi_processor_get_info(struct acpi_processor *pr, unsigned has_uid)
501 {
502 acpi_status status = 0;
503 union acpi_object object = { 0 };
504 struct acpi_buffer buffer = { sizeof(union acpi_object), &object };
505 int cpu_index;
506 static int cpu0_initialized;
507
508
509 if (!pr)
510 return -EINVAL;
511
512 if (num_online_cpus() > 1)
513 errata.smp = TRUE;
514
515 acpi_processor_errata(pr);
516
517 /*
518 * Check to see if we have bus mastering arbitration control. This
519 * is required for proper C3 usage (to maintain cache coherency).
520 */
521 if (acpi_gbl_FADT.pm2_control_block && acpi_gbl_FADT.pm2_control_length) {
522 pr->flags.bm_control = 1;
523 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
524 "Bus mastering arbitration control present\n"));
525 } else
526 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
527 "No bus mastering arbitration control\n"));
528
529 /* Check if it is a Device with HID and UID */
530 if (has_uid) {
531 unsigned long value;
532 status = acpi_evaluate_integer(pr->handle, METHOD_NAME__UID,
533 NULL, &value);
534 if (ACPI_FAILURE(status)) {
535 printk(KERN_ERR PREFIX "Evaluating processor _UID\n");
536 return -ENODEV;
537 }
538 pr->acpi_id = value;
539 } else {
540 /*
541 * Evalute the processor object. Note that it is common on SMP to
542 * have the first (boot) processor with a valid PBLK address while
543 * all others have a NULL address.
544 */
545 status = acpi_evaluate_object(pr->handle, NULL, NULL, &buffer);
546 if (ACPI_FAILURE(status)) {
547 printk(KERN_ERR PREFIX "Evaluating processor object\n");
548 return -ENODEV;
549 }
550
551 /*
552 * TBD: Synch processor ID (via LAPIC/LSAPIC structures) on SMP.
553 * >>> 'acpi_get_processor_id(acpi_id, &id)' in arch/xxx/acpi.c
554 */
555 pr->acpi_id = object.processor.proc_id;
556 }
557 cpu_index = get_cpu_id(pr->handle, pr->acpi_id);
558
559 /* Handle UP system running SMP kernel, with no LAPIC in MADT */
560 if (!cpu0_initialized && (cpu_index == -1) &&
561 (num_online_cpus() == 1)) {
562 cpu_index = 0;
563 }
564
565 cpu0_initialized = 1;
566
567 pr->id = cpu_index;
568
569 /*
570 * Extra Processor objects may be enumerated on MP systems with
571 * less than the max # of CPUs. They should be ignored _iff
572 * they are physically not present.
573 */
574 if (pr->id == -1) {
575 if (ACPI_FAILURE
576 (acpi_processor_hotadd_init(pr->handle, &pr->id))) {
577 return -ENODEV;
578 }
579 }
580
581 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Processor [%d:%d]\n", pr->id,
582 pr->acpi_id));
583
584 if (!object.processor.pblk_address)
585 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "No PBLK (NULL address)\n"));
586 else if (object.processor.pblk_length != 6)
587 printk(KERN_ERR PREFIX "Invalid PBLK length [%d]\n",
588 object.processor.pblk_length);
589 else {
590 pr->throttling.address = object.processor.pblk_address;
591 pr->throttling.duty_offset = acpi_gbl_FADT.duty_offset;
592 pr->throttling.duty_width = acpi_gbl_FADT.duty_width;
593
594 pr->pblk = object.processor.pblk_address;
595
596 /*
597 * We don't care about error returns - we just try to mark
598 * these reserved so that nobody else is confused into thinking
599 * that this region might be unused..
600 *
601 * (In particular, allocating the IO range for Cardbus)
602 */
603 request_region(pr->throttling.address, 6, "ACPI CPU throttle");
604 }
605
606 /*
607 * If ACPI describes a slot number for this CPU, we can use it
608 * ensure we get the right value in the "physical id" field
609 * of /proc/cpuinfo
610 */
611 status = acpi_evaluate_object(pr->handle, "_SUN", NULL, &buffer);
612 if (ACPI_SUCCESS(status))
613 arch_fix_phys_package_id(pr->id, object.integer.value);
614
615 return 0;
616 }
617
618 static void *processor_device_array[NR_CPUS];
619
620 static int __cpuinit acpi_processor_start(struct acpi_device *device)
621 {
622 int result = 0;
623 acpi_status status = AE_OK;
624 struct acpi_processor *pr;
625
626
627 pr = acpi_driver_data(device);
628
629 result = acpi_processor_get_info(pr, device->flags.unique_id);
630 if (result) {
631 /* Processor is physically not present */
632 return 0;
633 }
634
635 BUG_ON((pr->id >= nr_cpu_ids) || (pr->id < 0));
636
637 /*
638 * Buggy BIOS check
639 * ACPI id of processors can be reported wrongly by the BIOS.
640 * Don't trust it blindly
641 */
642 if (processor_device_array[pr->id] != NULL &&
643 processor_device_array[pr->id] != device) {
644 printk(KERN_WARNING "BIOS reported wrong ACPI id "
645 "for the processor\n");
646 return -ENODEV;
647 }
648 processor_device_array[pr->id] = device;
649
650 processors[pr->id] = pr;
651
652 result = acpi_processor_add_fs(device);
653 if (result)
654 goto end;
655
656 status = acpi_install_notify_handler(pr->handle, ACPI_DEVICE_NOTIFY,
657 acpi_processor_notify, pr);
658
659 /* _PDC call should be done before doing anything else (if reqd.). */
660 arch_acpi_processor_init_pdc(pr);
661 acpi_processor_set_pdc(pr);
662 #ifdef CONFIG_CPU_FREQ
663 acpi_processor_ppc_has_changed(pr);
664 #endif
665 acpi_processor_get_throttling_info(pr);
666 acpi_processor_get_limit_info(pr);
667
668
669 acpi_processor_power_init(pr, device);
670
671 pr->cdev = thermal_cooling_device_register("Processor", device,
672 &processor_cooling_ops);
673 if (IS_ERR(pr->cdev)) {
674 result = PTR_ERR(pr->cdev);
675 goto end;
676 }
677
678 printk(KERN_INFO PREFIX
679 "%s is registered as cooling_device%d\n",
680 device->dev.bus_id, pr->cdev->id);
681
682 result = sysfs_create_link(&device->dev.kobj,
683 &pr->cdev->device.kobj,
684 "thermal_cooling");
685 if (result)
686 printk(KERN_ERR PREFIX "Create sysfs link\n");
687 result = sysfs_create_link(&pr->cdev->device.kobj,
688 &device->dev.kobj,
689 "device");
690 if (result)
691 printk(KERN_ERR PREFIX "Create sysfs link\n");
692
693 if (pr->flags.throttling) {
694 printk(KERN_INFO PREFIX "%s [%s] (supports",
695 acpi_device_name(device), acpi_device_bid(device));
696 printk(" %d throttling states", pr->throttling.state_count);
697 printk(")\n");
698 }
699
700 end:
701
702 return result;
703 }
704
705 static void acpi_processor_notify(acpi_handle handle, u32 event, void *data)
706 {
707 struct acpi_processor *pr = data;
708 struct acpi_device *device = NULL;
709 int saved;
710
711 if (!pr)
712 return;
713
714 if (acpi_bus_get_device(pr->handle, &device))
715 return;
716
717 switch (event) {
718 case ACPI_PROCESSOR_NOTIFY_PERFORMANCE:
719 saved = pr->performance_platform_limit;
720 acpi_processor_ppc_has_changed(pr);
721 if (saved == pr->performance_platform_limit)
722 break;
723 acpi_bus_generate_proc_event(device, event,
724 pr->performance_platform_limit);
725 acpi_bus_generate_netlink_event(device->pnp.device_class,
726 device->dev.bus_id, event,
727 pr->performance_platform_limit);
728 break;
729 case ACPI_PROCESSOR_NOTIFY_POWER:
730 acpi_processor_cst_has_changed(pr);
731 acpi_bus_generate_proc_event(device, event, 0);
732 acpi_bus_generate_netlink_event(device->pnp.device_class,
733 device->dev.bus_id, event, 0);
734 break;
735 case ACPI_PROCESSOR_NOTIFY_THROTTLING:
736 acpi_processor_tstate_has_changed(pr);
737 acpi_bus_generate_proc_event(device, event, 0);
738 acpi_bus_generate_netlink_event(device->pnp.device_class,
739 device->dev.bus_id, event, 0);
740 default:
741 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
742 "Unsupported event [0x%x]\n", event));
743 break;
744 }
745
746 return;
747 }
748
749 static int acpi_cpu_soft_notify(struct notifier_block *nfb,
750 unsigned long action, void *hcpu)
751 {
752 unsigned int cpu = (unsigned long)hcpu;
753 struct acpi_processor *pr = processors[cpu];
754
755 if (action == CPU_ONLINE && pr) {
756 acpi_processor_ppc_has_changed(pr);
757 acpi_processor_cst_has_changed(pr);
758 acpi_processor_tstate_has_changed(pr);
759 }
760 return NOTIFY_OK;
761 }
762
763 static struct notifier_block acpi_cpu_notifier =
764 {
765 .notifier_call = acpi_cpu_soft_notify,
766 };
767
768 static int acpi_processor_add(struct acpi_device *device)
769 {
770 struct acpi_processor *pr = NULL;
771
772
773 if (!device)
774 return -EINVAL;
775
776 pr = kzalloc(sizeof(struct acpi_processor), GFP_KERNEL);
777 if (!pr)
778 return -ENOMEM;
779
780 pr->handle = device->handle;
781 strcpy(acpi_device_name(device), ACPI_PROCESSOR_DEVICE_NAME);
782 strcpy(acpi_device_class(device), ACPI_PROCESSOR_CLASS);
783 acpi_driver_data(device) = pr;
784
785 return 0;
786 }
787
788 static int acpi_processor_remove(struct acpi_device *device, int type)
789 {
790 acpi_status status = AE_OK;
791 struct acpi_processor *pr = NULL;
792
793
794 if (!device || !acpi_driver_data(device))
795 return -EINVAL;
796
797 pr = acpi_driver_data(device);
798
799 if (pr->id >= nr_cpu_ids) {
800 kfree(pr);
801 return 0;
802 }
803
804 if (type == ACPI_BUS_REMOVAL_EJECT) {
805 if (acpi_processor_handle_eject(pr))
806 return -EINVAL;
807 }
808
809 acpi_processor_power_exit(pr, device);
810
811 status = acpi_remove_notify_handler(pr->handle, ACPI_DEVICE_NOTIFY,
812 acpi_processor_notify);
813
814 acpi_processor_remove_fs(device);
815
816 if (pr->cdev) {
817 sysfs_remove_link(&device->dev.kobj, "thermal_cooling");
818 sysfs_remove_link(&pr->cdev->device.kobj, "device");
819 thermal_cooling_device_unregister(pr->cdev);
820 pr->cdev = NULL;
821 }
822
823 processors[pr->id] = NULL;
824 processor_device_array[pr->id] = NULL;
825 kfree(pr);
826
827 return 0;
828 }
829
830 #ifdef CONFIG_ACPI_HOTPLUG_CPU
831 /****************************************************************************
832 * Acpi processor hotplug support *
833 ****************************************************************************/
834
835 static int is_processor_present(acpi_handle handle)
836 {
837 acpi_status status;
838 unsigned long sta = 0;
839
840
841 status = acpi_evaluate_integer(handle, "_STA", NULL, &sta);
842
843 if (ACPI_SUCCESS(status) && (sta & ACPI_STA_DEVICE_PRESENT))
844 return 1;
845
846 /*
847 * _STA is mandatory for a processor that supports hot plug
848 */
849 if (status == AE_NOT_FOUND)
850 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
851 "Processor does not support hot plug\n"));
852 else
853 ACPI_EXCEPTION((AE_INFO, status,
854 "Processor Device is not present"));
855 return 0;
856 }
857
858 static
859 int acpi_processor_device_add(acpi_handle handle, struct acpi_device **device)
860 {
861 acpi_handle phandle;
862 struct acpi_device *pdev;
863 struct acpi_processor *pr;
864
865
866 if (acpi_get_parent(handle, &phandle)) {
867 return -ENODEV;
868 }
869
870 if (acpi_bus_get_device(phandle, &pdev)) {
871 return -ENODEV;
872 }
873
874 if (acpi_bus_add(device, pdev, handle, ACPI_BUS_TYPE_PROCESSOR)) {
875 return -ENODEV;
876 }
877
878 acpi_bus_start(*device);
879
880 pr = acpi_driver_data(*device);
881 if (!pr)
882 return -ENODEV;
883
884 if ((pr->id >= 0) && (pr->id < nr_cpu_ids)) {
885 kobject_uevent(&(*device)->dev.kobj, KOBJ_ONLINE);
886 }
887 return 0;
888 }
889
890 static void __ref acpi_processor_hotplug_notify(acpi_handle handle,
891 u32 event, void *data)
892 {
893 struct acpi_processor *pr;
894 struct acpi_device *device = NULL;
895 int result;
896
897
898 switch (event) {
899 case ACPI_NOTIFY_BUS_CHECK:
900 case ACPI_NOTIFY_DEVICE_CHECK:
901 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
902 "Processor driver received %s event\n",
903 (event == ACPI_NOTIFY_BUS_CHECK) ?
904 "ACPI_NOTIFY_BUS_CHECK" : "ACPI_NOTIFY_DEVICE_CHECK"));
905
906 if (!is_processor_present(handle))
907 break;
908
909 if (acpi_bus_get_device(handle, &device)) {
910 result = acpi_processor_device_add(handle, &device);
911 if (result)
912 printk(KERN_ERR PREFIX
913 "Unable to add the device\n");
914 break;
915 }
916
917 pr = acpi_driver_data(device);
918 if (!pr) {
919 printk(KERN_ERR PREFIX "Driver data is NULL\n");
920 break;
921 }
922
923 if (pr->id >= 0 && (pr->id < nr_cpu_ids)) {
924 kobject_uevent(&device->dev.kobj, KOBJ_OFFLINE);
925 break;
926 }
927
928 result = acpi_processor_start(device);
929 if ((!result) && ((pr->id >= 0) && (pr->id < nr_cpu_ids))) {
930 kobject_uevent(&device->dev.kobj, KOBJ_ONLINE);
931 } else {
932 printk(KERN_ERR PREFIX "Device [%s] failed to start\n",
933 acpi_device_bid(device));
934 }
935 break;
936 case ACPI_NOTIFY_EJECT_REQUEST:
937 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
938 "received ACPI_NOTIFY_EJECT_REQUEST\n"));
939
940 if (acpi_bus_get_device(handle, &device)) {
941 printk(KERN_ERR PREFIX
942 "Device don't exist, dropping EJECT\n");
943 break;
944 }
945 pr = acpi_driver_data(device);
946 if (!pr) {
947 printk(KERN_ERR PREFIX
948 "Driver data is NULL, dropping EJECT\n");
949 return;
950 }
951
952 if ((pr->id < nr_cpu_ids) && (cpu_present(pr->id)))
953 kobject_uevent(&device->dev.kobj, KOBJ_OFFLINE);
954 break;
955 default:
956 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
957 "Unsupported event [0x%x]\n", event));
958 break;
959 }
960
961 return;
962 }
963
964 static acpi_status
965 processor_walk_namespace_cb(acpi_handle handle,
966 u32 lvl, void *context, void **rv)
967 {
968 acpi_status status;
969 int *action = context;
970 acpi_object_type type = 0;
971
972 status = acpi_get_type(handle, &type);
973 if (ACPI_FAILURE(status))
974 return (AE_OK);
975
976 if (type != ACPI_TYPE_PROCESSOR)
977 return (AE_OK);
978
979 switch (*action) {
980 case INSTALL_NOTIFY_HANDLER:
981 acpi_install_notify_handler(handle,
982 ACPI_SYSTEM_NOTIFY,
983 acpi_processor_hotplug_notify,
984 NULL);
985 break;
986 case UNINSTALL_NOTIFY_HANDLER:
987 acpi_remove_notify_handler(handle,
988 ACPI_SYSTEM_NOTIFY,
989 acpi_processor_hotplug_notify);
990 break;
991 default:
992 break;
993 }
994
995 return (AE_OK);
996 }
997
998 static acpi_status acpi_processor_hotadd_init(acpi_handle handle, int *p_cpu)
999 {
1000
1001 if (!is_processor_present(handle)) {
1002 return AE_ERROR;
1003 }
1004
1005 if (acpi_map_lsapic(handle, p_cpu))
1006 return AE_ERROR;
1007
1008 if (arch_register_cpu(*p_cpu)) {
1009 acpi_unmap_lsapic(*p_cpu);
1010 return AE_ERROR;
1011 }
1012
1013 return AE_OK;
1014 }
1015
1016 static int acpi_processor_handle_eject(struct acpi_processor *pr)
1017 {
1018 if (cpu_online(pr->id)) {
1019 return (-EINVAL);
1020 }
1021 arch_unregister_cpu(pr->id);
1022 acpi_unmap_lsapic(pr->id);
1023 return (0);
1024 }
1025 #else
1026 static acpi_status acpi_processor_hotadd_init(acpi_handle handle, int *p_cpu)
1027 {
1028 return AE_ERROR;
1029 }
1030 static int acpi_processor_handle_eject(struct acpi_processor *pr)
1031 {
1032 return (-EINVAL);
1033 }
1034 #endif
1035
1036 static
1037 void acpi_processor_install_hotplug_notify(void)
1038 {
1039 #ifdef CONFIG_ACPI_HOTPLUG_CPU
1040 int action = INSTALL_NOTIFY_HANDLER;
1041 acpi_walk_namespace(ACPI_TYPE_PROCESSOR,
1042 ACPI_ROOT_OBJECT,
1043 ACPI_UINT32_MAX,
1044 processor_walk_namespace_cb, &action, NULL);
1045 #endif
1046 register_hotcpu_notifier(&acpi_cpu_notifier);
1047 }
1048
1049 static
1050 void acpi_processor_uninstall_hotplug_notify(void)
1051 {
1052 #ifdef CONFIG_ACPI_HOTPLUG_CPU
1053 int action = UNINSTALL_NOTIFY_HANDLER;
1054 acpi_walk_namespace(ACPI_TYPE_PROCESSOR,
1055 ACPI_ROOT_OBJECT,
1056 ACPI_UINT32_MAX,
1057 processor_walk_namespace_cb, &action, NULL);
1058 #endif
1059 unregister_hotcpu_notifier(&acpi_cpu_notifier);
1060 }
1061
1062 /*
1063 * We keep the driver loaded even when ACPI is not running.
1064 * This is needed for the powernow-k8 driver, that works even without
1065 * ACPI, but needs symbols from this driver
1066 */
1067
1068 static int __init acpi_processor_init(void)
1069 {
1070 int result = 0;
1071
1072
1073 memset(&processors, 0, sizeof(processors));
1074 memset(&errata, 0, sizeof(errata));
1075
1076 #ifdef CONFIG_SMP
1077 if (ACPI_FAILURE(acpi_get_table(ACPI_SIG_MADT, 0,
1078 (struct acpi_table_header **)&madt)))
1079 madt = NULL;
1080 #endif
1081
1082 acpi_processor_dir = proc_mkdir(ACPI_PROCESSOR_CLASS, acpi_root_dir);
1083 if (!acpi_processor_dir)
1084 return -ENOMEM;
1085 acpi_processor_dir->owner = THIS_MODULE;
1086
1087 result = cpuidle_register_driver(&acpi_idle_driver);
1088 if (result < 0)
1089 goto out_proc;
1090
1091 result = acpi_bus_register_driver(&acpi_processor_driver);
1092 if (result < 0)
1093 goto out_cpuidle;
1094
1095 acpi_processor_install_hotplug_notify();
1096
1097 acpi_thermal_cpufreq_init();
1098
1099 acpi_processor_ppc_init();
1100
1101 acpi_processor_throttling_init();
1102
1103 return 0;
1104
1105 out_cpuidle:
1106 cpuidle_unregister_driver(&acpi_idle_driver);
1107
1108 out_proc:
1109 remove_proc_entry(ACPI_PROCESSOR_CLASS, acpi_root_dir);
1110
1111 return result;
1112 }
1113
1114 static void __exit acpi_processor_exit(void)
1115 {
1116 acpi_processor_ppc_exit();
1117
1118 acpi_thermal_cpufreq_exit();
1119
1120 acpi_processor_uninstall_hotplug_notify();
1121
1122 acpi_bus_unregister_driver(&acpi_processor_driver);
1123
1124 cpuidle_unregister_driver(&acpi_idle_driver);
1125
1126 remove_proc_entry(ACPI_PROCESSOR_CLASS, acpi_root_dir);
1127
1128 return;
1129 }
1130
1131 module_init(acpi_processor_init);
1132 module_exit(acpi_processor_exit);
1133
1134 EXPORT_SYMBOL(acpi_processor_set_thermal_limit);
1135
1136 MODULE_ALIAS("processor");
Community contributions to the Openmoko Kernel