[GitHub/mt8127/android_kernel_alcatel_ttab.git] / arch / mips / sgi-ip27 / ip27-memory.c

/*
 * This file is subject to the terms and conditions of the GNU General Public
 * License.  See the file "COPYING" in the main directory of this archive
 * for more details.
 *
 * Copyright (C) 2000, 05 by Ralf Baechle (ralf@linux-mips.org)
 * Copyright (C) 2000 by Silicon Graphics, Inc.
 * Copyright (C) 2004 by Christoph Hellwig
 *
 * On SGI IP27 the ARC memory configuration data is completly bogus but
 * alternate easier to use mechanisms are available.
 */
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/memblock.h>
#include <linux/mm.h>
#include <linux/mmzone.h>
#include <linux/module.h>
#include <linux/nodemask.h>
#include <linux/swap.h>
#include <linux/bootmem.h>
#include <linux/pfn.h>
#include <linux/highmem.h>
#include <asm/page.h>
#include <asm/pgalloc.h>
#include <asm/sections.h>

#include <asm/sn/arch.h>
#include <asm/sn/hub.h>
#include <asm/sn/klconfig.h>
#include <asm/sn/sn_private.h>


#define SLOT_PFNSHIFT		(SLOT_SHIFT - PAGE_SHIFT)
#define PFN_NASIDSHFT		(NASID_SHFT - PAGE_SHIFT)

struct node_data *__node_data[MAX_COMPACT_NODES];

EXPORT_SYMBOL(__node_data);

static int fine_mode;

static int is_fine_dirmode(void)
{
	return (((LOCAL_HUB_L(NI_STATUS_REV_ID) & NSRI_REGIONSIZE_MASK)
		>> NSRI_REGIONSIZE_SHFT) & REGIONSIZE_FINE);
}

static hubreg_t get_region(cnodeid_t cnode)
{
	if (fine_mode)
		return COMPACT_TO_NASID_NODEID(cnode) >> NASID_TO_FINEREG_SHFT;
	else
		return COMPACT_TO_NASID_NODEID(cnode) >> NASID_TO_COARSEREG_SHFT;
}

static hubreg_t region_mask;

static void gen_region_mask(hubreg_t *region_mask)
{
	cnodeid_t cnode;

	(*region_mask) = 0;
	for_each_online_node(cnode) {
		(*region_mask) |= 1ULL << get_region(cnode);
	}
}

#define rou_rflag	rou_flags

static int router_distance;

static void router_recurse(klrou_t *router_a, klrou_t *router_b, int depth)
{
	klrou_t *router;
	lboard_t *brd;
	int	port;

	if (router_a->rou_rflag == 1)
		return;

	if (depth >= router_distance)
		return;

	router_a->rou_rflag = 1;

	for (port = 1; port <= MAX_ROUTER_PORTS; port++) {
		if (router_a->rou_port[port].port_nasid == INVALID_NASID)
			continue;

		brd = (lboard_t *)NODE_OFFSET_TO_K0(
			router_a->rou_port[port].port_nasid,
			router_a->rou_port[port].port_offset);

		if (brd->brd_type == KLTYPE_ROUTER) {
			router = (klrou_t *)NODE_OFFSET_TO_K0(NASID_GET(brd), brd->brd_compts[0]);
			if (router == router_b) {
				if (depth < router_distance)
					router_distance = depth;
			}
			else
				router_recurse(router, router_b, depth + 1);
		}
	}

	router_a->rou_rflag = 0;
}

unsigned char __node_distances[MAX_COMPACT_NODES][MAX_COMPACT_NODES];

static int __init compute_node_distance(nasid_t nasid_a, nasid_t nasid_b)
{
	klrou_t *router, *router_a = NULL, *router_b = NULL;
	lboard_t *brd, *dest_brd;
	cnodeid_t cnode;
	nasid_t nasid;
	int port;

	/* Figure out which routers nodes in question are connected to */
	for_each_online_node(cnode) {
		nasid = COMPACT_TO_NASID_NODEID(cnode);

		if (nasid == -1) continue;

		brd = find_lboard_class((lboard_t *)KL_CONFIG_INFO(nasid),
					KLTYPE_ROUTER);

		if (!brd)
			continue;

		do {
			if (brd->brd_flags & DUPLICATE_BOARD)
				continue;

			router = (klrou_t *)NODE_OFFSET_TO_K0(NASID_GET(brd), brd->brd_compts[0]);
			router->rou_rflag = 0;

			for (port = 1; port <= MAX_ROUTER_PORTS; port++) {
				if (router->rou_port[port].port_nasid == INVALID_NASID)
					continue;

				dest_brd = (lboard_t *)NODE_OFFSET_TO_K0(
					router->rou_port[port].port_nasid,
					router->rou_port[port].port_offset);

				if (dest_brd->brd_type == KLTYPE_IP27) {
					if (dest_brd->brd_nasid == nasid_a)
						router_a = router;
					if (dest_brd->brd_nasid == nasid_b)
						router_b = router;
				}
			}

		} while ((brd = find_lboard_class(KLCF_NEXT(brd), KLTYPE_ROUTER)));
	}

	if (router_a == NULL) {
		printk("node_distance: router_a NULL\n");
		return -1;
	}
	if (router_b == NULL) {
		printk("node_distance: router_b NULL\n");
		return -1;
	}

	if (nasid_a == nasid_b)
		return 0;

	if (router_a == router_b)
		return 1;

	router_distance = 100;
	router_recurse(router_a, router_b, 2);

	return router_distance;
}

