[mirror_ubuntu-artful-kernel.git] / drivers / acpi / acpi_processor.c

/*
 * acpi_processor.c - ACPI processor enumeration support
 *
 * 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>
 * Copyright (C) 2013, Intel Corporation
 *                     Rafael J. Wysocki <rafael.j.wysocki@intel.com>
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License version 2 as published
 * by the Free Software Foundation.
 */

#include <linux/acpi.h>
#include <linux/device.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/pci.h>

#include <acpi/processor.h>

#include <asm/cpu.h>

#include "internal.h"

#define _COMPONENT	ACPI_PROCESSOR_COMPONENT

ACPI_MODULE_NAME("processor");

DEFINE_PER_CPU(struct acpi_processor *, processors);
EXPORT_PER_CPU_SYMBOL(processors);

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

struct acpi_processor_errata errata __read_mostly;
EXPORT_SYMBOL_GPL(errata);

static int acpi_processor_errata_piix4(struct pci_dev *dev)
{
	u8 value1 = 0;
	u8 value2 = 0;


	if (!dev)
		return -EINVAL;

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

	switch (dev->revision) {
	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;
	}

	switch (dev->revision) {

	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,
				     PCI_DEVICE_ID_INTEL_82371AB,
				     PCI_ANY_ID, PCI_ANY_ID, NULL);
		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,
				     PCI_DEVICE_ID_INTEL_82371AB_0,
				     PCI_ANY_ID, PCI_ANY_ID, NULL);
		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,
				  "Bus master activity detection (BM-IDE) erratum enabled\n"));
	if (errata.piix4.fdma)
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
				  "Type-F DMA livelock erratum (C3 disabled)\n"));

	return 0;
}

static int acpi_processor_errata(void)
{
	int result = 0;
	struct pci_dev *dev = NULL;

	/*
	 * PIIX4
	 */
	dev = pci_get_subsys(PCI_VENDOR_ID_INTEL,
			     PCI_DEVICE_ID_INTEL_82371AB_3, PCI_ANY_ID,
			     PCI_ANY_ID, NULL);
	if (dev) {
		result = acpi_processor_errata_piix4(dev);
		pci_dev_put(dev);
	}

	return result;
}

/* --------------------------------------------------------------------------
                                Initialization
   -------------------------------------------------------------------------- */

#ifdef CONFIG_ACPI_HOTPLUG_CPU
static int acpi_processor_hotadd_init(struct acpi_processor *pr)
{
	unsigned long long sta;
	acpi_status status;
	int ret;

	if (pr->apic_id == -1)
		return -ENODEV;

	status = acpi_evaluate_integer(pr->handle, "_STA", NULL, &sta);
	if (ACPI_FAILURE(status) || !(sta & ACPI_STA_DEVICE_PRESENT))
		return -ENODEV;

	cpu_maps_update_begin();
	cpu_hotplug_begin();

	ret = acpi_map_lsapic(pr->handle, pr->apic_id, &pr->id);
	if (ret)
		goto out;

	ret = arch_register_cpu(pr->id);
	if (ret) {
		acpi_unmap_lsapic(pr->id);
		goto out;
	}

	/*
	 * CPU got hot-added, but cpu_data is not initialized yet.  Set a flag
	 * to delay cpu_idle/throttling initialization and do it when the CPU
	 * gets online for the first time.
	 */
	pr_info("CPU%d has been hot-added\n", pr->id);
	pr->flags.need_hotplug_init = 1;

out:
	cpu_hotplug_done();
	cpu_maps_update_done();
	return ret;
}
#else
static inline int acpi_processor_hotadd_init(struct acpi_processor *pr)
{
	return -ENODEV;
}
#endif /* CONFIG_ACPI_HOTPLUG_CPU */

