processor_driver.c 23.1 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42
/*
 * acpi_processor.c - ACPI Processor Driver ($Revision: 71 $)
 *
 *  Copyright (C) 2001, 2002 Andy Grover <andrew.grover@intel.com>
 *  Copyright (C) 2001, 2002 Paul Diefenbaugh <paul.s.diefenbaugh@intel.com>
 *  Copyright (C) 2004       Dominik Brodowski <linux@brodo.de>
 *  Copyright (C) 2004  Anil S Keshavamurthy <anil.s.keshavamurthy@intel.com>
 *  			- Added processor hotplug support
 *
 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or (at
 *  your option) any later version.
 *
 *  This program is distributed in the hope that it will be useful, but
 *  WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 *  General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License along
 *  with this program; if not, write to the Free Software Foundation, Inc.,
 *  59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
 *
 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 *  TBD:
 *	1. Make # power states dynamic.
 *	2. Support duty_cycle values that span bit 4.
 *	3. Optimize by having scheduler determine business instead of
 *	   having us try to calculate it here.
 *	4. Need C1 timing -- must modify kernel (IRQ handler) to get this.
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/types.h>
#include <linux/pci.h>
#include <linux/pm.h>
#include <linux/cpufreq.h>
#include <linux/cpu.h>
43
#ifdef CONFIG_ACPI_PROCFS
L
Linus Torvalds 已提交
44 45
#include <linux/proc_fs.h>
#include <linux/seq_file.h>
46
#endif
L
Linus Torvalds 已提交
47 48
#include <linux/dmi.h>
#include <linux/moduleparam.h>
49
#include <linux/cpuidle.h>
50
#include <linux/slab.h>
L
Linus Torvalds 已提交
51 52 53 54 55 56 57 58 59 60 61 62 63 64

#include <asm/io.h>
#include <asm/system.h>
#include <asm/cpu.h>
#include <asm/delay.h>
#include <asm/uaccess.h>
#include <asm/processor.h>
#include <asm/smp.h>
#include <asm/acpi.h>

#include <acpi/acpi_bus.h>
#include <acpi/acpi_drivers.h>
#include <acpi/processor.h>

65 66
#define PREFIX "ACPI: "

L
Linus Torvalds 已提交
67 68 69 70 71 72 73
#define ACPI_PROCESSOR_CLASS		"processor"
#define ACPI_PROCESSOR_DEVICE_NAME	"Processor"
#define ACPI_PROCESSOR_FILE_INFO	"info"
#define ACPI_PROCESSOR_FILE_THROTTLING	"throttling"
#define ACPI_PROCESSOR_FILE_LIMIT	"limit"
#define ACPI_PROCESSOR_NOTIFY_PERFORMANCE 0x80
#define ACPI_PROCESSOR_NOTIFY_POWER	0x81
74
#define ACPI_PROCESSOR_NOTIFY_THROTTLING	0x82
L
Linus Torvalds 已提交
75 76 77 78 79

#define ACPI_PROCESSOR_LIMIT_USER	0
#define ACPI_PROCESSOR_LIMIT_THERMAL	1

#define _COMPONENT		ACPI_PROCESSOR_COMPONENT
80
ACPI_MODULE_NAME("processor_driver");
L
Linus Torvalds 已提交
81

82
MODULE_AUTHOR("Paul Diefenbaugh");
83
MODULE_DESCRIPTION("ACPI Processor Driver");
L
Linus Torvalds 已提交
84 85
MODULE_LICENSE("GPL");

L
Len Brown 已提交
86 87
static int acpi_processor_add(struct acpi_device *device);
static int acpi_processor_remove(struct acpi_device *device, int type);
88
static void acpi_processor_notify(struct acpi_device *device, u32 event);
L
Linus Torvalds 已提交
89 90
static acpi_status acpi_processor_hotadd_init(acpi_handle handle, int *p_cpu);
static int acpi_processor_handle_eject(struct acpi_processor *pr);
91

L
Linus Torvalds 已提交
92

93
static const struct acpi_device_id processor_device_ids[] = {
94
	{ACPI_PROCESSOR_OBJECT_HID, 0},
95
	{"ACPI0007", 0},
96 97 98 99
	{"", 0},
};
MODULE_DEVICE_TABLE(acpi, processor_device_ids);

L
Linus Torvalds 已提交
100
static struct acpi_driver acpi_processor_driver = {
L
Len Brown 已提交
101
	.name = "processor",
L
Len Brown 已提交
102
	.class = ACPI_PROCESSOR_CLASS,
103
	.ids = processor_device_ids,
L
Len Brown 已提交
104 105 106
	.ops = {
		.add = acpi_processor_add,
		.remove = acpi_processor_remove,
107 108
		.suspend = acpi_processor_suspend,
		.resume = acpi_processor_resume,
109
		.notify = acpi_processor_notify,
L
Len Brown 已提交
110
		},
L
Linus Torvalds 已提交
111 112 113 114 115
};

#define INSTALL_NOTIFY_HANDLER		1
#define UNINSTALL_NOTIFY_HANDLER	2

116
DEFINE_PER_CPU(struct acpi_processor *, processors);
117 118
EXPORT_PER_CPU_SYMBOL(processors);

119
struct acpi_processor_errata errata __read_mostly;
L
Linus Torvalds 已提交
120 121 122 123 124

/* --------------------------------------------------------------------------
                                Errata Handling
   -------------------------------------------------------------------------- */