static void __init init_topology_matrix(void)
{
	nasid_t nasid, nasid2;
	cnodeid_t row, col;

	for (row = 0; row < MAX_COMPACT_NODES; row++)
		for (col = 0; col < MAX_COMPACT_NODES; col++)
			__node_distances[row][col] = -1;

	for_each_online_node(row) {
		nasid = COMPACT_TO_NASID_NODEID(row);
		for_each_online_node(col) {
			nasid2 = COMPACT_TO_NASID_NODEID(col);
			__node_distances[row][col] =
				compute_node_distance(nasid, nasid2);
		}
	}
}

static void __init dump_topology(void)
{
	nasid_t nasid;
	cnodeid_t cnode;
	lboard_t *brd, *dest_brd;
	int port;
	int router_num = 0;
	klrou_t *router;
	cnodeid_t row, col;

	printk("************** Topology ********************\n");

	printk("    ");
	for_each_online_node(col)
		printk("%02d ", col);
	printk("\n");
	for_each_online_node(row) {
		printk("%02d  ", row);
		for_each_online_node(col)
			printk("%2d ", node_distance(row, col));
		printk("\n");
	}

	for_each_online_node(cnode) {
		nasid = COMPACT_TO_NASID_NODEID(cnode);

		if (nasid == -1) continue;

		brd = find_lboard_class((lboard_t *)KL_CONFIG_INFO(nasid),
					KLTYPE_ROUTER);

		if (!brd)
			continue;

		do {
			if (brd->brd_flags & DUPLICATE_BOARD)
				continue;
			printk("Router %d:", router_num);
			router_num++;

			router = (klrou_t *)NODE_OFFSET_TO_K0(NASID_GET(brd), brd->brd_compts[0]);

			for (port = 1; port <= MAX_ROUTER_PORTS; port++) {
				if (router->rou_port[port].port_nasid == INVALID_NASID)
					continue;

				dest_brd = (lboard_t *)NODE_OFFSET_TO_K0(
					router->rou_port[port].port_nasid,
					router->rou_port[port].port_offset);

				if (dest_brd->brd_type == KLTYPE_IP27)
					printk(" %d", dest_brd->brd_nasid);
				if (dest_brd->brd_type == KLTYPE_ROUTER)
					printk(" r");
			}
			printk("\n");

		} while ( (brd = find_lboard_class(KLCF_NEXT(brd), KLTYPE_ROUTER)) );
	}
}

static unsigned long __init slot_getbasepfn(cnodeid_t cnode, int slot)
{
	nasid_t nasid = COMPACT_TO_NASID_NODEID(cnode);

	return ((unsigned long)nasid << PFN_NASIDSHFT) | (slot << SLOT_PFNSHIFT);
}

static unsigned long __init slot_psize_compute(cnodeid_t node, int slot)
{
	nasid_t nasid;
	lboard_t *brd;
	klmembnk_t *banks;
	unsigned long size;

	nasid = COMPACT_TO_NASID_NODEID(node);
	/* Find the node board */
	brd = find_lboard((lboard_t *)KL_CONFIG_INFO(nasid), KLTYPE_IP27);
	if (!brd)
		return 0;

	/* Get the memory bank structure */
	banks = (klmembnk_t *) find_first_component(brd, KLSTRUCT_MEMBNK);
	if (!banks)
		return 0;

	/* Size in _Megabytes_ */
	size = (unsigned long)banks->membnk_bnksz[slot/4];

	/* hack for 128 dimm banks */
	if (size <= 128) {
		if (slot % 4 == 0) {
			size <<= 20;		/* size in bytes */
			return(size >> PAGE_SHIFT);
		} else
			return 0;
	} else {
		size /= 4;
		size <<= 20;
		return size >> PAGE_SHIFT;
	}
}