static int acpi_processor_get_info(struct acpi_device *device)
{
	union acpi_object object = { 0 };
	struct acpi_buffer buffer = { sizeof(union acpi_object), &object };
	struct acpi_processor *pr = acpi_driver_data(device);
	int apic_id, cpu_index, device_declaration = 0;
	acpi_status status = AE_OK;
	static int cpu0_initialized;
	unsigned long long value;

	acpi_processor_errata();

	/*
	 * Check to see if we have bus mastering arbitration control.  This
	 * is required for proper C3 usage (to maintain cache coherency).
	 */
	if (acpi_gbl_FADT.pm2_control_block && acpi_gbl_FADT.pm2_control_length) {
		pr->flags.bm_control = 1;
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
				  "Bus mastering arbitration control present\n"));
	} else
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
				  "No bus mastering arbitration control\n"));

	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)) {
			dev_err(&device->dev,
				"Failed to evaluate processor object (0x%x)\n",
				status);
			return -ENODEV;
		}

		pr->acpi_id = object.processor.proc_id;
	} else {
		/*
		 * Declared with "Device" statement; match _UID.
		 * Note that we don't handle string _UIDs yet.
		 */
		status = acpi_evaluate_integer(pr->handle, METHOD_NAME__UID,
						NULL, &value);
		if (ACPI_FAILURE(status)) {
			dev_err(&device->dev,
				"Failed to evaluate processor _UID (0x%x)\n",
				status);
			return -ENODEV;
		}
		device_declaration = 1;
		pr->acpi_id = value;
	}

	apic_id = acpi_get_apicid(pr->handle, device_declaration, pr->acpi_id);
	if (apic_id < 0)
		acpi_handle_debug(pr->handle, "failed to get CPU APIC ID.\n");
	pr->apic_id = apic_id;

	cpu_index = acpi_map_cpuid(pr->apic_id, pr->acpi_id);
	if (!cpu0_initialized && !acpi_has_cpu_in_madt()) {
		cpu0_initialized = 1;
		/* Handle UP system running SMP kernel, with no LAPIC in MADT */
		if ((cpu_index == -1) && (num_online_cpus() == 1))
			cpu_index = 0;
	}
	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.
	 */
	if (pr->id == -1) {
		int ret = acpi_processor_hotadd_init(pr);
		if (ret)
			return ret;
	}

	/*
	 * 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);
	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Processor [%d:%d]\n", pr->id,
			  pr->acpi_id));

	if (!object.processor.pblk_address)
		ACPI_DEBUG_PRINT((ACPI_DB_INFO, "No PBLK (NULL address)\n"));
	else if (object.processor.pblk_length != 6)
		dev_err(&device->dev, "Invalid PBLK length [%d]\n",
			    object.processor.pblk_length);
	else {
		pr->throttling.address = object.processor.pblk_address;
		pr->throttling.duty_offset = acpi_gbl_FADT.duty_offset;
		pr->throttling.duty_width = acpi_gbl_FADT.duty_width;

		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");
	}

	/*
	 * If ACPI describes a slot number for this CPU, we can use it to
	 * ensure we get the right value in the "physical id" field
	 * of /proc/cpuinfo
	 */
	status = acpi_evaluate_integer(pr->handle, "_SUN", NULL, &value);
	if (ACPI_SUCCESS(status))
		arch_fix_phys_package_id(pr->id, value);

	return 0;
}

/*
 * Do not put anything in here which needs the core to be online.
 * For example MSR access or setting up things which check for cpuinfo_x86
 * (cpu_data(cpu)) values, like CPU feature flags, family, model, etc.
 * Such things have to be put in and set up by the processor driver's .probe().
 */
static DEFINE_PER_CPU(void *, processor_device_array);

