[linux-2.6-block.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;

	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");
		return -ENODEV;
	}
	pr->apic_id = apic_id;

	cpu_index = acpi_map_cpuid(pr->apic_id, pr->acpi_id);
	if (!cpu0_initialized) {
		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;
	dev->offline = pr->flags.need_hotplug_init;

	/* 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
	173	status = acpi_evaluate_integer(pr->handle, "_STA", NULL, &sta);
	174	if (ACPI_FAILURE(status) \|\| !(sta & ACPI_STA_DEVICE_PRESENT))
	175	return -ENODEV;
	176
b9d10be7 TK	177	cpu_maps_update_begin();
	178	cpu_hotplug_begin();
	179
d536bf3d	180	ret = acpi_map_lsapic(pr->handle, pr->apic_id, &pr->id);
ac212b69	181	if (ret)
b9d10be7	182	goto out;
ac212b69 RW	183
	184	ret = arch_register_cpu(pr->id);
	185	if (ret) {
	186	acpi_unmap_lsapic(pr->id);
b9d10be7	187	goto out;
ac212b69 RW	188	}
	189
	190	/*
	191	* CPU got hot-added, but cpu_data is not initialized yet. Set a flag
	192	* to delay cpu_idle/throttling initialization and do it when the CPU
	193	* gets online for the first time.
	194	*/
	195	pr_info("CPU%d has been hot-added\n", pr->id);
	196	pr->flags.need_hotplug_init = 1;
b9d10be7 TK	197
	198	out:
	199	cpu_hotplug_done();
	200	cpu_maps_update_done();
	201	return ret;
ac212b69 RW	202	}
	203	#else
	204	static inline int acpi_processor_hotadd_init(struct acpi_processor *pr)
	205	{
	206	return -ENODEV;
	207	}
	208	#endif /* CONFIG_ACPI_HOTPLUG_CPU */
	209
	210	static int acpi_processor_get_info(struct acpi_device *device)
	211	{
	212	union acpi_object object = { 0 };
	213	struct acpi_buffer buffer = { sizeof(union acpi_object), &object };
	214	struct acpi_processor *pr = acpi_driver_data(device);
b981513f	215	int apic_id, cpu_index, device_declaration = 0;
ac212b69 RW	216	acpi_status status = AE_OK;
ac212b69 RW	217	static int cpu0_initialized;
6ebb5bc9	218	unsigned long long value;
ac212b69	219
082e12a0	220	acpi_processor_errata();
ac212b69 RW	221
	222	/*
	223	* Check to see if we have bus mastering arbitration control. This
	224	* is required for proper C3 usage (to maintain cache coherency).
	225	*/
	226	if (acpi_gbl_FADT.pm2_control_block && acpi_gbl_FADT.pm2_control_length) {
	227	pr->flags.bm_control = 1;
	228	ACPI_DEBUG_PRINT((ACPI_DB_INFO,
	229	"Bus mastering arbitration control present\n"));
	230	} else
	231	ACPI_DEBUG_PRINT((ACPI_DB_INFO,
	232	"No bus mastering arbitration control\n"));
	233
	234	if (!strcmp(acpi_device_hid(device), ACPI_PROCESSOR_OBJECT_HID)) {
	235	/* Declared with "Processor" statement; match ProcessorID */
	236	status = acpi_evaluate_object(pr->handle, NULL, NULL, &buffer);
	237	if (ACPI_FAILURE(status)) {
	238	dev_err(&device->dev,
	239	"Failed to evaluate processor object (0x%x)\n",
	240	status);
	241	return -ENODEV;
	242	}
	243
ac212b69 RW	244	pr->acpi_id = object.processor.proc_id;
	245	} else {
	246	/*
	247	* Declared with "Device" statement; match _UID.
	248	* Note that we don't handle string _UIDs yet.
	249	*/
ac212b69 RW	250	status = acpi_evaluate_integer(pr->handle, METHOD_NAME__UID,
	251	NULL, &value);
	252	if (ACPI_FAILURE(status)) {
	253	dev_err(&device->dev,
	254	"Failed to evaluate processor _UID (0x%x)\n",
	255	status);
	256	return -ENODEV;
	257	}
	258	device_declaration = 1;
	259	pr->acpi_id = value;
	260	}
ac212b69	261
b981513f JL	262	apic_id = acpi_get_apicid(pr->handle, device_declaration, pr->acpi_id);
b981513f JL	263	if (apic_id < 0) {
f778d121	264	acpi_handle_debug(pr->handle, "failed to get CPU APIC ID.\n");
b981513f	265	return -ENODEV;
ac212b69	266	}
b981513f	267	pr->apic_id = apic_id;
ac212b69	268
b981513f JL	269	cpu_index = acpi_map_cpuid(pr->apic_id, pr->acpi_id);
	270	if (!cpu0_initialized) {
	271	cpu0_initialized = 1;
	272	/* Handle UP system running SMP kernel, with no LAPIC in MADT */
	273	if ((cpu_index == -1) && (num_online_cpus() == 1))
	274	cpu_index = 0;
	275	}
ac212b69 RW	276	pr->id = cpu_index;
	277
	278	/*
	279	* Extra Processor objects may be enumerated on MP systems with
	280	* less than the max # of CPUs. They should be ignored _iff
	281	* they are physically not present.
	282	*/
	283	if (pr->id == -1) {
	284	int ret = acpi_processor_hotadd_init(pr);
	285	if (ret)
	286	return ret;
	287	}
b981513f	288
ac212b69 RW	289	/*
	290	* On some boxes several processors use the same processor bus id.
	291	* But they are located in different scope. For example:
	292	* \_SB.SCK0.CPU0
	293	* \_SB.SCK1.CPU0
	294	* Rename the processor device bus id. And the new bus id will be
	295	* generated as the following format:
	296	* CPU+CPU ID.
	297	*/
	298	sprintf(acpi_device_bid(device), "CPU%X", pr->id);
	299	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Processor [%d:%d]\n", pr->id,
	300	pr->acpi_id));
	301
	302	if (!object.processor.pblk_address)
	303	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "No PBLK (NULL address)\n"));
	304	else if (object.processor.pblk_length != 6)
	305	dev_err(&device->dev, "Invalid PBLK length [%d]\n",
	306	object.processor.pblk_length);
	307	else {
	308	pr->throttling.address = object.processor.pblk_address;
	309	pr->throttling.duty_offset = acpi_gbl_FADT.duty_offset;
	310	pr->throttling.duty_width = acpi_gbl_FADT.duty_width;
	311
	312	pr->pblk = object.processor.pblk_address;
	313
	314	/*
	315	* We don't care about error returns - we just try to mark
	316	* these reserved so that nobody else is confused into thinking
	317	* that this region might be unused..
	318	*
	319	* (In particular, allocating the IO range for Cardbus)
	320	*/
	321	request_region(pr->throttling.address, 6, "ACPI CPU throttle");
	322	}
	323
	324	/*
	325	* If ACPI describes a slot number for this CPU, we can use it to
	326	* ensure we get the right value in the "physical id" field
	327	* of /proc/cpuinfo
	328	*/