static void __init mlreset(void)
{
	int i;

	master_nasid = get_nasid();
	fine_mode = is_fine_dirmode();

	/*
	 * Probe for all CPUs - this creates the cpumask and sets up the
	 * mapping tables.  We need to do this as early as possible.
	 */
#ifdef CONFIG_SMP
	cpu_node_probe();
#endif

	init_topology_matrix();
	dump_topology();

	gen_region_mask(&region_mask);

	setup_replication_mask();

	/*
	 * Set all nodes' calias sizes to 8k
	 */
	for_each_online_node(i) {
		nasid_t nasid;

		nasid = COMPACT_TO_NASID_NODEID(i);

		/*
		 * Always have node 0 in the region mask, otherwise
		 * CALIAS accesses get exceptions since the hub
		 * thinks it is a node 0 address.
		 */
		REMOTE_HUB_S(nasid, PI_REGION_PRESENT, (region_mask | 1));
#ifdef CONFIG_REPLICATE_EXHANDLERS
		REMOTE_HUB_S(nasid, PI_CALIAS_SIZE, PI_CALIAS_SIZE_8K);
#else
		REMOTE_HUB_S(nasid, PI_CALIAS_SIZE, PI_CALIAS_SIZE_0);
#endif

#ifdef LATER
		/*
		 * Set up all hubs to have a big window pointing at
		 * widget 0. Memory mode, widget 0, offset 0
		 */
		REMOTE_HUB_S(nasid, IIO_ITTE(SWIN0_BIGWIN),
			((HUB_PIO_MAP_TO_MEM << IIO_ITTE_IOSP_SHIFT) |
			(0 << IIO_ITTE_WIDGET_SHIFT)));
#endif
	}
}

static void __init szmem(void)
{
	unsigned long slot_psize, slot0sz = 0, nodebytes;	/* Hack to detect problem configs */
	int slot;
	cnodeid_t node;

	num_physpages = 0;

	for_each_online_node(node) {
		nodebytes = 0;
		for (slot = 0; slot < MAX_MEM_SLOTS; slot++) {
			slot_psize = slot_psize_compute(node, slot);
			if (slot == 0)
				slot0sz = slot_psize;
			/*
			 * We need to refine the hack when we have replicated
			 * kernel text.
			 */
			nodebytes += (1LL << SLOT_SHIFT);

			if (!slot_psize)
				continue;

			if ((nodebytes >> PAGE_SHIFT) * (sizeof(struct page)) >
						(slot0sz << PAGE_SHIFT)) {
				printk("Ignoring slot %d onwards on node %d\n",
								slot, node);
				slot = MAX_MEM_SLOTS;
				continue;
			}
			num_physpages += slot_psize;
			memblock_add_node(PFN_PHYS(slot_getbasepfn(node, slot)),
					  PFN_PHYS(slot_psize), node);
		}
	}
}

static void __init node_mem_init(cnodeid_t node)
{
	unsigned long slot_firstpfn = slot_getbasepfn(node, 0);
	unsigned long slot_freepfn = node_getfirstfree(node);
	unsigned long bootmap_size;
	unsigned long start_pfn, end_pfn;

	get_pfn_range_for_nid(node, &start_pfn, &end_pfn);

	/*
	 * Allocate the node data structures on the node first.
	 */
	__node_data[node] = __va(slot_freepfn << PAGE_SHIFT);
	memset(__node_data[node], 0, PAGE_SIZE);

	NODE_DATA(node)->bdata = &bootmem_node_data[node];
	NODE_DATA(node)->node_start_pfn = start_pfn;
	NODE_DATA(node)->node_spanned_pages = end_pfn - start_pfn;

	cpus_clear(hub_data(node)->h_cpus);

	slot_freepfn += PFN_UP(sizeof(struct pglist_data) +
			       sizeof(struct hub_data));

	bootmap_size = init_bootmem_node(NODE_DATA(node), slot_freepfn,
					start_pfn, end_pfn);
	free_bootmem_with_active_regions(node, end_pfn);
	reserve_bootmem_node(NODE_DATA(node), slot_firstpfn << PAGE_SHIFT,
		((slot_freepfn - slot_firstpfn) << PAGE_SHIFT) + bootmap_size,
		BOOTMEM_DEFAULT);
	sparse_memory_present_with_active_regions(node);
}

/*
 * A node with nothing.	 We use it to avoid any special casing in
 * cpumask_of_node
 */