L
Len Brown 已提交
125
static int acpi_processor_errata_piix4(struct pci_dev *dev)
L
Linus Torvalds 已提交
126
{
L
Len Brown 已提交
127 128
	u8 value1 = 0;
	u8 value2 = 0;
L
Linus Torvalds 已提交
129 130 131


	if (!dev)
132
		return -EINVAL;
L
Linus Torvalds 已提交
133 134 135 136 137

	/*
	 * Note that 'dev' references the PIIX4 ACPI Controller.
	 */

138
	switch (dev->revision) {
L
Linus Torvalds 已提交
139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155
	case 0:
		ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found PIIX4 A-step\n"));
		break;
	case 1:
		ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found PIIX4 B-step\n"));
		break;
	case 2:
		ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found PIIX4E\n"));
		break;
	case 3:
		ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found PIIX4M\n"));
		break;
	default:
		ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found unknown PIIX4\n"));
		break;
	}

156
	switch (dev->revision) {
L
Linus Torvalds 已提交
157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185

	case 0:		/* PIIX4 A-step */
	case 1:		/* PIIX4 B-step */
		/*
		 * See specification changes #13 ("Manual Throttle Duty Cycle")
		 * and #14 ("Enabling and Disabling Manual Throttle"), plus
		 * erratum #5 ("STPCLK# Deassertion Time") from the January
		 * 2002 PIIX4 specification update.  Applies to only older
		 * PIIX4 models.
		 */
		errata.piix4.throttle = 1;

	case 2:		/* PIIX4E */
	case 3:		/* PIIX4M */
		/*
		 * See erratum #18 ("C3 Power State/BMIDE and Type-F DMA
		 * Livelock") from the January 2002 PIIX4 specification update.
		 * Applies to all PIIX4 models.
		 */

		/*
		 * BM-IDE
		 * ------
		 * Find the PIIX4 IDE Controller and get the Bus Master IDE
		 * Status register address.  We'll use this later to read
		 * each IDE controller's DMA status to make sure we catch all
		 * DMA activity.
		 */
		dev = pci_get_subsys(PCI_VENDOR_ID_INTEL,
L
Len Brown 已提交
186 187
				     PCI_DEVICE_ID_INTEL_82371AB,
				     PCI_ANY_ID, PCI_ANY_ID, NULL);
L
Linus Torvalds 已提交
188 189 190 191 192 193 194 195 196 197 198 199 200 201 202
		if (dev) {
			errata.piix4.bmisx = pci_resource_start(dev, 4);
			pci_dev_put(dev);
		}

		/*
		 * Type-F DMA
		 * ----------
		 * Find the PIIX4 ISA Controller and read the Motherboard
		 * DMA controller's status to see if Type-F (Fast) DMA mode
		 * is enabled (bit 7) on either channel.  Note that we'll
		 * disable C3 support if this is enabled, as some legacy
		 * devices won't operate well if fast DMA is disabled.
		 */
		dev = pci_get_subsys(PCI_VENDOR_ID_INTEL,
L
Len Brown 已提交
203 204
				     PCI_DEVICE_ID_INTEL_82371AB_0,
				     PCI_ANY_ID, PCI_ANY_ID, NULL);
L
Linus Torvalds 已提交
205 206 207 208 209 210 211 212 213 214 215 216 217
		if (dev) {
			pci_read_config_byte(dev, 0x76, &value1);
			pci_read_config_byte(dev, 0x77, &value2);
			if ((value1 & 0x80) || (value2 & 0x80))
				errata.piix4.fdma = 1;
			pci_dev_put(dev);
		}

		break;
	}

	if (errata.piix4.bmisx)
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
L
Len Brown 已提交
218
				  "Bus master activity detection (BM-IDE) erratum enabled\n"));
L
Linus Torvalds 已提交
219 220
	if (errata.piix4.fdma)
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
L
Len Brown 已提交
221
				  "Type-F DMA livelock erratum (C3 disabled)\n"));
L
Linus Torvalds 已提交
222

223
	return 0;
L
Linus Torvalds 已提交
224 225
}

226
static int acpi_processor_errata(struct acpi_processor *pr)
L
Linus Torvalds 已提交
227
{
L
Len Brown 已提交
228 229
	int result = 0;
	struct pci_dev *dev = NULL;
L
Linus Torvalds 已提交
230 231 232


	if (!pr)
233
		return -EINVAL;
L
Linus Torvalds 已提交
234 235 236 237 238

	/*
	 * PIIX4
	 */
	dev = pci_get_subsys(PCI_VENDOR_ID_INTEL,
L
Len Brown 已提交
239 240
			     PCI_DEVICE_ID_INTEL_82371AB_3, PCI_ANY_ID,
			     PCI_ANY_ID, NULL);
L
Linus Torvalds 已提交
241 242 243 244 245
	if (dev) {
		result = acpi_processor_errata_piix4(dev);
		pci_dev_put(dev);
	}

246
	return result;
L
Linus Torvalds 已提交
247 248
}