static int acpi_processor_add(struct acpi_device *device,
					const struct acpi_device_id *id)
{
	struct acpi_processor *pr;
	struct device *dev;
	int result = 0;

	pr = kzalloc(sizeof(struct acpi_processor), GFP_KERNEL);
	if (!pr)
		return -ENOMEM;

	if (!zalloc_cpumask_var(&pr->throttling.shared_cpu_map, GFP_KERNEL)) {
		result = -ENOMEM;
		goto err_free_pr;
	}

	pr->handle = device->handle;
	strcpy(acpi_device_name(device), ACPI_PROCESSOR_DEVICE_NAME);
	strcpy(acpi_device_class(device), ACPI_PROCESSOR_CLASS);
	device->driver_data = pr;

	result = acpi_processor_get_info(device);
	if (result) /* Processor is not physically present or unavailable */
		return 0;

#ifdef CONFIG_SMP
	if (pr->id >= setup_max_cpus && pr->id != 0)
		return 0;
#endif

	BUG_ON(pr->id >= nr_cpu_ids);

	/*
	 * Buggy BIOS check.
	 * ACPI id of processors can be reported wrongly by the BIOS.
	 * Don't trust it blindly
	 */
	if (per_cpu(processor_device_array, pr->id) != NULL &&
	    per_cpu(processor_device_array, pr->id) != device) {
		dev_warn(&device->dev,
			"BIOS reported wrong ACPI id %d for the processor\n",
			pr->id);
		/* Give up, but do not abort the namespace scan. */
		goto err;
	}
	/*
	 * processor_device_array is not cleared on errors to allow buggy BIOS
	 * checks.
	 */
	per_cpu(processor_device_array, pr->id) = device;
	per_cpu(processors, pr->id) = pr;

	dev = get_cpu_device(pr->id);
	if (!dev) {
		result = -ENODEV;
		goto err;
	}

	result = acpi_bind_one(dev, device);
	if (result)
		goto err;

	pr->dev = dev;

	/* Trigger the processor driver's .probe() if present. */
	if (device_attach(dev) >= 0)
		return 1;

	dev_err(dev, "Processor driver could not be attached\n");
	acpi_unbind_one(dev);

 err:
	free_cpumask_var(pr->throttling.shared_cpu_map);
	device->driver_data = NULL;
	per_cpu(processors, pr->id) = NULL;
 err_free_pr:
	kfree(pr);
	return result;
}

#ifdef CONFIG_ACPI_HOTPLUG_CPU
/* --------------------------------------------------------------------------
                                    Removal
   -------------------------------------------------------------------------- */

static void acpi_processor_remove(struct acpi_device *device)
{
	struct acpi_processor *pr;

	if (!device || !acpi_driver_data(device))
		return;

	pr = acpi_driver_data(device);
	if (pr->id >= nr_cpu_ids)
		goto out;

	/*
	 * The only reason why we ever get here is CPU hot-removal.  The CPU is
	 * already offline and the ACPI device removal locking prevents it from
	 * being put back online at this point.
	 *
	 * Unbind the driver from the processor device and detach it from the
	 * ACPI companion object.
	 */
	device_release_driver(pr->dev);
	acpi_unbind_one(pr->dev);

	/* Clean up. */
	per_cpu(processor_device_array, pr->id) = NULL;
	per_cpu(processors, pr->id) = NULL;

	cpu_maps_update_begin();
	cpu_hotplug_begin();

	/* Remove the CPU. */
	arch_unregister_cpu(pr->id);
	acpi_unmap_lsapic(pr->id);

	cpu_hotplug_done();
	cpu_maps_update_done();

	try_offline_node(cpu_to_node(pr->id));

 out:
	free_cpumask_var(pr->throttling.shared_cpu_map);
	kfree(pr);
}
#endif /* CONFIG_ACPI_HOTPLUG_CPU */

/*
 * The following ACPI IDs are known to be suitable for representing as
 * processor devices.
 */
static const struct acpi_device_id processor_device_ids[] = {

	{ ACPI_PROCESSOR_OBJECT_HID, },
	{ ACPI_PROCESSOR_DEVICE_HID, },

	{ }
};

static struct acpi_scan_handler __refdata processor_handler = {
	.ids = processor_device_ids,
	.attach = acpi_processor_add,
#ifdef CONFIG_ACPI_HOTPLUG_CPU
	.detach = acpi_processor_remove,
#endif
	.hotplug = {
		.enabled = true,
	},
};

