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