249
#ifdef CONFIG_ACPI_PROCFS
L
Len Brown 已提交
250
static struct proc_dir_entry *acpi_processor_dir = NULL;
L
Linus Torvalds 已提交
251

252
static int __cpuinit acpi_processor_add_fs(struct acpi_device *device)
L
Linus Torvalds 已提交
253
{
L
Len Brown 已提交
254
	struct proc_dir_entry *entry = NULL;
L
Linus Torvalds 已提交
255 256 257 258


	if (!acpi_device_dir(device)) {
		acpi_device_dir(device) = proc_mkdir(acpi_device_bid(device),
L
Len Brown 已提交
259
						     acpi_processor_dir);
L
Linus Torvalds 已提交
260
		if (!acpi_device_dir(device))
261
			return -ENODEV;
L
Linus Torvalds 已提交
262 263 264
	}

	/* 'throttling' [R/W] */
265 266 267 268 269
	entry = proc_create_data(ACPI_PROCESSOR_FILE_THROTTLING,
				 S_IFREG | S_IRUGO | S_IWUSR,
				 acpi_device_dir(device),
				 &acpi_processor_throttling_fops,
				 acpi_driver_data(device));
L
Linus Torvalds 已提交
270
	if (!entry)
271 272
		return -EIO;
	return 0;
L
Linus Torvalds 已提交
273
}
L
Len Brown 已提交
274
static int acpi_processor_remove_fs(struct acpi_device *device)
L
Linus Torvalds 已提交
275 276 277 278
{

	if (acpi_device_dir(device)) {
		remove_proc_entry(ACPI_PROCESSOR_FILE_THROTTLING,
L
Len Brown 已提交
279
				  acpi_device_dir(device));
L
Linus Torvalds 已提交
280 281 282 283
		remove_proc_entry(acpi_device_bid(device), acpi_processor_dir);
		acpi_device_dir(device) = NULL;
	}

284
	return 0;
L
Linus Torvalds 已提交
285
}
286 287 288 289 290 291 292 293 294 295
#else
static inline int acpi_processor_add_fs(struct acpi_device *device)
{
	return 0;
}
static inline int acpi_processor_remove_fs(struct acpi_device *device)
{
	return 0;
}
#endif
L
Linus Torvalds 已提交
296 297 298 299
/* --------------------------------------------------------------------------
                                 Driver Interface
   -------------------------------------------------------------------------- */

300
static int acpi_processor_get_info(struct acpi_device *device)
L
Linus Torvalds 已提交
301
{
L
Len Brown 已提交
302 303 304
	acpi_status status = 0;
	union acpi_object object = { 0 };
	struct acpi_buffer buffer = { sizeof(union acpi_object), &object };
305 306
	struct acpi_processor *pr;
	int cpu_index, device_declaration = 0;
L
Len Brown 已提交
307
	static int cpu0_initialized;
L
Linus Torvalds 已提交
308

309
	pr = acpi_driver_data(device);
L
Linus Torvalds 已提交
310
	if (!pr)
311
		return -EINVAL;
L
Linus Torvalds 已提交
312 313 314 315 316 317 318 319 320 321

	if (num_online_cpus() > 1)
		errata.smp = TRUE;

	acpi_processor_errata(pr);

	/*
	 * Check to see if we have bus mastering arbitration control.  This
	 * is required for proper C3 usage (to maintain cache coherency).
	 */
322
	if (acpi_gbl_FADT.pm2_control_block && acpi_gbl_FADT.pm2_control_length) {
L
Linus Torvalds 已提交
323 324
		pr->flags.bm_control = 1;
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
L
Len Brown 已提交
325 326
				  "Bus mastering arbitration control present\n"));
	} else
L
Linus Torvalds 已提交
327
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
L
Len Brown 已提交
328
				  "No bus mastering arbitration control\n"));
L
Linus Torvalds 已提交
329

330 331 332 333 334 335 336 337 338 339 340 341 342 343 344
	if (!strcmp(acpi_device_hid(device), ACPI_PROCESSOR_OBJECT_HID)) {
		/* Declared with "Processor" statement; match ProcessorID */
		status = acpi_evaluate_object(pr->handle, NULL, NULL, &buffer);
		if (ACPI_FAILURE(status)) {
			printk(KERN_ERR PREFIX "Evaluating processor object\n");
			return -ENODEV;
		}

		/*
		 * TBD: Synch processor ID (via LAPIC/LSAPIC structures) on SMP.
		 *      >>> 'acpi_get_processor_id(acpi_id, &id)' in
		 *      arch/xxx/acpi.c
		 */
		pr->acpi_id = object.processor.proc_id;
	} else {
345 346 347 348
		/*
		 * Declared with "Device" statement; match _UID.
		 * Note that we don't handle string _UIDs yet.
		 */
349
		unsigned long long value;
350 351 352
		status = acpi_evaluate_integer(pr->handle, METHOD_NAME__UID,
						NULL, &value);
		if (ACPI_FAILURE(status)) {
353 354
			printk(KERN_ERR PREFIX
			    "Evaluating processor _UID [%#x]\n", status);
355 356
			return -ENODEV;
		}
357
		device_declaration = 1;
358 359
		pr->acpi_id = value;
	}