void __init acpi_processor_init(void)
{
	acpi_scan_add_handler_with_hotplug(&processor_handler, "processor");
}
Commit	Line	Data
ac212b69 RW	1	/*
	2	* acpi_processor.c - ACPI processor enumeration support
	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	* Copyright (C) 2013, Intel Corporation
	9	* Rafael J. Wysocki <rafael.j.wysocki@intel.com>
	10	*
	11	* This program is free software; you can redistribute it and/or modify it
	12	* under the terms of the GNU General Public License version 2 as published
	13	* by the Free Software Foundation.
	14	*/
	15
	16	#include <linux/acpi.h>
	17	#include <linux/device.h>
	18	#include <linux/kernel.h>
	19	#include <linux/module.h>
	20	#include <linux/pci.h>
	21
	22	#include <acpi/processor.h>
	23
	24	#include <asm/cpu.h>
	25
	26	#include "internal.h"
	27
	28	#define _COMPONENT ACPI_PROCESSOR_COMPONENT
	29
	30	ACPI_MODULE_NAME("processor");
	31
2e4f1db4 RW	32	DEFINE_PER_CPU(struct acpi_processor *, processors);
	33	EXPORT_PER_CPU_SYMBOL(processors);
	34
ac212b69 RW	35	/* --------------------------------------------------------------------------
	36	Errata Handling
	37	-------------------------------------------------------------------------- */
	38
	39	struct acpi_processor_errata errata __read_mostly;
	40	EXPORT_SYMBOL_GPL(errata);
	41
	42	static int acpi_processor_errata_piix4(struct pci_dev *dev)
	43	{
	44	u8 value1 = 0;
	45	u8 value2 = 0;
	46
	47
	48	if (!dev)
	49	return -EINVAL;
	50
	51	/*
	52	* Note that 'dev' references the PIIX4 ACPI Controller.
	53	*/
	54
	55	switch (dev->revision) {
	56	case 0:
	57	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found PIIX4 A-step\n"));
	58	break;
	59	case 1:
	60	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found PIIX4 B-step\n"));
	61	break;
	62	case 2:
	63	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found PIIX4E\n"));
	64	break;
	65	case 3:
	66	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found PIIX4M\n"));
	67	break;
	68	default:
	69	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found unknown PIIX4\n"));
	70	break;
	71	}
	72
	73	switch (dev->revision) {
	74
	75	case 0: /* PIIX4 A-step */
	76	case 1: /* PIIX4 B-step */
	77	/*
	78	* See specification changes #13 ("Manual Throttle Duty Cycle")
	79	* and #14 ("Enabling and Disabling Manual Throttle"), plus
	80	* erratum #5 ("STPCLK# Deassertion Time") from the January
	81	* 2002 PIIX4 specification update. Applies to only older
	82	* PIIX4 models.
	83	*/
	84	errata.piix4.throttle = 1;
	85
	86	case 2: /* PIIX4E */
	87	case 3: /* PIIX4M */
	88	/*
	89	* See erratum #18 ("C3 Power State/BMIDE and Type-F DMA
	90	* Livelock") from the January 2002 PIIX4 specification update.
	91	* Applies to all PIIX4 models.
	92	*/
	93
	94	/*
	95	* BM-IDE
	96	* ------
	97	* Find the PIIX4 IDE Controller and get the Bus Master IDE
	98	* Status register address. We'll use this later to read
99	* each IDE controller's DMA status to make sure we catch all
100	* DMA activity.
101	*/
102	dev = pci_get_subsys(PCI_VENDOR_ID_INTEL,
103	PCI_DEVICE_ID_INTEL_82371AB,
104	PCI_ANY_ID, PCI_ANY_ID, NULL);
105	if (dev) {
106	errata.piix4.bmisx = pci_resource_start(dev, 4);
107	pci_dev_put(dev);
108	}
109
110	/*
111	* Type-F DMA
112	* ----------
113	* Find the PIIX4 ISA Controller and read the Motherboard
114	* DMA controller's status to see if Type-F (Fast) DMA mode
115	* is enabled (bit 7) on either channel. Note that we'll
116	* disable C3 support if this is enabled, as some legacy
117	* devices won't operate well if fast DMA is disabled.
118	*/
119	dev = pci_get_subsys(PCI_VENDOR_ID_INTEL,
120	PCI_DEVICE_ID_INTEL_82371AB_0,
121	PCI_ANY_ID, PCI_ANY_ID, NULL);
122	if (dev) {
123	pci_read_config_byte(dev, 0x76, &value1);
124	pci_read_config_byte(dev, 0x77, &value2);
125	if ((value1 & 0x80) \|\| (value2 & 0x80))
126	errata.piix4.fdma = 1;
127	pci_dev_put(dev);
128	}
129
130	break;
131	}
132
133	if (errata.piix4.bmisx)
134	ACPI_DEBUG_PRINT((ACPI_DB_INFO,
135	"Bus master activity detection (BM-IDE) erratum enabled\n"));
136	if (errata.piix4.fdma)
137	ACPI_DEBUG_PRINT((ACPI_DB_INFO,
138	"Type-F DMA livelock erratum (C3 disabled)\n"));
139
140	return 0;
141	}
142
082e12a0	143	static int acpi_processor_errata(void)
ac212b69 RW	144	{
	145	int result = 0;
	146	struct pci_dev *dev = NULL;
	147
ac212b69 RW	148	/*
	149	* PIIX4
	150	*/
	151	dev = pci_get_subsys(PCI_VENDOR_ID_INTEL,
	152	PCI_DEVICE_ID_INTEL_82371AB_3, PCI_ANY_ID,
	153	PCI_ANY_ID, NULL);
	154	if (dev) {
	155	result = acpi_processor_errata_piix4(dev);
	156	pci_dev_put(dev);
	157	}
	158
	159	return result;
	160	}
	161
	162	/* --------------------------------------------------------------------------
	163	Initialization
	164	-------------------------------------------------------------------------- */
	165
	166	#ifdef CONFIG_ACPI_HOTPLUG_CPU
	167	static int acpi_processor_hotadd_init(struct acpi_processor *pr)
	168	{
	169	unsigned long long sta;
	170	acpi_status status;
	171	int ret;
	172
4985c32e LT	173	if (pr->apic_id == -1)
	174	return -ENODEV;
	175
ac212b69 RW	176	status = acpi_evaluate_integer(pr->handle, "_STA", NULL, &sta);
	177	if (ACPI_FAILURE(status) \|\| !(sta & ACPI_STA_DEVICE_PRESENT))
	178	return -ENODEV;
	179
b9d10be7 TK	180	cpu_maps_update_begin();
	181	cpu_hotplug_begin();
	182
d536bf3d	183	ret = acpi_map_lsapic(pr->handle, pr->apic_id, &pr->id);
ac212b69	184	if (ret)
b9d10be7	185	goto out;
ac212b69 RW	186
	187	ret = arch_register_cpu(pr->id);
	188	if (ret) {
	189	acpi_unmap_lsapic(pr->id);
b9d10be7	190	goto out;
ac212b69 RW	191	}
	192
	193	/*
	194	* CPU got hot-added, but cpu_data is not initialized yet. Set a flag
	195	* to delay cpu_idle/throttling initialization and do it when the CPU
	196	* gets online for the first time.
	197	*/
	198	pr_info("CPU%d has been hot-added\n", pr->id);
	199	pr->flags.need_hotplug_init = 1;
b9d10be7 TK	200
	201	out:
	202	cpu_hotplug_done();
	203	cpu_maps_update_done();
	204	return ret;
ac212b69 RW	205	}
	206	#else
	207	static inline int acpi_processor_hotadd_init(struct acpi_processor *pr)
	208	{
	209	return -ENODEV;
	210	}
	211	#endif /* CONFIG_ACPI_HOTPLUG_CPU */
	212
	213	static int acpi_processor_get_info(struct acpi_device *device)
	214	{
	215	union acpi_object object = { 0 };
	216	struct acpi_buffer buffer = { sizeof(union acpi_object), &object };
	217	struct acpi_processor *pr = acpi_driver_data(device);
b981513f	218	int apic_id, cpu_index, device_declaration = 0;
ac212b69 RW	219	acpi_status status = AE_OK;
ac212b69 RW	220	static int cpu0_initialized;
6ebb5bc9	221	unsigned long long value;
ac212b69	222
082e12a0	223	acpi_processor_errata();
ac212b69 RW	224
	225	/*
	226	* Check to see if we have bus mastering arbitration control. This
	227	* is required for proper C3 usage (to maintain cache coherency).
	228	*/
	229	if (acpi_gbl_FADT.pm2_control_block && acpi_gbl_FADT.pm2_control_length) {
	230	pr->flags.bm_control = 1;
	231	ACPI_DEBUG_PRINT((ACPI_DB_INFO,
	232	"Bus mastering arbitration control present\n"));
	233	} else
	234	ACPI_DEBUG_PRINT((ACPI_DB_INFO,
	235	"No bus mastering arbitration control\n"));
	236
	237	if (!strcmp(acpi_device_hid(device), ACPI_PROCESSOR_OBJECT_HID)) {
	238	/* Declared with "Processor" statement; match ProcessorID */
	239	status = acpi_evaluate_object(pr->handle, NULL, NULL, &buffer);
	240	if (ACPI_FAILURE(status)) {
	241	dev_err(&device->dev,
	242	"Failed to evaluate processor object (0x%x)\n",
	243	status);
	244	return -ENODEV;
	245	}
	246
ac212b69 RW	247	pr->acpi_id = object.processor.proc_id;
	248	} else {
	249	/*
	250	* Declared with "Device" statement; match _UID.
	251	* Note that we don't handle string _UIDs yet.
	252	*/
ac212b69 RW	253	status = acpi_evaluate_integer(pr->handle, METHOD_NAME__UID,
	254	NULL, &value);
	255	if (ACPI_FAILURE(status)) {
	256	dev_err(&device->dev,
	257	"Failed to evaluate processor _UID (0x%x)\n",
	258	status);
	259	return -ENODEV;
	260	}
	261	device_declaration = 1;
	262	pr->acpi_id = value;
	263	}
ac212b69	264
b981513f	265	apic_id = acpi_get_apicid(pr->handle, device_declaration, pr->acpi_id);
4985c32e	266	if (apic_id < 0)
f778d121	267	acpi_handle_debug(pr->handle, "failed to get CPU APIC ID.\n");
b981513f	268	pr->apic_id = apic_id;
ac212b69	269
b981513f	270	cpu_index = acpi_map_cpuid(pr->apic_id, pr->acpi_id);
b50154d5	271	if (!cpu0_initialized && !acpi_has_cpu_in_madt()) {
b981513f JL	272	cpu0_initialized = 1;
	273	/* Handle UP system running SMP kernel, with no LAPIC in MADT */
	274	if ((cpu_index == -1) && (num_online_cpus() == 1))
	275	cpu_index = 0;
	276	}
ac212b69 RW	277	pr->id = cpu_index;
	278
	279	/*
	280	* Extra Processor objects may be enumerated on MP systems with
	281	* less than the max # of CPUs. They should be ignored _iff
	282	* they are physically not present.
	283	*/
	284	if (pr->id == -1) {
	285	int ret = acpi_processor_hotadd_init(pr);
	286	if (ret)
	287	return ret;
	288	}
b981513f	289
ac212b69 RW	290	/*
	291	* On some boxes several processors use the same processor bus id.
	292	* But they are located in different scope. For example:
	293	* \_SB.SCK0.CPU0
	294	* \_SB.SCK1.CPU0
	295	* Rename the processor device bus id. And the new bus id will be
	296	* generated as the following format:
	297	* CPU+CPU ID.
	298	*/
	299	sprintf(acpi_device_bid(device), "CPU%X", pr->id);
	300	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Processor [%d:%d]\n", pr->id,
	301	pr->acpi_id));
	302
	303	if (!object.processor.pblk_address)
	304	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "No PBLK (NULL address)\n"));
	305	else if (object.processor.pblk_length != 6)
	306	dev_err(&device->dev, "Invalid PBLK length [%d]\n",
	307	object.processor.pblk_length);
	308	else {
	309	pr->throttling.address = object.processor.pblk_address;
	310	pr->throttling.duty_offset = acpi_gbl_FADT.duty_offset;
	311	pr->throttling.duty_width = acpi_gbl_FADT.duty_width;
	312
	313	pr->pblk = object.processor.pblk_address;
	314
	315	/*
	316	* We don't care about error returns - we just try to mark
	317	* these reserved so that nobody else is confused into thinking
	318	* that this region might be unused..
	319	*
	320	* (In particular, allocating the IO range for Cardbus)
	321	*/
	322	request_region(pr->throttling.address, 6, "ACPI CPU throttle");
	323	}
	324
	325	/*
	326	* If ACPI describes a slot number for this CPU, we can use it to
	327	* ensure we get the right value in the "physical id" field
	328	* of /proc/cpuinfo
	329	*/