static struct node_data null_node = {
	.hub = {
		.h_cpus = CPU_MASK_NONE
	}
};

/*
 * Currently, the intranode memory hole support assumes that each slot
 * contains at least 32 MBytes of memory. We assume all bootmem data
 * fits on the first slot.
 */
void __init prom_meminit(void)
{
	cnodeid_t node;

	mlreset();
	szmem();

	for (node = 0; node < MAX_COMPACT_NODES; node++) {
		if (node_online(node)) {
			node_mem_init(node);
			continue;
		}
		__node_data[node] = &null_node;
	}
}

void __init prom_free_prom_memory(void)
{
	/* We got nothing to free here ...  */
}

extern void setup_zero_pages(void);

void __init paging_init(void)
{
	unsigned long zones_size[MAX_NR_ZONES] = {0, };
	unsigned node;

	pagetable_init();

	for_each_online_node(node) {
		unsigned long start_pfn, end_pfn;

		get_pfn_range_for_nid(node, &start_pfn, &end_pfn);

		if (end_pfn > max_low_pfn)
			max_low_pfn = end_pfn;
	}
	zones_size[ZONE_NORMAL] = max_low_pfn;
	free_area_init_nodes(zones_size);
}

void __init mem_init(void)
{
	unsigned long codesize, datasize, initsize, tmp;
	unsigned node;

	high_memory = (void *) __va(num_physpages << PAGE_SHIFT);

	for_each_online_node(node) {
		/*
		 * This will free up the bootmem, ie, slot 0 memory.
		 */
		totalram_pages += free_all_bootmem_node(NODE_DATA(node));
	}

	setup_zero_pages();	/* This comes from node 0 */

	codesize =  (unsigned long) &_etext - (unsigned long) &_text;
	datasize =  (unsigned long) &_edata - (unsigned long) &_etext;
	initsize =  (unsigned long) &__init_end - (unsigned long) &__init_begin;

	tmp = nr_free_pages();
	printk(KERN_INFO "Memory: %luk/%luk available (%ldk kernel code, "
	       "%ldk reserved, %ldk data, %ldk init, %ldk highmem)\n",
	       tmp << (PAGE_SHIFT-10),
	       num_physpages << (PAGE_SHIFT-10),
	       codesize >> 10,
	       (num_physpages - tmp) << (PAGE_SHIFT-10),
	       datasize >> 10,
	       initsize >> 10,
	       totalhigh_pages << (PAGE_SHIFT-10));
}
Commit	Line	Data
1da177e4 LT	1	/*
	2	* This file is subject to the terms and conditions of the GNU General Public
	3	* License. See the file "COPYING" in the main directory of this archive
	4	* for more details.
	5	*
	6	* Copyright (C) 2000, 05 by Ralf Baechle (ralf@linux-mips.org)
	7	* Copyright (C) 2000 by Silicon Graphics, Inc.
	8	* Copyright (C) 2004 by Christoph Hellwig
	9	*
	10	* On SGI IP27 the ARC memory configuration data is completly bogus but
	11	* alternate easier to use mechanisms are available.
	12	*/
1da177e4 LT	13	#include <linux/init.h>
1da177e4 LT	14	#include <linux/kernel.h>
9d15ffc8	15	#include <linux/memblock.h>
1da177e4 LT	16	#include <linux/mm.h>
	17	#include <linux/mmzone.h>
	18	#include <linux/module.h>
	19	#include <linux/nodemask.h>
	20	#include <linux/swap.h>
	21	#include <linux/bootmem.h>
22a9835c	22	#include <linux/pfn.h>
c1f60a5a	23	#include <linux/highmem.h>
1da177e4	24	#include <asm/page.h>
6a1e5529	25	#include <asm/pgalloc.h>
1da177e4 LT	26	#include <asm/sections.h>
	27
	28	#include <asm/sn/arch.h>
	29	#include <asm/sn/hub.h>
	30	#include <asm/sn/klconfig.h>
	31	#include <asm/sn/sn_private.h>
	32
	33