360
	cpu_index = acpi_get_cpuid(pr->handle, device_declaration, pr->acpi_id);
L
Linus Torvalds 已提交
361

L
Len Brown 已提交
362
	/* Handle UP system running SMP kernel, with no LAPIC in MADT */
A
Ashok Raj 已提交
363
	if (!cpu0_initialized && (cpu_index == -1) &&
L
Len Brown 已提交
364 365 366 367 368 369 370 371 372 373 374 375 376
	    (num_online_cpus() == 1)) {
		cpu_index = 0;
	}

	cpu0_initialized = 1;

	pr->id = cpu_index;

	/*
	 *  Extra Processor objects may be enumerated on MP systems with
	 *  less than the max # of CPUs. They should be ignored _iff
	 *  they are physically not present.
	 */
377
	if (pr->id == -1) {
L
Len Brown 已提交
378 379
		if (ACPI_FAILURE
		    (acpi_processor_hotadd_init(pr->handle, &pr->id))) {
380
			return -ENODEV;
L
Len Brown 已提交
381 382
		}
	}
383 384 385 386 387 388 389 390 391 392
	/*
	 * On some boxes several processors use the same processor bus id.
	 * But they are located in different scope. For example:
	 * \_SB.SCK0.CPU0
	 * \_SB.SCK1.CPU0
	 * Rename the processor device bus id. And the new bus id will be
	 * generated as the following format:
	 * CPU+CPU ID.
	 */
	sprintf(acpi_device_bid(device), "CPU%X", pr->id);
L
Linus Torvalds 已提交
393
	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Processor [%d:%d]\n", pr->id,
L
Len Brown 已提交
394
			  pr->acpi_id));
L
Linus Torvalds 已提交
395 396 397 398

	if (!object.processor.pblk_address)
		ACPI_DEBUG_PRINT((ACPI_DB_INFO, "No PBLK (NULL address)\n"));
	else if (object.processor.pblk_length != 6)
399 400
		printk(KERN_ERR PREFIX "Invalid PBLK length [%d]\n",
			    object.processor.pblk_length);
L
Linus Torvalds 已提交
401 402
	else {
		pr->throttling.address = object.processor.pblk_address;
403 404
		pr->throttling.duty_offset = acpi_gbl_FADT.duty_offset;
		pr->throttling.duty_width = acpi_gbl_FADT.duty_width;
L
Linus Torvalds 已提交
405 406 407 408 409 410 411 412 413 414 415 416 417

		pr->pblk = object.processor.pblk_address;

		/*
		 * We don't care about error returns - we just try to mark
		 * these reserved so that nobody else is confused into thinking
		 * that this region might be unused..
		 *
		 * (In particular, allocating the IO range for Cardbus)
		 */
		request_region(pr->throttling.address, 6, "ACPI CPU throttle");
	}

418 419 420 421 422 423 424 425 426
	/*
	 * If ACPI describes a slot number for this CPU, we can use it
	 * ensure we get the right value in the "physical id" field
	 * of /proc/cpuinfo
	 */
	status = acpi_evaluate_object(pr->handle, "_SUN", NULL, &buffer);
	if (ACPI_SUCCESS(status))
		arch_fix_phys_package_id(pr->id, object.integer.value);

427
	return 0;
L
Linus Torvalds 已提交
428 429
}

430
static DEFINE_PER_CPU(void *, processor_device_array);
431

432
static void acpi_processor_notify(struct acpi_device *device, u32 event)
L
Linus Torvalds 已提交
433
{
434
	struct acpi_processor *pr = acpi_driver_data(device);
435
	int saved;
L
Linus Torvalds 已提交
436 437

	if (!pr)
438
		return;
L
Linus Torvalds 已提交
439 440 441

	switch (event) {
	case ACPI_PROCESSOR_NOTIFY_PERFORMANCE:
442
		saved = pr->performance_platform_limit;
443
		acpi_processor_ppc_has_changed(pr, 1);
444 445
		if (saved == pr->performance_platform_limit)
			break;
446
		acpi_bus_generate_proc_event(device, event,
L
Len Brown 已提交
447
					pr->performance_platform_limit);
448
		acpi_bus_generate_netlink_event(device->pnp.device_class,
449
						  dev_name(&device->dev), event,
450
						  pr->performance_platform_limit);
L
Linus Torvalds 已提交
451 452 453
		break;
	case ACPI_PROCESSOR_NOTIFY_POWER:
		acpi_processor_cst_has_changed(pr);
454
		acpi_bus_generate_proc_event(device, event, 0);
455
		acpi_bus_generate_netlink_event(device->pnp.device_class,
456
						  dev_name(&device->dev), event, 0);
L
Linus Torvalds 已提交
457
		break;
458 459
	case ACPI_PROCESSOR_NOTIFY_THROTTLING:
		acpi_processor_tstate_has_changed(pr);
460
		acpi_bus_generate_proc_event(device, event, 0);
461
		acpi_bus_generate_netlink_event(device->pnp.device_class,
462
						  dev_name(&device->dev), event, 0);
L
Linus Torvalds 已提交
463 464
	default:
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
L
Len Brown 已提交
465
				  "Unsupported event [0x%x]\n", event));