6ebb5bc9	330	status = acpi_evaluate_integer(pr->handle, "_SUN", NULL, &value);
ac212b69	331	if (ACPI_SUCCESS(status))
6ebb5bc9	332	arch_fix_phys_package_id(pr->id, value);
ac212b69 RW	333
	334	return 0;
	335	}
	336
	337	/*
	338	* Do not put anything in here which needs the core to be online.
	339	* For example MSR access or setting up things which check for cpuinfo_x86
	340	* (cpu_data(cpu)) values, like CPU feature flags, family, model, etc.
	341	* Such things have to be put in and set up by the processor driver's .probe().
	342	*/
	343	static DEFINE_PER_CPU(void *, processor_device_array);
	344
fe7bf106	345	static int acpi_processor_add(struct acpi_device *device,
ac212b69 RW	346	const struct acpi_device_id *id)
	347	{
	348	struct acpi_processor *pr;
	349	struct device *dev;
	350	int result = 0;
	351
	352	pr = kzalloc(sizeof(struct acpi_processor), GFP_KERNEL);
	353	if (!pr)
	354	return -ENOMEM;
	355
	356	if (!zalloc_cpumask_var(&pr->throttling.shared_cpu_map, GFP_KERNEL)) {
	357	result = -ENOMEM;
	358	goto err_free_pr;
	359	}
	360
	361	pr->handle = device->handle;
	362	strcpy(acpi_device_name(device), ACPI_PROCESSOR_DEVICE_NAME);
	363	strcpy(acpi_device_class(device), ACPI_PROCESSOR_CLASS);
	364	device->driver_data = pr;
	365
	366	result = acpi_processor_get_info(device);
	367	if (result) /* Processor is not physically present or unavailable */
	368	return 0;
	369
	370	#ifdef CONFIG_SMP
	371	if (pr->id >= setup_max_cpus && pr->id != 0)
	372	return 0;
	373	#endif
	374
	375	BUG_ON(pr->id >= nr_cpu_ids);
	376
	377	/*
	378	* Buggy BIOS check.
	379	* ACPI id of processors can be reported wrongly by the BIOS.
	380	* Don't trust it blindly
	381	*/
	382	if (per_cpu(processor_device_array, pr->id) != NULL &&
	383	per_cpu(processor_device_array, pr->id) != device) {
	384	dev_warn(&device->dev,
	385	"BIOS reported wrong ACPI id %d for the processor\n",
	386	pr->id);
	387	/* Give up, but do not abort the namespace scan. */
	388	goto err;
	389	}
	390	/*
	391	* processor_device_array is not cleared on errors to allow buggy BIOS
	392	* checks.
	393	*/
	394	per_cpu(processor_device_array, pr->id) = device;
2e4f1db4	395	per_cpu(processors, pr->id) = pr;
ac212b69 RW	396
ac212b69 RW	397	dev = get_cpu_device(pr->id);
173a5a4c HG	398	if (!dev) {
	399	result = -ENODEV;
	400	goto err;
	401	}
	402
24dee1fc	403	result = acpi_bind_one(dev, device);
ac212b69 RW	404	if (result)
	405	goto err;
	406
	407	pr->dev = dev;
ac212b69 RW	408
	409	/* Trigger the processor driver's .probe() if present. */
	410	if (device_attach(dev) >= 0)
	411	return 1;
	412
	413	dev_err(dev, "Processor driver could not be attached\n");
	414	acpi_unbind_one(dev);
	415
	416	err:
	417	free_cpumask_var(pr->throttling.shared_cpu_map);
	418	device->driver_data = NULL;
2e4f1db4	419	per_cpu(processors, pr->id) = NULL;
ac212b69 RW	420	err_free_pr:
	421	kfree(pr);
	422	return result;
	423	}
	424
	425	#ifdef CONFIG_ACPI_HOTPLUG_CPU
	426	/* --------------------------------------------------------------------------
	427	Removal
	428	-------------------------------------------------------------------------- */
	429
	430	static void acpi_processor_remove(struct acpi_device *device)
	431	{
	432	struct acpi_processor *pr;
	433
	434	if (!device \|\| !acpi_driver_data(device))
	435	return;
	436
	437	pr = acpi_driver_data(device);
	438	if (pr->id >= nr_cpu_ids)
	439	goto out;
	440
	441	/*
	442	* The only reason why we ever get here is CPU hot-removal. The CPU is
	443	* already offline and the ACPI device removal locking prevents it from
	444	* being put back online at this point.
	445	*
	446	* Unbind the driver from the processor device and detach it from the
	447	* ACPI companion object.
	448	*/
	449	device_release_driver(pr->dev);
	450	acpi_unbind_one(pr->dev);
	451
	452	/* Clean up. */
	453	per_cpu(processor_device_array, pr->id) = NULL;
2e4f1db4	454	per_cpu(processors, pr->id) = NULL;
ac212b69	455
b9d10be7 TK	456	cpu_maps_update_begin();
	457	cpu_hotplug_begin();
	458
ac212b69	459	/* Remove the CPU. */
ac212b69 RW	460	arch_unregister_cpu(pr->id);
ac212b69 RW	461	acpi_unmap_lsapic(pr->id);
b9d10be7 TK	462
	463	cpu_hotplug_done();
	464	cpu_maps_update_done();
ac212b69	465
1e385f6f YI	466	try_offline_node(cpu_to_node(pr->id));
1e385f6f YI	467
ac212b69 RW	468	out:
	469	free_cpumask_var(pr->throttling.shared_cpu_map);
	470	kfree(pr);
	471	}
	472	#endif /* CONFIG_ACPI_HOTPLUG_CPU */
	473
	474	/*
	475	* The following ACPI IDs are known to be suitable for representing as
	476	* processor devices.
	477	*/
	478	static const struct acpi_device_id processor_device_ids[] = {
	479
	480	{ ACPI_PROCESSOR_OBJECT_HID, },
	481	{ ACPI_PROCESSOR_DEVICE_HID, },
	482
	483	{ }
	484	};
	485
	486	static struct acpi_scan_handler __refdata processor_handler = {
	487	.ids = processor_device_ids,
	488	.attach = acpi_processor_add,
	489	#ifdef CONFIG_ACPI_HOTPLUG_CPU
	490	.detach = acpi_processor_remove,
	491	#endif
	492	.hotplug = {
	493	.enabled = true,
	494	},
	495	};
	496
	497	void __init acpi_processor_init(void)
	498	{
	499	acpi_scan_add_handler_with_hotplug(&processor_handler, "processor");
	500	}