70342287 RB	34	#define SLOT_PFNSHIFT (SLOT_SHIFT - PAGE_SHIFT)
70342287 RB	35	#define PFN_NASIDSHFT (NASID_SHFT - PAGE_SHIFT)
1da177e4	36
1da177e4 LT	37	struct node_data *__node_data[MAX_COMPACT_NODES];
	38
	39	EXPORT_SYMBOL(__node_data);
	40
	41	static int fine_mode;
	42
	43	static int is_fine_dirmode(void)
	44	{
	45	return (((LOCAL_HUB_L(NI_STATUS_REV_ID) & NSRI_REGIONSIZE_MASK)
70342287	46	>> NSRI_REGIONSIZE_SHFT) & REGIONSIZE_FINE);
1da177e4 LT	47	}
	48
	49	static hubreg_t get_region(cnodeid_t cnode)
	50	{
	51	if (fine_mode)
	52	return COMPACT_TO_NASID_NODEID(cnode) >> NASID_TO_FINEREG_SHFT;
	53	else
	54	return COMPACT_TO_NASID_NODEID(cnode) >> NASID_TO_COARSEREG_SHFT;
	55	}
	56
	57	static hubreg_t region_mask;
	58
	59	static void gen_region_mask(hubreg_t *region_mask)
	60	{
	61	cnodeid_t cnode;
	62
	63	(*region_mask) = 0;
	64	for_each_online_node(cnode) {
	65	(*region_mask) \|= 1ULL << get_region(cnode);
	66	}
	67	}
	68