L
Linus Torvalds 已提交
466 467 468
		break;
	}

469
	return;
L
Linus Torvalds 已提交
470 471
}

472 473 474 475
static int acpi_cpu_soft_notify(struct notifier_block *nfb,
		unsigned long action, void *hcpu)
{
	unsigned int cpu = (unsigned long)hcpu;
476
	struct acpi_processor *pr = per_cpu(processors, cpu);
477 478

	if (action == CPU_ONLINE && pr) {
479
		acpi_processor_ppc_has_changed(pr, 0);
480 481 482 483 484 485 486 487 488 489 490
		acpi_processor_cst_has_changed(pr);
		acpi_processor_tstate_has_changed(pr);
	}
	return NOTIFY_OK;
}

static struct notifier_block acpi_cpu_notifier =
{
	    .notifier_call = acpi_cpu_soft_notify,
};

491
static int __cpuinit acpi_processor_add(struct acpi_device *device)
L
Linus Torvalds 已提交
492
{
L
Len Brown 已提交
493
	struct acpi_processor *pr = NULL;
494 495
	int result = 0;
	struct sys_device *sysdev;
L
Linus Torvalds 已提交
496

497
	pr = kzalloc(sizeof(struct acpi_processor), GFP_KERNEL);
L
Linus Torvalds 已提交
498
	if (!pr)
499
		return -ENOMEM;
L
Linus Torvalds 已提交
500

501
	if (!zalloc_cpumask_var(&pr->throttling.shared_cpu_map, GFP_KERNEL)) {
502 503 504 505
		kfree(pr);
		return -ENOMEM;
	}

L
Linus Torvalds 已提交
506 507 508
	pr->handle = device->handle;
	strcpy(acpi_device_name(device), ACPI_PROCESSOR_DEVICE_NAME);
	strcpy(acpi_device_class(device), ACPI_PROCESSOR_CLASS);
509
	device->driver_data = pr;
L
Linus Torvalds 已提交
510

511
	result = acpi_processor_get_info(device);
L
Linus Torvalds 已提交
512 513
	if (result) {
		/* Processor is physically not present */
514
		return 0;
L
Linus Torvalds 已提交
515 516
	}

517 518 519 520 521
#ifdef CONFIG_SMP
	if (pr->id >= setup_max_cpus && pr->id != 0)
		return 0;
#endif

522
	BUG_ON((pr->id >= nr_cpu_ids) || (pr->id < 0));
L
Linus Torvalds 已提交
523

524 525 526 527 528
	/*
	 * Buggy BIOS check
	 * ACPI id of processors can be reported wrongly by the BIOS.
	 * Don't trust it blindly
	 */
529 530
	if (per_cpu(processor_device_array, pr->id) != NULL &&
	    per_cpu(processor_device_array, pr->id) != device) {
531
		printk(KERN_WARNING "BIOS reported wrong ACPI id "
L
Len Brown 已提交
532
			"for the processor\n");
533 534
		result = -ENODEV;
		goto err_free_cpumask;
535
	}
536
	per_cpu(processor_device_array, pr->id) = device;
537

538
	per_cpu(processors, pr->id) = pr;
L
Linus Torvalds 已提交
539 540 541

	result = acpi_processor_add_fs(device);
	if (result)
542
		goto err_free_cpumask;
L
Linus Torvalds 已提交
543

544
	sysdev = get_cpu_sysdev(pr->id);
545 546 547 548
	if (sysfs_create_link(&device->dev.kobj, &sysdev->kobj, "sysdev")) {
		result = -EFAULT;
		goto err_remove_fs;
	}
549

550
#ifdef CONFIG_CPU_FREQ
551
	acpi_processor_ppc_has_changed(pr, 0);
552 553 554 555
#endif
	acpi_processor_get_throttling_info(pr);
	acpi_processor_get_limit_info(pr);

556

557 558
	if (cpuidle_get_driver() == &acpi_idle_driver)
		acpi_processor_power_init(pr, device);
L
Linus Torvalds 已提交
559

560 561
	pr->cdev = thermal_cooling_device_register("Processor", device,
						&processor_cooling_ops);
562 563
	if (IS_ERR(pr->cdev)) {
		result = PTR_ERR(pr->cdev);
564
		goto err_power_exit;
565
	}
566

567
	dev_dbg(&device->dev, "registered as cooling_device%d\n",
568
		 pr->cdev->id);
569 570 571 572

	result = sysfs_create_link(&device->dev.kobj,
				   &pr->cdev->device.kobj,
				   "thermal_cooling");
573
	if (result) {
574
		printk(KERN_ERR PREFIX "Create sysfs link\n");
575 576
		goto err_thermal_unregister;
	}
577 578 579
	result = sysfs_create_link(&pr->cdev->device.kobj,
				   &device->dev.kobj,
				   "device");
580
	if (result) {
581
		printk(KERN_ERR PREFIX "Create sysfs link\n");
582 583
		goto err_remove_sysfs;
	}
584

585
	return 0;
586 587 588 589 590 591 592 593 594

err_remove_sysfs:
	sysfs_remove_link(&device->dev.kobj, "thermal_cooling");
err_thermal_unregister:
	thermal_cooling_device_unregister(pr->cdev);
err_power_exit:
	acpi_processor_power_exit(pr, device);
err_remove_fs:
	acpi_processor_remove_fs(device);
595 596
err_free_cpumask:
	free_cpumask_var(pr->throttling.shared_cpu_map);
L
Linus Torvalds 已提交
597

598
	return result;
L
Linus Torvalds 已提交
599 600
}