6ebb5bc9	329	status = acpi_evaluate_integer(pr->handle, "_SUN", NULL, &value);
ac212b69	330	if (ACPI_SUCCESS(status))
6ebb5bc9	331	arch_fix_phys_package_id(pr->id, value);
ac212b69 RW	332
	333	return 0;
	334	}
	335
	336	/*
	337	* Do not put anything in here which needs the core to be online.
	338	* For example MSR access or setting up things which check for cpuinfo_x86
	339	* (cpu_data(cpu)) values, like CPU feature flags, family, model, etc.
	340	* Such things have to be put in and set up by the processor driver's .probe().
	341	*/
	342	static DEFINE_PER_CPU(void *, processor_device_array);
	343
fe7bf106	344	static int acpi_processor_add(struct acpi_device *device,
ac212b69 RW	345	const struct acpi_device_id *id)
	346	{
	347	struct acpi_processor *pr;
	348	struct device *dev;
	349	int result = 0;
	350
	351	pr = kzalloc(sizeof(struct acpi_processor), GFP_KERNEL);
	352	if (!pr)
	353	return -ENOMEM;
	354
	355	if (!zalloc_cpumask_var(&pr->throttling.shared_cpu_map, GFP_KERNEL)) {
	356	result = -ENOMEM;
	357	goto err_free_pr;
	358	}
	359
	360	pr->handle = device->handle;
	361	strcpy(acpi_device_name(device), ACPI_PROCESSOR_DEVICE_NAME);
	362	strcpy(acpi_device_class(device), ACPI_PROCESSOR_CLASS);
	363	device->driver_data = pr;
	364
	365	result = acpi_processor_get_info(device);
	366	if (result) /* Processor is not physically present or unavailable */
	367	return 0;
	368
	369	#ifdef CONFIG_SMP
	370	if (pr->id >= setup_max_cpus && pr->id != 0)
	371	return 0;
	372	#endif
	373
	374	BUG_ON(pr->id >= nr_cpu_ids);
	375
	376	/*
	377	* Buggy BIOS check.
	378	* ACPI id of processors can be reported wrongly by the BIOS.
	379	* Don't trust it blindly
	380	*/
	381	if (per_cpu(processor_device_array, pr->id) != NULL &&
	382	per_cpu(processor_device_array, pr->id) != device) {
	383	dev_warn(&device->dev,
	384	"BIOS reported wrong ACPI id %d for the processor\n",
	385	pr->id);
	386	/* Give up, but do not abort the namespace scan. */
	387	goto err;
	388	}
	389	/*
	390	* processor_device_array is not cleared on errors to allow buggy BIOS
	391	* checks.
	392	*/
	393	per_cpu(processor_device_array, pr->id) = device;
2e4f1db4	394	per_cpu(processors, pr->id) = pr;
ac212b69 RW	395
ac212b69 RW	396	dev = get_cpu_device(pr->id);
173a5a4c HG	397	if (!dev) {
	398	result = -ENODEV;
	399	goto err;
	400	}
	401
24dee1fc	402	result = acpi_bind_one(dev, device);
ac212b69 RW	403	if (result)
	404	goto err;
	405
	406	pr->dev = dev;
	407	dev->offline = pr->flags.need_hotplug_init;
	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	}