70342287	69	#define rou_rflag rou_flags
1da177e4 LT	70
	71	static int router_distance;
	72
	73	static void router_recurse(klrou_t router_a, klrou_t router_b, int depth)
	74	{
	75	klrou_t *router;
	76	lboard_t *brd;
	77	int port;
	78
	79	if (router_a->rou_rflag == 1)
	80	return;
	81
	82	if (depth >= router_distance)
	83	return;
	84
	85	router_a->rou_rflag = 1;
	86
	87	for (port = 1; port <= MAX_ROUTER_PORTS; port++) {
	88	if (router_a->rou_port[port].port_nasid == INVALID_NASID)
	89	continue;
	90
	91	brd = (lboard_t *)NODE_OFFSET_TO_K0(
	92	router_a->rou_port[port].port_nasid,
	93	router_a->rou_port[port].port_offset);
	94
	95	if (brd->brd_type == KLTYPE_ROUTER) {
	96	router = (klrou_t *)NODE_OFFSET_TO_K0(NASID_GET(brd), brd->brd_compts[0]);
	97	if (router == router_b) {
	98	if (depth < router_distance)
	99	router_distance = depth;
	100	}
	101	else
	102	router_recurse(router, router_b, depth + 1);
	103	}
	104	}
	105
	106	router_a->rou_rflag = 0;
	107	}
	108
	109	unsigned char __node_distances[MAX_COMPACT_NODES][MAX_COMPACT_NODES];
	110
	111	static int __init compute_node_distance(nasid_t nasid_a, nasid_t nasid_b)
	112	{
	113	klrou_t router, router_a = NULL, *router_b = NULL;
	114	lboard_t brd, dest_brd;
	115	cnodeid_t cnode;
	116	nasid_t nasid;
	117	int port;
	118
	119	/* Figure out which routers nodes in question are connected to */
	120	for_each_online_node(cnode) {
	121	nasid = COMPACT_TO_NASID_NODEID(cnode);
	122
	123	if (nasid == -1) continue;
	124
	125	brd = find_lboard_class((lboard_t *)KL_CONFIG_INFO(nasid),
	126	KLTYPE_ROUTER);
	127
	128	if (!brd)
	129	continue;
	130
	131	do {
	132	if (brd->brd_flags & DUPLICATE_BOARD)
	133	continue;
134
135	router = (klrou_t *)NODE_OFFSET_TO_K0(NASID_GET(brd), brd->brd_compts[0]);
136	router->rou_rflag = 0;
137
138	for (port = 1; port <= MAX_ROUTER_PORTS; port++) {
139	if (router->rou_port[port].port_nasid == INVALID_NASID)
140	continue;
141
142	dest_brd = (lboard_t *)NODE_OFFSET_TO_K0(
143	router->rou_port[port].port_nasid,
144	router->rou_port[port].port_offset);
145
146	if (dest_brd->brd_type == KLTYPE_IP27) {
147	if (dest_brd->brd_nasid == nasid_a)
148	router_a = router;
149	if (dest_brd->brd_nasid == nasid_b)
150	router_b = router;
151	}
152	}
153
154	} while ((brd = find_lboard_class(KLCF_NEXT(brd), KLTYPE_ROUTER)));
155	}
156
157	if (router_a == NULL) {
158	printk("node_distance: router_a NULL\n");
159	return -1;
160	}
161	if (router_b == NULL) {
162	printk("node_distance: router_b NULL\n");
163	return -1;
164	}
165
166	if (nasid_a == nasid_b)
167	return 0;
168
169	if (router_a == router_b)
170	return 1;
171
172	router_distance = 100;
173	router_recurse(router_a, router_b, 2);
174
175	return router_distance;
176	}
177
178	static void __init init_topology_matrix(void)
179	{
180	nasid_t nasid, nasid2;
181	cnodeid_t row, col;
182
183	for (row = 0; row < MAX_COMPACT_NODES; row++)
184	for (col = 0; col < MAX_COMPACT_NODES; col++)
185	__node_distances[row][col] = -1;
186
187	for_each_online_node(row) {
188	nasid = COMPACT_TO_NASID_NODEID(row);
189	for_each_online_node(col) {
190	nasid2 = COMPACT_TO_NASID_NODEID(col);
191	__node_distances[row][col] =
192	compute_node_distance(nasid, nasid2);
193	}
194	}
195	}
196
197	static void __init dump_topology(void)
198	{
199	nasid_t nasid;
200	cnodeid_t cnode;
201	lboard_t brd, dest_brd;
202	int port;
203	int router_num = 0;
204	klrou_t *router;
205	cnodeid_t row, col;
206
207	printk("************ Topology ******************\n");
208
209	printk(" ");
210	for_each_online_node(col)
211	printk("%02d ", col);
212	printk("\n");
213	for_each_online_node(row) {
214	printk("%02d ", row);
215	for_each_online_node(col)
216	printk("%2d ", node_distance(row, col));
217	printk("\n");
218	}
219
220	for_each_online_node(cnode) {
221	nasid = COMPACT_TO_NASID_NODEID(cnode);
222
223	if (nasid == -1) continue;
224
225	brd = find_lboard_class((lboard_t *)KL_CONFIG_INFO(nasid),
226	KLTYPE_ROUTER);
227
228	if (!brd)
229	continue;
230
231	do {
232	if (brd->brd_flags & DUPLICATE_BOARD)
233	continue;
234	printk("Router %d:", router_num);
235	router_num++;
236
237	router = (klrou_t *)NODE_OFFSET_TO_K0(NASID_GET(brd), brd->brd_compts[0]);
238
239	for (port = 1; port <= MAX_ROUTER_PORTS; port++) {
240	if (router->rou_port[port].port_nasid == INVALID_NASID)
241	continue;
242
243	dest_brd = (lboard_t *)NODE_OFFSET_TO_K0(
244	router->rou_port[port].port_nasid,
245	router->rou_port[port].port_offset);
246
247	if (dest_brd->brd_type == KLTYPE_IP27)
248	printk(" %d", dest_brd->brd_nasid);
249	if (dest_brd->brd_type == KLTYPE_ROUTER)
250	printk(" r");
251	}
252	printk("\n");
253
254	} while ( (brd = find_lboard_class(KLCF_NEXT(brd), KLTYPE_ROUTER)) );
255	}
256	}
257
fc0460d0	258	static unsigned long __init slot_getbasepfn(cnodeid_t cnode, int slot)
1da177e4 LT	259	{
	260	nasid_t nasid = COMPACT_TO_NASID_NODEID(cnode);
	261
fc0460d0	262	return ((unsigned long)nasid << PFN_NASIDSHFT) \| (slot << SLOT_PFNSHIFT);
1da177e4 LT	263	}
1da177e4 LT	264
fc0460d0	265	static unsigned long __init slot_psize_compute(cnodeid_t node, int slot)
1da177e4 LT	266	{
	267	nasid_t nasid;
	268	lboard_t *brd;
	269	klmembnk_t *banks;
	270	unsigned long size;
	271
	272	nasid = COMPACT_TO_NASID_NODEID(node);
	273	/* Find the node board */
	274	brd = find_lboard((lboard_t *)KL_CONFIG_INFO(nasid), KLTYPE_IP27);
	275	if (!brd)
	276	return 0;
	277
	278	/* Get the memory bank structure */
	279	banks = (klmembnk_t *) find_first_component(brd, KLSTRUCT_MEMBNK);
	280	if (!banks)
	281	return 0;
	282
	283	/* Size in _Megabytes_ */
	284	size = (unsigned long)banks->membnk_bnksz[slot/4];
	285
	286	/* hack for 128 dimm banks */
	287	if (size <= 128) {
	288	if (slot % 4 == 0) {
	289	size <<= 20; /* size in bytes */
	290	return(size >> PAGE_SHIFT);
	291	} else
	292	return 0;
	293	} else {
	294	size /= 4;
	295	size <<= 20;
	296	return size >> PAGE_SHIFT;
	297	}
	298	}
	299
	300	static void __init mlreset(void)
	301	{
	302	int i;
	303
	304	master_nasid = get_nasid();
	305	fine_mode = is_fine_dirmode();
	306
	307	/*
	308	* Probe for all CPUs - this creates the cpumask and sets up the
	309	* mapping tables. We need to do this as early as possible.
	310	*/
	311	#ifdef CONFIG_SMP
	312	cpu_node_probe();
	313	#endif
	314
	315	init_topology_matrix();
	316	dump_topology();
	317
	318	gen_region_mask(&region_mask);
	319
	320	setup_replication_mask();
	321
	322	/*
	323	* Set all nodes' calias sizes to 8k
	324	*/
	325	for_each_online_node(i) {
	326	nasid_t nasid;
	327
	328	nasid = COMPACT_TO_NASID_NODEID(i);
	329
330	/*
331	* Always have node 0 in the region mask, otherwise
332	* CALIAS accesses get exceptions since the hub
333	* thinks it is a node 0 address.
334	*/
335	REMOTE_HUB_S(nasid, PI_REGION_PRESENT, (region_mask \| 1));
336	#ifdef CONFIG_REPLICATE_EXHANDLERS
337	REMOTE_HUB_S(nasid, PI_CALIAS_SIZE, PI_CALIAS_SIZE_8K);
338	#else
339	REMOTE_HUB_S(nasid, PI_CALIAS_SIZE, PI_CALIAS_SIZE_0);
340	#endif
341
342	#ifdef LATER
343	/*
344	* Set up all hubs to have a big window pointing at
345	* widget 0. Memory mode, widget 0, offset 0
346	*/
347	REMOTE_HUB_S(nasid, IIO_ITTE(SWIN0_BIGWIN),
348	((HUB_PIO_MAP_TO_MEM << IIO_ITTE_IOSP_SHIFT) \|
349	(0 << IIO_ITTE_WIDGET_SHIFT)));
350	#endif
351	}
352	}
353
354	static void __init szmem(void)
355	{
fc0460d0	356	unsigned long slot_psize, slot0sz = 0, nodebytes; /* Hack to detect problem configs */
2bf8ec2d	357	int slot;
1da177e4 LT	358	cnodeid_t node;
	359
	360	num_physpages = 0;
	361
	362	for_each_online_node(node) {
2bf8ec2d	363	nodebytes = 0;
1da177e4 LT	364	for (slot = 0; slot < MAX_MEM_SLOTS; slot++) {
	365	slot_psize = slot_psize_compute(node, slot);
	366	if (slot == 0)
	367	slot0sz = slot_psize;
	368	/*
	369	* We need to refine the hack when we have replicated
	370	* kernel text.
	371	*/
	372	nodebytes += (1LL << SLOT_SHIFT);
2bf8ec2d TB	373
	374	if (!slot_psize)
	375	continue;
	376
1da177e4	377	if ((nodebytes >> PAGE_SHIFT) * (sizeof(struct page)) >
2bf8ec2d	378	(slot0sz << PAGE_SHIFT)) {
1da177e4 LT	379	printk("Ignoring slot %d onwards on node %d\n",
1da177e4 LT	380	slot, node);
1da177e4 LT	381	slot = MAX_MEM_SLOTS;
	382	continue;
	383	}
	384	num_physpages += slot_psize;
9d15ffc8 TH	385	memblock_add_node(PFN_PHYS(slot_getbasepfn(node, slot)),
9d15ffc8 TH	386	PFN_PHYS(slot_psize), node);
1da177e4 LT	387	}
	388	}
	389	}
	390
	391	static void __init node_mem_init(cnodeid_t node)
	392	{
fc0460d0 RB	393	unsigned long slot_firstpfn = slot_getbasepfn(node, 0);
fc0460d0 RB	394	unsigned long slot_freepfn = node_getfirstfree(node);
1da177e4	395	unsigned long bootmap_size;
fc0460d0	396	unsigned long start_pfn, end_pfn;
2bf8ec2d TB	397
2bf8ec2d TB	398	get_pfn_range_for_nid(node, &start_pfn, &end_pfn);
1da177e4 LT	399
	400	/*
	401	* Allocate the node data structures on the node first.
	402	*/
	403	__node_data[node] = __va(slot_freepfn << PAGE_SHIFT);
93180cec	404	memset(__node_data[node], 0, PAGE_SIZE);
1da177e4	405
b61bfa3c	406	NODE_DATA(node)->bdata = &bootmem_node_data[node];
2bf8ec2d TB	407	NODE_DATA(node)->node_start_pfn = start_pfn;
2bf8ec2d TB	408	NODE_DATA(node)->node_spanned_pages = end_pfn - start_pfn;
1da177e4 LT	409
	410	cpus_clear(hub_data(node)->h_cpus);
	411
	412	slot_freepfn += PFN_UP(sizeof(struct pglist_data) +
	413	sizeof(struct hub_data));
	414
70342287	415	bootmap_size = init_bootmem_node(NODE_DATA(node), slot_freepfn,
2bf8ec2d TB	416	start_pfn, end_pfn);
2bf8ec2d TB	417	free_bootmem_with_active_regions(node, end_pfn);
1da177e4	418	reserve_bootmem_node(NODE_DATA(node), slot_firstpfn << PAGE_SHIFT,
72a7fe39 BW	419	((slot_freepfn - slot_firstpfn) << PAGE_SHIFT) + bootmap_size,
72a7fe39 BW	420	BOOTMEM_DEFAULT);
2bf8ec2d	421	sparse_memory_present_with_active_regions(node);
1da177e4 LT	422	}
	423
	424	/*
70342287	425	* A node with nothing. We use it to avoid any special casing in
29c337a0	426	* cpumask_of_node
1da177e4 LT	427	*/
	428	static struct node_data null_node = {
	429	.hub = {
	430	.h_cpus = CPU_MASK_NONE
	431	}
	432	};
	433
	434	/*
	435	* Currently, the intranode memory hole support assumes that each slot
	436	* contains at least 32 MBytes of memory. We assume all bootmem data
	437	* fits on the first slot.
	438	*/
	439	void __init prom_meminit(void)
	440	{
	441	cnodeid_t node;
	442
	443	mlreset();
	444	szmem();
	445
	446	for (node = 0; node < MAX_COMPACT_NODES; node++) {
	447	if (node_online(node)) {
	448	node_mem_init(node);
	449	continue;
	450	}
	451	__node_data[node] = &null_node;
	452	}
	453	}
	454