L
Len Brown 已提交
601
static int acpi_processor_remove(struct acpi_device *device, int type)
L
Linus Torvalds 已提交
602
{
L
Len Brown 已提交
603
	struct acpi_processor *pr = NULL;
L
Linus Torvalds 已提交
604 605 606


	if (!device || !acpi_driver_data(device))
607
		return -EINVAL;
L
Linus Torvalds 已提交
608

609
	pr = acpi_driver_data(device);
L
Linus Torvalds 已提交
610

611 612
	if (pr->id >= nr_cpu_ids)
		goto free;
L
Linus Torvalds 已提交
613 614 615

	if (type == ACPI_BUS_REMOVAL_EJECT) {
		if (acpi_processor_handle_eject(pr))
616
			return -EINVAL;
L
Linus Torvalds 已提交
617 618 619 620
	}

	acpi_processor_power_exit(pr, device);

621 622
	sysfs_remove_link(&device->dev.kobj, "sysdev");

L
Linus Torvalds 已提交
623 624
	acpi_processor_remove_fs(device);

625 626 627 628 629 630
	if (pr->cdev) {
		sysfs_remove_link(&device->dev.kobj, "thermal_cooling");
		sysfs_remove_link(&pr->cdev->device.kobj, "device");
		thermal_cooling_device_unregister(pr->cdev);
		pr->cdev = NULL;
	}
631

632 633
	per_cpu(processors, pr->id) = NULL;
	per_cpu(processor_device_array, pr->id) = NULL;
634 635 636

free:
	free_cpumask_var(pr->throttling.shared_cpu_map);
L
Linus Torvalds 已提交
637 638
	kfree(pr);

639
	return 0;
L
Linus Torvalds 已提交
640 641 642 643 644 645 646
}

#ifdef CONFIG_ACPI_HOTPLUG_CPU
/****************************************************************************
 * 	Acpi processor hotplug support 				       	    *
 ****************************************************************************/

L
Len Brown 已提交
647
static int is_processor_present(acpi_handle handle)
L
Linus Torvalds 已提交
648
{
L
Len Brown 已提交
649
	acpi_status status;
650
	unsigned long long sta = 0;
L
Linus Torvalds 已提交
651 652 653


	status = acpi_evaluate_integer(handle, "_STA", NULL, &sta);
654 655 656 657

	if (ACPI_SUCCESS(status) && (sta & ACPI_STA_DEVICE_PRESENT))
		return 1;

658 659 660 661 662 663 664 665 666
	/*
	 * _STA is mandatory for a processor that supports hot plug
	 */
	if (status == AE_NOT_FOUND)
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
				"Processor does not support hot plug\n"));
	else
		ACPI_EXCEPTION((AE_INFO, status,
				"Processor Device is not present"));
667
	return 0;
L
Linus Torvalds 已提交
668 669 670
}

static
L
Len Brown 已提交
671
int acpi_processor_device_add(acpi_handle handle, struct acpi_device **device)
L
Linus Torvalds 已提交
672
{
L
Len Brown 已提交
673 674
	acpi_handle phandle;
	struct acpi_device *pdev;
L
Linus Torvalds 已提交
675 676 677


	if (acpi_get_parent(handle, &phandle)) {
678
		return -ENODEV;
L
Linus Torvalds 已提交
679 680 681
	}

	if (acpi_bus_get_device(phandle, &pdev)) {
682
		return -ENODEV;
L
Linus Torvalds 已提交
683 684 685
	}

	if (acpi_bus_add(device, pdev, handle, ACPI_BUS_TYPE_PROCESSOR)) {
686
		return -ENODEV;
L
Linus Torvalds 已提交
687 688
	}

689
	return 0;
L
Linus Torvalds 已提交
690 691
}

692 693
static void __ref acpi_processor_hotplug_notify(acpi_handle handle,
						u32 event, void *data)
