1/*
2 * Ported from IRIX to Linux by Kanoj Sarcar, 06/08/00.
3 * Copyright 2000 - 2001 Silicon Graphics, Inc.
4 * Copyright 2000 - 2001 Kanoj Sarcar (kanoj@sgi.com)
5 */
6#include <linux/init.h>
7#include <linux/mm.h>
8#include <linux/mmzone.h>
9#include <linux/kernel.h>
10#include <linux/nodemask.h>
11#include <linux/string.h>
12
13#include <asm/page.h>
14#include <asm/sections.h>
15#include <asm/sn/types.h>
16#include <asm/sn/arch.h>
17#include <asm/sn/gda.h>
18#include <asm/sn/hub.h>
19#include <asm/sn/mapped_kernel.h>
20#include <asm/sn/sn_private.h>
21
22static cpumask_t ktext_repmask;
23
24/*
25 * XXX - This needs to be much smarter about where it puts copies of the
26 * kernel.  For example, we should never put a copy on a headless node,
27 * and we should respect the topology of the machine.
28 */
29void __init setup_replication_mask(void)
30{
31	/* Set only the master cnode's bit.  The master cnode is always 0. */
32	cpumask_clear(&ktext_repmask);
33	cpumask_set_cpu(0, &ktext_repmask);
34
35#ifdef CONFIG_REPLICATE_KTEXT
36#ifndef CONFIG_MAPPED_KERNEL
37#error Kernel replication works with mapped kernel support. No calias support.
38#endif
39	{
40		cnodeid_t	cnode;
41
42		for_each_online_node(cnode) {
43			if (cnode == 0)
44				continue;
45			/* Advertise that we have a copy of the kernel */
46			cpumask_set_cpu(cnode, &ktext_repmask);
47		}
48	}
49#endif
50	/* Set up a GDA pointer to the replication mask. */
51	GDA->g_ktext_repmask = &ktext_repmask;
52}
53
54
55static __init void set_ktext_source(nasid_t client_nasid, nasid_t server_nasid)
56{
57	kern_vars_t *kvp;
58
59	kvp = &hub_data(client_nasid)->kern_vars;
60
61	KERN_VARS_ADDR(client_nasid) = (unsigned long)kvp;
62
63	kvp->kv_magic = KV_MAGIC;
64	kvp->kv_ro_nasid = server_nasid;
65	kvp->kv_rw_nasid = master_nasid;
66	kvp->kv_ro_baseaddr = NODE_CAC_BASE(server_nasid);
67	kvp->kv_rw_baseaddr = NODE_CAC_BASE(master_nasid);
68	printk("REPLICATION: ON nasid %d, ktext from nasid %d, kdata from nasid %d\n", client_nasid, server_nasid, master_nasid);
69}
70
71/* XXX - When the BTE works, we should use it instead of this. */
72static __init void copy_kernel(nasid_t dest_nasid)
73{
74	unsigned long dest_kern_start, source_start, source_end, kern_size;
75
76	source_start = (unsigned long) _stext;
77	source_end = (unsigned long) _etext;
78	kern_size = source_end - source_start;
79
80	dest_kern_start = CHANGE_ADDR_NASID(MAPPED_KERN_RO_TO_K0(source_start),
81					    dest_nasid);
82	memcpy((void *)dest_kern_start, (void *)source_start, kern_size);
83}
84
85void __init replicate_kernel_text()
86{
87	cnodeid_t cnode;
88	nasid_t client_nasid;
89	nasid_t server_nasid;
90
91	server_nasid = master_nasid;
92
93	/* Record where the master node should get its kernel text */
94	set_ktext_source(master_nasid, master_nasid);
95
96	for_each_online_node(cnode) {
97		if (cnode == 0)
98			continue;
99		client_nasid = COMPACT_TO_NASID_NODEID(cnode);
100
101		/* Check if this node should get a copy of the kernel */
102		if (cpumask_test_cpu(cnode, &ktext_repmask)) {
103			server_nasid = client_nasid;
104			copy_kernel(server_nasid);
105		}
106
107		/* Record where this node should get its kernel text */
108		set_ktext_source(client_nasid, server_nasid);
109	}
110}
111
112/*
113 * Return pfn of first free page of memory on a node. PROM may allocate
114 * data structures on the first couple of pages of the first slot of each
115 * node. If this is the case, getfirstfree(node) > getslotstart(node, 0).
116 */
117unsigned long node_getfirstfree(cnodeid_t cnode)
118{
119	unsigned long loadbase = REP_BASE;
120	nasid_t nasid = COMPACT_TO_NASID_NODEID(cnode);
121	unsigned long offset;
122
123#ifdef CONFIG_MAPPED_KERNEL
124	loadbase += 16777216;
125#endif
126	offset = PAGE_ALIGN((unsigned long)(&_end)) - loadbase;
127	if ((cnode == 0) || (cpumask_test_cpu(cnode, &ktext_repmask)))
128		return TO_NODE(nasid, offset) >> PAGE_SHIFT;
129	else
130		return KDM_TO_PHYS(PAGE_ALIGN(SYMMON_STK_ADDR(nasid, 0))) >> PAGE_SHIFT;
131}
132