[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / acpi / numa.c

/*
 *  acpi_numa.c - ACPI NUMA support
 *
 *  Copyright (C) 2002 Takayoshi Kochi <t-kochi@bq.jp.nec.com>
 *
 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 *
 *  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
 *
 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 *
 */
#include <linux/module.h>
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/types.h>
#include <linux/errno.h>
#include <linux/acpi.h>
#include <acpi/acpi_bus.h>
#include <acpi/acmacros.h>

#define ACPI_NUMA	0x80000000
#define _COMPONENT	ACPI_NUMA
ACPI_MODULE_NAME("numa")

static nodemask_t nodes_found_map = NODE_MASK_NONE;
#define PXM_INVAL	-1
#define NID_INVAL	-1

/* maps to convert between proximity domain and logical node ID */
int __cpuinitdata pxm_to_node_map[MAX_PXM_DOMAINS]
				= { [0 ... MAX_PXM_DOMAINS - 1] = NID_INVAL };
int __cpuinitdata node_to_pxm_map[MAX_NUMNODES]
				= { [0 ... MAX_NUMNODES - 1] = PXM_INVAL };

extern int __init acpi_table_parse_madt_family(enum acpi_table_id id,
					       unsigned long madt_size,
					       int entry_id,
					       acpi_madt_entry_handler handler,
					       unsigned int max_entries);

int __cpuinit pxm_to_node(int pxm)
{
	if (pxm < 0)
		return NID_INVAL;
	return pxm_to_node_map[pxm];
}

int __cpuinit node_to_pxm(int node)
{
	if (node < 0)
		return PXM_INVAL;
	return node_to_pxm_map[node];
}

int __cpuinit acpi_map_pxm_to_node(int pxm)
{
	int node = pxm_to_node_map[pxm];

	if (node < 0){
		if (nodes_weight(nodes_found_map) >= MAX_NUMNODES)
			return NID_INVAL;
		node = first_unset_node(nodes_found_map);
		pxm_to_node_map[pxm] = node;
		node_to_pxm_map[node] = pxm;
		node_set(node, nodes_found_map);
	}

	return node;
}

void __cpuinit acpi_unmap_pxm_to_node(int node)
{
	int pxm = node_to_pxm_map[node];
	pxm_to_node_map[pxm] = NID_INVAL;
	node_to_pxm_map[node] = PXM_INVAL;
	node_clear(node, nodes_found_map);
}

void __init acpi_table_print_srat_entry(acpi_table_entry_header * header)
{

	ACPI_FUNCTION_NAME("acpi_table_print_srat_entry");

	if (!header)
		return;

	switch (header->type) {

	case ACPI_SRAT_PROCESSOR_AFFINITY:
#ifdef ACPI_DEBUG_OUTPUT
		{
			struct acpi_table_processor_affinity *p =
			    (struct acpi_table_processor_affinity *)header;
			ACPI_DEBUG_PRINT((ACPI_DB_INFO,
					  "SRAT Processor (id[0x%02x] eid[0x%02x]) in proximity domain %d %s\n",
					  p->apic_id, p->lsapic_eid,
					  p->proximity_domain,
					  p->flags.
					  enabled ? "enabled" : "disabled"));
		}
#endif				/* ACPI_DEBUG_OUTPUT */
		break;

	case ACPI_SRAT_MEMORY_AFFINITY:
#ifdef ACPI_DEBUG_OUTPUT
		{
			struct acpi_table_memory_affinity *p =
			    (struct acpi_table_memory_affinity *)header;
			ACPI_DEBUG_PRINT((ACPI_DB_INFO,
					  "SRAT Memory (0x%08x%08x length 0x%08x%08x type 0x%x) in proximity domain %d %s%s\n",
					  p->base_addr_hi, p->base_addr_lo,
					  p->length_hi, p->length_lo,
					  p->memory_type, p->proximity_domain,
					  p->flags.
					  enabled ? "enabled" : "disabled",
					  p->flags.
					  hot_pluggable ? " hot-pluggable" :
					  ""));
		}
#endif				/* ACPI_DEBUG_OUTPUT */
		break;

	default:
		printk(KERN_WARNING PREFIX
		       "Found unsupported SRAT entry (type = 0x%x)\n",
		       header->type);
		break;
	}
}

static int __init acpi_parse_slit(unsigned long phys_addr, unsigned long size)
{
	struct acpi_table_slit *slit;
	u32 localities;

	if (!phys_addr || !size)
		return -EINVAL;

	slit = (struct acpi_table_slit *)__va(phys_addr);

	/* downcast just for %llu vs %lu for i386/ia64  */
	localities = (u32) slit->localities;

	acpi_numa_slit_init(slit);

	return 0;
}

static int __init
acpi_parse_processor_affinity(acpi_table_entry_header * header,
			      const unsigned long end)
{
	struct acpi_table_processor_affinity *processor_affinity;

	processor_affinity = (struct acpi_table_processor_affinity *)header;
	if (!processor_affinity)
		return -EINVAL;

	acpi_table_print_srat_entry(header);

	/* let architecture-dependent part to do it */
	acpi_numa_processor_affinity_init(processor_affinity);

	return 0;
}

static int __init
acpi_parse_memory_affinity(acpi_table_entry_header * header,
			   const unsigned long end)
{
	struct acpi_table_memory_affinity *memory_affinity;

	memory_affinity = (struct acpi_table_memory_affinity *)header;
	if (!memory_affinity)
		return -EINVAL;

	acpi_table_print_srat_entry(header);

	/* let architecture-dependent part to do it */
	acpi_numa_memory_affinity_init(memory_affinity);

	return 0;
}

static int __init acpi_parse_srat(unsigned long phys_addr, unsigned long size)
{
	struct acpi_table_srat *srat;

	if (!phys_addr || !size)
		return -EINVAL;

	srat = (struct acpi_table_srat *)__va(phys_addr);

	return 0;
}

int __init
acpi_table_parse_srat(enum acpi_srat_entry_id id,
		      acpi_madt_entry_handler handler, unsigned int max_entries)
{
	return acpi_table_parse_madt_family(ACPI_SRAT,
					    sizeof(struct acpi_table_srat), id,
					    handler, max_entries);
}

int __init acpi_numa_init(void)
{
	int result;

	/* SRAT: Static Resource Affinity Table */
	result = acpi_table_parse(ACPI_SRAT, acpi_parse_srat);

	if (result > 0) {
		result = acpi_table_parse_srat(ACPI_SRAT_PROCESSOR_AFFINITY,
					       acpi_parse_processor_affinity,
					       NR_CPUS);
		result = acpi_table_parse_srat(ACPI_SRAT_MEMORY_AFFINITY, acpi_parse_memory_affinity, NR_NODE_MEMBLKS);	// IA64 specific
	}

	/* SLIT: System Locality Information Table */
	result = acpi_table_parse(ACPI_SLIT, acpi_parse_slit);

	acpi_numa_arch_fixup();
	return 0;
}

int acpi_get_pxm(acpi_handle h)
{
	unsigned long pxm;
	acpi_status status;
	acpi_handle handle;
	acpi_handle phandle = h;

	do {
		handle = phandle;
		status = acpi_evaluate_integer(handle, "_PXM", NULL, &pxm);
		if (ACPI_SUCCESS(status))
			return (int)pxm;
		status = acpi_get_parent(handle, &phandle);
	} while (ACPI_SUCCESS(status));
	return -1;
}
EXPORT_SYMBOL(acpi_get_pxm);

int acpi_get_node(acpi_handle *handle)
{
	int pxm, node = -1;

	pxm = acpi_get_pxm(handle);
	if (pxm >= 0)
		node = acpi_map_pxm_to_node(pxm);

	return node;
}
EXPORT_SYMBOL(acpi_get_node);
Commit	Line	Data
1da177e4 LT	1	/*
	2	* acpi_numa.c - ACPI NUMA support
	3	*
	4	* Copyright (C) 2002 Takayoshi Kochi <t-kochi@bq.jp.nec.com>
	5	*
	6	* ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
	7	*
	8	* This program is free software; you can redistribute it and/or modify
	9	* it under the terms of the GNU General Public License as published by
	10	* the Free Software Foundation; either version 2 of the License, or
	11	* (at your option) any later version.
	12	*
	13	* This program is distributed in the hope that it will be useful,
	14	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	15	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	16	* GNU General Public License for more details.
	17	*
	18	* You should have received a copy of the GNU General Public License
	19	* along with this program; if not, write to the Free Software
	20	* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
	21	*
	22	* ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
	23	*
	24	*/
	25	#include <linux/module.h>
1da177e4 LT	26	#include <linux/init.h>
	27	#include <linux/kernel.h>
	28	#include <linux/types.h>
	29	#include <linux/errno.h>
	30	#include <linux/acpi.h>
	31	#include <acpi/acpi_bus.h>
	32	#include <acpi/acmacros.h>
	33
	34	#define ACPI_NUMA 0x80000000
	35	#define _COMPONENT ACPI_NUMA
4be44fcd	36	ACPI_MODULE_NAME("numa")
1da177e4	37
762834e8 YG	38	static nodemask_t nodes_found_map = NODE_MASK_NONE;
	39	#define PXM_INVAL -1
	40	#define NID_INVAL -1
	41
	42	/* maps to convert between proximity domain and logical node ID */
	43	int __cpuinitdata pxm_to_node_map[MAX_PXM_DOMAINS]
	44	= { [0 ... MAX_PXM_DOMAINS - 1] = NID_INVAL };
	45	int __cpuinitdata node_to_pxm_map[MAX_NUMNODES]
	46	= { [0 ... MAX_NUMNODES - 1] = PXM_INVAL };
	47
4be44fcd LB	48	extern int __init acpi_table_parse_madt_family(enum acpi_table_id id,
	49	unsigned long madt_size,
	50	int entry_id,
	51	acpi_madt_entry_handler handler,
	52	unsigned int max_entries);
1da177e4	53
762834e8 YG	54	int __cpuinit pxm_to_node(int pxm)
	55	{
	56	if (pxm < 0)
	57	return NID_INVAL;
	58	return pxm_to_node_map[pxm];
	59	}
	60
	61	int __cpuinit node_to_pxm(int node)
	62	{
	63	if (node < 0)
	64	return PXM_INVAL;
	65	return node_to_pxm_map[node];
	66	}
	67
	68	int __cpuinit acpi_map_pxm_to_node(int pxm)
	69	{
	70	int node = pxm_to_node_map[pxm];
	71
	72	if (node < 0){
	73	if (nodes_weight(nodes_found_map) >= MAX_NUMNODES)
	74	return NID_INVAL;
	75	node = first_unset_node(nodes_found_map);
	76	pxm_to_node_map[pxm] = node;
	77	node_to_pxm_map[node] = pxm;
	78	node_set(node, nodes_found_map);
	79	}
	80
	81	return node;
	82	}
	83
	84	void __cpuinit acpi_unmap_pxm_to_node(int node)
	85	{
	86	int pxm = node_to_pxm_map[node];
	87	pxm_to_node_map[pxm] = NID_INVAL;
	88	node_to_pxm_map[node] = PXM_INVAL;
	89	node_clear(node, nodes_found_map);
	90	}
	91
4be44fcd	92	void __init acpi_table_print_srat_entry(acpi_table_entry_header * header)
1da177e4 LT	93	{
1da177e4 LT	94
4be44fcd	95	ACPI_FUNCTION_NAME("acpi_table_print_srat_entry");
1da177e4 LT	96
	97	if (!header)
	98	return;
	99
	100	switch (header->type) {
	101
	102	case ACPI_SRAT_PROCESSOR_AFFINITY:
	103	#ifdef ACPI_DEBUG_OUTPUT
4be44fcd LB	104	{
	105	struct acpi_table_processor_affinity *p =
	106	(struct acpi_table_processor_affinity *)header;
	107	ACPI_DEBUG_PRINT((ACPI_DB_INFO,
	108	"SRAT Processor (id[0x%02x] eid[0x%02x]) in proximity domain %d %s\n",
	109	p->apic_id, p->lsapic_eid,
	110	p->proximity_domain,
	111	p->flags.
	112	enabled ? "enabled" : "disabled"));
	113	}
	114	#endif /* ACPI_DEBUG_OUTPUT */
1da177e4 LT	115	break;
	116
	117	case ACPI_SRAT_MEMORY_AFFINITY:
	118	#ifdef ACPI_DEBUG_OUTPUT
4be44fcd LB	119	{
	120	struct acpi_table_memory_affinity *p =
	121	(struct acpi_table_memory_affinity *)header;
	122	ACPI_DEBUG_PRINT((ACPI_DB_INFO,
	123	"SRAT Memory (0x%08x%08x length 0x%08x%08x type 0x%x) in proximity domain %d %s%s\n",
	124	p->base_addr_hi, p->base_addr_lo,
	125	p->length_hi, p->length_lo,
	126	p->memory_type, p->proximity_domain,
	127	p->flags.
	128	enabled ? "enabled" : "disabled",
	129	p->flags.
	130	hot_pluggable ? " hot-pluggable" :
	131	""));
	132	}
	133	#endif /* ACPI_DEBUG_OUTPUT */
1da177e4 LT	134	break;
	135
	136	default:
4be44fcd LB	137	printk(KERN_WARNING PREFIX
	138	"Found unsupported SRAT entry (type = 0x%x)\n",
	139	header->type);
1da177e4 LT	140	break;
	141	}
	142	}
	143
4be44fcd	144	static int __init acpi_parse_slit(unsigned long phys_addr, unsigned long size)
1da177e4	145	{
4be44fcd LB	146	struct acpi_table_slit *slit;
4be44fcd LB	147	u32 localities;
1da177e4 LT	148
	149	if (!phys_addr \|\| !size)
	150	return -EINVAL;
	151
4be44fcd	152	slit = (struct acpi_table_slit *)__va(phys_addr);
1da177e4 LT	153
	154	/* downcast just for %llu vs %lu for i386/ia64 */
	155	localities = (u32) slit->localities;
	156
	157	acpi_numa_slit_init(slit);
	158
	159	return 0;
	160	}
	161
1da177e4	162	static int __init
4be44fcd LB	163	acpi_parse_processor_affinity(acpi_table_entry_header * header,
4be44fcd LB	164	const unsigned long end)
1da177e4 LT	165	{
	166	struct acpi_table_processor_affinity *processor_affinity;
	167
4be44fcd	168	processor_affinity = (struct acpi_table_processor_affinity *)header;
1da177e4 LT	169	if (!processor_affinity)
	170	return -EINVAL;
	171
	172	acpi_table_print_srat_entry(header);
	173
	174	/* let architecture-dependent part to do it */
	175	acpi_numa_processor_affinity_init(processor_affinity);
	176
	177	return 0;
	178	}
	179
1da177e4	180	static int __init
4be44fcd LB	181	acpi_parse_memory_affinity(acpi_table_entry_header * header,
4be44fcd LB	182	const unsigned long end)
1da177e4 LT	183	{
	184	struct acpi_table_memory_affinity *memory_affinity;
	185
4be44fcd	186	memory_affinity = (struct acpi_table_memory_affinity *)header;
1da177e4 LT	187	if (!memory_affinity)
	188	return -EINVAL;
	189
	190	acpi_table_print_srat_entry(header);
	191
	192	/* let architecture-dependent part to do it */
	193	acpi_numa_memory_affinity_init(memory_affinity);
	194
	195	return 0;
	196	}
	197
4be44fcd	198	static int __init acpi_parse_srat(unsigned long phys_addr, unsigned long size)
1da177e4	199	{
4be44fcd	200	struct acpi_table_srat *srat;
1da177e4 LT	201
	202	if (!phys_addr \|\| !size)
	203	return -EINVAL;
	204
4be44fcd	205	srat = (struct acpi_table_srat *)__va(phys_addr);
1da177e4 LT	206
	207	return 0;
	208	}
	209
1da177e4	210	int __init
4be44fcd LB	211	acpi_table_parse_srat(enum acpi_srat_entry_id id,
4be44fcd LB	212	acpi_madt_entry_handler handler, unsigned int max_entries)
1da177e4	213	{
4be44fcd LB	214	return acpi_table_parse_madt_family(ACPI_SRAT,
	215	sizeof(struct acpi_table_srat), id,
	216	handler, max_entries);
1da177e4 LT	217	}
1da177e4 LT	218
4be44fcd	219	int __init acpi_numa_init(void)
1da177e4	220	{
4be44fcd	221	int result;
1da177e4 LT	222
	223	/* SRAT: Static Resource Affinity Table */
	224	result = acpi_table_parse(ACPI_SRAT, acpi_parse_srat);
	225
	226	if (result > 0) {
	227	result = acpi_table_parse_srat(ACPI_SRAT_PROCESSOR_AFFINITY,
	228	acpi_parse_processor_affinity,
	229	NR_CPUS);
4be44fcd	230	result = acpi_table_parse_srat(ACPI_SRAT_MEMORY_AFFINITY, acpi_parse_memory_affinity, NR_NODE_MEMBLKS); // IA64 specific
1da177e4 LT	231	}
	232
	233	/* SLIT: System Locality Information Table */
	234	result = acpi_table_parse(ACPI_SLIT, acpi_parse_slit);
	235
	236	acpi_numa_arch_fixup();
	237	return 0;
	238	}
	239
4be44fcd	240	int acpi_get_pxm(acpi_handle h)
1da177e4 LT	241	{
	242	unsigned long pxm;
	243	acpi_status status;
	244	acpi_handle handle;
	245	acpi_handle phandle = h;
	246
	247	do {
	248	handle = phandle;
	249	status = acpi_evaluate_integer(handle, "_PXM", NULL, &pxm);
	250	if (ACPI_SUCCESS(status))
	251	return (int)pxm;
	252	status = acpi_get_parent(handle, &phandle);
4be44fcd	253	} while (ACPI_SUCCESS(status));
1da177e4 LT	254	return -1;
	255	}
	256	EXPORT_SYMBOL(acpi_get_pxm);
1e3590e2 YG	257
	258	int acpi_get_node(acpi_handle *handle)
	259	{
	260	int pxm, node = -1;
	261
1e3590e2 YG	262	pxm = acpi_get_pxm(handle);
	263	if (pxm >= 0)
	264	node = acpi_map_pxm_to_node(pxm);
	265
635227ee	266	return node;
1e3590e2 YG	267	}
1e3590e2 YG	268	EXPORT_SYMBOL(acpi_get_node);