L
Linus Torvalds 已提交
694
{
L
Len Brown 已提交
695 696
	struct acpi_processor *pr;
	struct acpi_device *device = NULL;
L
Linus Torvalds 已提交
697 698 699 700 701 702
	int result;


	switch (event) {
	case ACPI_NOTIFY_BUS_CHECK:
	case ACPI_NOTIFY_DEVICE_CHECK:
703 704
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
		"Processor driver received %s event\n",
L
Len Brown 已提交
705
		       (event == ACPI_NOTIFY_BUS_CHECK) ?
706
		       "ACPI_NOTIFY_BUS_CHECK" : "ACPI_NOTIFY_DEVICE_CHECK"));
L
Linus Torvalds 已提交
707 708 709 710 711 712 713

		if (!is_processor_present(handle))
			break;

		if (acpi_bus_get_device(handle, &device)) {
			result = acpi_processor_device_add(handle, &device);
			if (result)
714 715
				printk(KERN_ERR PREFIX
					    "Unable to add the device\n");
L
Linus Torvalds 已提交
716 717
			break;
		}
L
Len Brown 已提交
718
		break;
L
Linus Torvalds 已提交
719
	case ACPI_NOTIFY_EJECT_REQUEST:
L
Len Brown 已提交
720 721
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
				  "received ACPI_NOTIFY_EJECT_REQUEST\n"));
L
Linus Torvalds 已提交
722 723

		if (acpi_bus_get_device(handle, &device)) {
724 725
			printk(KERN_ERR PREFIX
				    "Device don't exist, dropping EJECT\n");
L
Linus Torvalds 已提交
726 727 728 729
			break;
		}
		pr = acpi_driver_data(device);
		if (!pr) {
730 731
			printk(KERN_ERR PREFIX
				    "Driver data is NULL, dropping EJECT\n");
732
			return;
L
Linus Torvalds 已提交
733 734 735 736
		}
		break;
	default:
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
L
Len Brown 已提交
737
				  "Unsupported event [0x%x]\n", event));
L
Linus Torvalds 已提交
738 739 740
		break;
	}

741
	return;
L
Linus Torvalds 已提交
742 743 744 745
}

static acpi_status
processor_walk_namespace_cb(acpi_handle handle,
L
Len Brown 已提交
746
			    u32 lvl, void *context, void **rv)
L
Linus Torvalds 已提交
747
{
L
Len Brown 已提交
748
	acpi_status status;
L
Linus Torvalds 已提交
749
	int *action = context;
L
Len Brown 已提交
750
	acpi_object_type type = 0;
L
Linus Torvalds 已提交
751 752 753

	status = acpi_get_type(handle, &type);
	if (ACPI_FAILURE(status))
L
Len Brown 已提交
754
		return (AE_OK);
L
Linus Torvalds 已提交
755 756

	if (type != ACPI_TYPE_PROCESSOR)
L
Len Brown 已提交
757
		return (AE_OK);
L
Linus Torvalds 已提交
758

L
Len Brown 已提交
759
	switch (*action) {
L
Linus Torvalds 已提交
760 761
	case INSTALL_NOTIFY_HANDLER:
		acpi_install_notify_handler(handle,
L
Len Brown 已提交
762 763 764
					    ACPI_SYSTEM_NOTIFY,
					    acpi_processor_hotplug_notify,
					    NULL);
L
Linus Torvalds 已提交
765 766 767
		break;
	case UNINSTALL_NOTIFY_HANDLER:
		acpi_remove_notify_handler(handle,
L
Len Brown 已提交
768 769
					   ACPI_SYSTEM_NOTIFY,
					   acpi_processor_hotplug_notify);
L
Linus Torvalds 已提交
770 771 772 773 774
		break;
	default:
		break;
	}

L
Len Brown 已提交
775
	return (AE_OK);
L
Linus Torvalds 已提交
776 777
}

L
Len Brown 已提交
778
static acpi_status acpi_processor_hotadd_init(acpi_handle handle, int *p_cpu)
L
Linus Torvalds 已提交
779 780 781
{

	if (!is_processor_present(handle)) {
782
		return AE_ERROR;
L
Linus Torvalds 已提交
783 784 785
	}

	if (acpi_map_lsapic(handle, p_cpu))
786
		return AE_ERROR;
L
Linus Torvalds 已提交
787 788 789

	if (arch_register_cpu(*p_cpu)) {
		acpi_unmap_lsapic(*p_cpu);
790
		return AE_ERROR;
L
Linus Torvalds 已提交
791 792
	}

793
	return AE_OK;
L
Linus Torvalds 已提交
794 795
}

