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/mmzone.h>
8#include <linux/kernel.h>
9#include <linux/nodemask.h>
10#include <linux/string.h>
11
12#include <asm/page.h>
13#include <asm/sections.h>
14#include <asm/smp.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
24void __init setup_replication_mask(void)
25{
26	cnodeid_t	cnode;
27
28	/* Set only the master cnode's bit.  The master cnode is always 0. */
29	cpus_clear(ktext_repmask);
30	cpu_set(0, ktext_repmask);
31
32#ifdef CONFIG_REPLICATE_KTEXT
33#ifndef CONFIG_MAPPED_KERNEL
34#error Kernel replication works with mapped kernel support. No calias support.
35#endif
36	for_each_online_node(cnode) {
37		if (cnode == 0)
38			continue;
39		/* Advertise that we have a copy of the kernel */
40		cpu_set(cnode, ktext_repmask);
41	}
42#endif
43	/* Set up a GDA pointer to the replication mask. */
44	GDA->g_ktext_repmask = &ktext_repmask;
45}
46
47
48static __init void set_ktext_source(nasid_t client_nasid, nasid_t server_nasid)
49{
50	cnodeid_t client_cnode;
51	kern_vars_t *kvp;
52
53	client_cnode = NASID_TO_COMPACT_NODEID(client_nasid);
54
55	kvp = &hub_data(client_nasid)->kern_vars;
56
57	KERN_VARS_ADDR(client_nasid) = (unsigned long)kvp;
58
59	kvp->kv_magic = KV_MAGIC;
60	kvp->kv_ro_nasid = server_nasid;
61	kvp->kv_rw_nasid = master_nasid;
62	kvp->kv_ro_baseaddr = NODE_CAC_BASE(server_nasid);
63	kvp->kv_rw_baseaddr = NODE_CAC_BASE(master_nasid);
64	printk("REPLICATION: ON nasid %d, ktext from nasid %d, kdata from nasid %d\n", client_nasid, server_nasid, master_nasid);
65}
66
67static __init void copy_kernel(nasid_t dest_nasid)
68{
69	unsigned long dest_kern_start, source_start, source_end, kern_size;
70
71	source_start = (unsigned long) _stext;
72	source_end = (unsigned long) _etext;
73	kern_size = source_end - source_start;
74
75	dest_kern_start = CHANGE_ADDR_NASID(MAPPED_KERN_RO_TO_K0(source_start),
76					    dest_nasid);
77	memcpy((void *)dest_kern_start, (void *)source_start, kern_size);
78}
79
80void __init replicate_kernel_text()
81{
82	cnodeid_t cnode;
83	nasid_t client_nasid;
84	nasid_t server_nasid;
85
86	server_nasid = master_nasid;
87
88	/* Record where the master node should get its kernel text */
89	set_ktext_source(master_nasid, master_nasid);
90
91	for_each_online_node(cnode) {
92		if (cnode == 0)
93			continue;
94		client_nasid = COMPACT_TO_NASID_NODEID(cnode);
95
96		/* Check if this node should get a copy of the kernel */
97		if (cpu_isset(cnode, ktext_repmask)) {
98			server_nasid = client_nasid;
99			copy_kernel(server_nasid);
100		}
101
102		/* Record where this node should get its kernel text */
103		set_ktext_source(client_nasid, server_nasid);
104	}
105}
106
107/*
108 * Return pfn of first free page of memory on a node. PROM may allocate
109 * data structures on the first couple of pages of the first slot of each
110 * node. If this is the case, getfirstfree(node) > getslotstart(node, 0).
111 */
112pfn_t node_getfirstfree(cnodeid_t cnode)
113{
114	unsigned long loadbase = REP_BASE;
115	nasid_t nasid = COMPACT_TO_NASID_NODEID(cnode);
116	unsigned long offset;
117
118#ifdef CONFIG_MAPPED_KERNEL
119	loadbase += 16777216;
120#endif
121	offset = PAGE_ALIGN((unsigned long)(&_end)) - loadbase;
122	if ((cnode == 0) || (cpu_isset(cnode, ktext_repmask)))
123		return (TO_NODE(nasid, offset) >> PAGE_SHIFT);
124	else
125		return (KDM_TO_PHYS(PAGE_ALIGN(SYMMON_STK_ADDR(nasid, 0))) >>
126								PAGE_SHIFT);
127}
128