c44e8d5e	455	void __init prom_free_prom_memory(void)
1da177e4 LT	456	{
1da177e4 LT	457	/* We got nothing to free here ... */
1da177e4 LT	458	}
1da177e4 LT	459
31605922	460	extern void setup_zero_pages(void);
1da177e4 LT	461
	462	void __init paging_init(void)
	463	{
f06a9684	464	unsigned long zones_size[MAX_NR_ZONES] = {0, };
1da177e4 LT	465	unsigned node;
	466
	467	pagetable_init();
	468
	469	for_each_online_node(node) {
fc0460d0	470	unsigned long start_pfn, end_pfn;
1da177e4	471
2bf8ec2d	472	get_pfn_range_for_nid(node, &start_pfn, &end_pfn);
1da177e4 LT	473
	474	if (end_pfn > max_low_pfn)
	475	max_low_pfn = end_pfn;
	476	}
2bf8ec2d TB	477	zones_size[ZONE_NORMAL] = max_low_pfn;
2bf8ec2d TB	478	free_area_init_nodes(zones_size);
1da177e4 LT	479	}
	480
	481	void __init mem_init(void)
	482	{
	483	unsigned long codesize, datasize, initsize, tmp;
	484	unsigned node;
	485
	486	high_memory = (void *) __va(num_physpages << PAGE_SHIFT);
	487
	488	for_each_online_node(node) {
1da177e4	489	/*
a3dddd56 RB	490	* This will free up the bootmem, ie, slot 0 memory.
a3dddd56 RB	491	*/
1da177e4	492	totalram_pages += free_all_bootmem_node(NODE_DATA(node));
1da177e4 LT	493	}
1da177e4 LT	494
31605922	495	setup_zero_pages(); /* This comes from node 0 */
1da177e4 LT	496
	497	codesize = (unsigned long) &_etext - (unsigned long) &_text;
	498	datasize = (unsigned long) &_edata - (unsigned long) &_etext;
	499	initsize = (unsigned long) &__init_end - (unsigned long) &__init_begin;
	500
	501	tmp = nr_free_pages();
	502	printk(KERN_INFO "Memory: %luk/%luk available (%ldk kernel code, "
	503	"%ldk reserved, %ldk data, %ldk init, %ldk highmem)\n",
	504	tmp << (PAGE_SHIFT-10),
	505	num_physpages << (PAGE_SHIFT-10),
	506	codesize >> 10,
	507	(num_physpages - tmp) << (PAGE_SHIFT-10),
	508	datasize >> 10,
	509	initsize >> 10,
4b529401	510	totalhigh_pages << (PAGE_SHIFT-10));
1da177e4	511	}