L
Len Brown 已提交
796
static int acpi_processor_handle_eject(struct acpi_processor *pr)
L
Linus Torvalds 已提交
797
{
798 799 800
	if (cpu_online(pr->id))
		cpu_down(pr->id);

L
Linus Torvalds 已提交
801 802
	arch_unregister_cpu(pr->id);
	acpi_unmap_lsapic(pr->id);
L
Len Brown 已提交
803
	return (0);
L
Linus Torvalds 已提交
804 805
}
#else
L
Len Brown 已提交
806
static acpi_status acpi_processor_hotadd_init(acpi_handle handle, int *p_cpu)
L
Linus Torvalds 已提交
807 808 809
{
	return AE_ERROR;
}
L
Len Brown 已提交
810
static int acpi_processor_handle_eject(struct acpi_processor *pr)
L
Linus Torvalds 已提交
811
{
L
Len Brown 已提交
812
	return (-EINVAL);
L
Linus Torvalds 已提交
813 814 815 816 817 818 819 820 821
}
#endif

static
void acpi_processor_install_hotplug_notify(void)
{
#ifdef CONFIG_ACPI_HOTPLUG_CPU
	int action = INSTALL_NOTIFY_HANDLER;
	acpi_walk_namespace(ACPI_TYPE_PROCESSOR,
L
Len Brown 已提交
822 823
			    ACPI_ROOT_OBJECT,
			    ACPI_UINT32_MAX,
824
			    processor_walk_namespace_cb, NULL, &action, NULL);
L
Linus Torvalds 已提交
825
#endif
826
	register_hotcpu_notifier(&acpi_cpu_notifier);
L
Linus Torvalds 已提交
827 828 829 830 831 832 833 834
}

static
void acpi_processor_uninstall_hotplug_notify(void)
{
#ifdef CONFIG_ACPI_HOTPLUG_CPU
	int action = UNINSTALL_NOTIFY_HANDLER;
	acpi_walk_namespace(ACPI_TYPE_PROCESSOR,
L
Len Brown 已提交
835 836
			    ACPI_ROOT_OBJECT,
			    ACPI_UINT32_MAX,
837
			    processor_walk_namespace_cb, NULL, &action, NULL);
L
Linus Torvalds 已提交
838
#endif
839
	unregister_hotcpu_notifier(&acpi_cpu_notifier);
L
Linus Torvalds 已提交
840 841 842 843 844 845 846 847
}

/*
 * We keep the driver loaded even when ACPI is not running.
 * This is needed for the powernow-k8 driver, that works even without
 * ACPI, but needs symbols from this driver
 */

L
Len Brown 已提交
848
static int __init acpi_processor_init(void)
L
Linus Torvalds 已提交
849
{
L
Len Brown 已提交
850
	int result = 0;
L
Linus Torvalds 已提交
851

852 853 854
	if (acpi_disabled)
		return 0;

L
Linus Torvalds 已提交
855 856
	memset(&errata, 0, sizeof(errata));

857
#ifdef CONFIG_ACPI_PROCFS
L
Linus Torvalds 已提交
858 859
	acpi_processor_dir = proc_mkdir(ACPI_PROCESSOR_CLASS, acpi_root_dir);
	if (!acpi_processor_dir)
860
		return -ENOMEM;
861
#endif
862

863
	if (!cpuidle_register_driver(&acpi_idle_driver)) {
864 865
		printk(KERN_DEBUG "ACPI: %s registered with cpuidle\n",
			acpi_idle_driver.name);
866
	} else {
L
Len Brown 已提交
867
		printk(KERN_DEBUG "ACPI: acpi_idle yielding to %s\n",
868 869
			cpuidle_get_driver()->name);
	}
870

L
Linus Torvalds 已提交
871
	result = acpi_bus_register_driver(&acpi_processor_driver);
872 873
	if (result < 0)
		goto out_cpuidle;
L
Linus Torvalds 已提交
874 875 876 877 878 879 880

	acpi_processor_install_hotplug_notify();

	acpi_thermal_cpufreq_init();

	acpi_processor_ppc_init();

881 882
	acpi_processor_throttling_init();

883
	return 0;
884 885 886 887

out_cpuidle:
	cpuidle_unregister_driver(&acpi_idle_driver);

888
#ifdef CONFIG_ACPI_PROCFS
889
	remove_proc_entry(ACPI_PROCESSOR_CLASS, acpi_root_dir);
890
#endif
891 892

	return result;
L
Linus Torvalds 已提交
893 894
}

L
Len Brown 已提交
895
static void __exit acpi_processor_exit(void)
L
Linus Torvalds 已提交
896
{
897 898 899
	if (acpi_disabled)
		return;

L
Linus Torvalds 已提交
900 901 902 903 904 905 906 907
	acpi_processor_ppc_exit();

	acpi_thermal_cpufreq_exit();

	acpi_processor_uninstall_hotplug_notify();

	acpi_bus_unregister_driver(&acpi_processor_driver);

908 909
	cpuidle_unregister_driver(&acpi_idle_driver);

910
#ifdef CONFIG_ACPI_PROCFS
L
Linus Torvalds 已提交
911
	remove_proc_entry(ACPI_PROCESSOR_CLASS, acpi_root_dir);
912
#endif
L
Linus Torvalds 已提交
913

914
	return;
L
Linus Torvalds 已提交
915 916 917 918 919 920
}

module_init(acpi_processor_init);
module_exit(acpi_processor_exit);

MODULE_ALIAS("processor");