162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * Ported from IRIX to Linux by Kanoj Sarcar, 06/08/00.
462306a36Sopenharmony_ci * Copyright 2000 - 2001 Silicon Graphics, Inc.
562306a36Sopenharmony_ci * Copyright 2000 - 2001 Kanoj Sarcar (kanoj@sgi.com)
662306a36Sopenharmony_ci */
762306a36Sopenharmony_ci#include <linux/init.h>
862306a36Sopenharmony_ci#include <linux/mm.h>
962306a36Sopenharmony_ci#include <linux/mmzone.h>
1062306a36Sopenharmony_ci#include <linux/kernel.h>
1162306a36Sopenharmony_ci#include <linux/nodemask.h>
1262306a36Sopenharmony_ci#include <linux/string.h>
1362306a36Sopenharmony_ci
1462306a36Sopenharmony_ci#include <asm/page.h>
1562306a36Sopenharmony_ci#include <asm/sections.h>
1662306a36Sopenharmony_ci#include <asm/sn/types.h>
1762306a36Sopenharmony_ci#include <asm/sn/arch.h>
1862306a36Sopenharmony_ci#include <asm/sn/gda.h>
1962306a36Sopenharmony_ci#include <asm/sn/mapped_kernel.h>
2062306a36Sopenharmony_ci
2162306a36Sopenharmony_ci#include "ip27-common.h"
2262306a36Sopenharmony_ci
2362306a36Sopenharmony_cistatic nodemask_t ktext_repmask;
2462306a36Sopenharmony_ci
2562306a36Sopenharmony_ci/*
2662306a36Sopenharmony_ci * XXX - This needs to be much smarter about where it puts copies of the
2762306a36Sopenharmony_ci * kernel.  For example, we should never put a copy on a headless node,
2862306a36Sopenharmony_ci * and we should respect the topology of the machine.
2962306a36Sopenharmony_ci */
3062306a36Sopenharmony_civoid __init setup_replication_mask(void)
3162306a36Sopenharmony_ci{
3262306a36Sopenharmony_ci	/* Set only the master cnode's bit.  The master cnode is always 0. */
3362306a36Sopenharmony_ci	nodes_clear(ktext_repmask);
3462306a36Sopenharmony_ci	node_set(0, ktext_repmask);
3562306a36Sopenharmony_ci
3662306a36Sopenharmony_ci#ifdef CONFIG_REPLICATE_KTEXT
3762306a36Sopenharmony_ci#ifndef CONFIG_MAPPED_KERNEL
3862306a36Sopenharmony_ci#error Kernel replication works with mapped kernel support. No calias support.
3962306a36Sopenharmony_ci#endif
4062306a36Sopenharmony_ci	{
4162306a36Sopenharmony_ci		nasid_t nasid;
4262306a36Sopenharmony_ci
4362306a36Sopenharmony_ci		for_each_online_node(nasid) {
4462306a36Sopenharmony_ci			if (nasid == 0)
4562306a36Sopenharmony_ci				continue;
4662306a36Sopenharmony_ci			/* Advertise that we have a copy of the kernel */
4762306a36Sopenharmony_ci			node_set(nasid, ktext_repmask);
4862306a36Sopenharmony_ci		}
4962306a36Sopenharmony_ci	}
5062306a36Sopenharmony_ci#endif
5162306a36Sopenharmony_ci	/* Set up a GDA pointer to the replication mask. */
5262306a36Sopenharmony_ci	GDA->g_ktext_repmask = &ktext_repmask;
5362306a36Sopenharmony_ci}
5462306a36Sopenharmony_ci
5562306a36Sopenharmony_ci
5662306a36Sopenharmony_cistatic __init void set_ktext_source(nasid_t client_nasid, nasid_t server_nasid)
5762306a36Sopenharmony_ci{
5862306a36Sopenharmony_ci	kern_vars_t *kvp;
5962306a36Sopenharmony_ci
6062306a36Sopenharmony_ci	kvp = &hub_data(client_nasid)->kern_vars;
6162306a36Sopenharmony_ci
6262306a36Sopenharmony_ci	KERN_VARS_ADDR(client_nasid) = (unsigned long)kvp;
6362306a36Sopenharmony_ci
6462306a36Sopenharmony_ci	kvp->kv_magic = KV_MAGIC;
6562306a36Sopenharmony_ci	kvp->kv_ro_nasid = server_nasid;
6662306a36Sopenharmony_ci	kvp->kv_rw_nasid = master_nasid;
6762306a36Sopenharmony_ci	kvp->kv_ro_baseaddr = NODE_CAC_BASE(server_nasid);
6862306a36Sopenharmony_ci	kvp->kv_rw_baseaddr = NODE_CAC_BASE(master_nasid);
6962306a36Sopenharmony_ci	printk("REPLICATION: ON nasid %d, ktext from nasid %d, kdata from nasid %d\n", client_nasid, server_nasid, master_nasid);
7062306a36Sopenharmony_ci}
7162306a36Sopenharmony_ci
7262306a36Sopenharmony_ci/* XXX - When the BTE works, we should use it instead of this. */
7362306a36Sopenharmony_cistatic __init void copy_kernel(nasid_t dest_nasid)
7462306a36Sopenharmony_ci{
7562306a36Sopenharmony_ci	unsigned long dest_kern_start, source_start, source_end, kern_size;
7662306a36Sopenharmony_ci
7762306a36Sopenharmony_ci	source_start = (unsigned long) _stext;
7862306a36Sopenharmony_ci	source_end = (unsigned long) _etext;
7962306a36Sopenharmony_ci	kern_size = source_end - source_start;
8062306a36Sopenharmony_ci
8162306a36Sopenharmony_ci	dest_kern_start = CHANGE_ADDR_NASID(MAPPED_KERN_RO_TO_K0(source_start),
8262306a36Sopenharmony_ci					    dest_nasid);
8362306a36Sopenharmony_ci	memcpy((void *)dest_kern_start, (void *)source_start, kern_size);
8462306a36Sopenharmony_ci}
8562306a36Sopenharmony_ci
8662306a36Sopenharmony_civoid __init replicate_kernel_text(void)
8762306a36Sopenharmony_ci{
8862306a36Sopenharmony_ci	nasid_t client_nasid;
8962306a36Sopenharmony_ci	nasid_t server_nasid;
9062306a36Sopenharmony_ci
9162306a36Sopenharmony_ci	server_nasid = master_nasid;
9262306a36Sopenharmony_ci
9362306a36Sopenharmony_ci	/* Record where the master node should get its kernel text */
9462306a36Sopenharmony_ci	set_ktext_source(master_nasid, master_nasid);
9562306a36Sopenharmony_ci
9662306a36Sopenharmony_ci	for_each_online_node(client_nasid) {
9762306a36Sopenharmony_ci		if (client_nasid == 0)
9862306a36Sopenharmony_ci			continue;
9962306a36Sopenharmony_ci
10062306a36Sopenharmony_ci		/* Check if this node should get a copy of the kernel */
10162306a36Sopenharmony_ci		if (node_isset(client_nasid, ktext_repmask)) {
10262306a36Sopenharmony_ci			server_nasid = client_nasid;
10362306a36Sopenharmony_ci			copy_kernel(server_nasid);
10462306a36Sopenharmony_ci		}
10562306a36Sopenharmony_ci
10662306a36Sopenharmony_ci		/* Record where this node should get its kernel text */
10762306a36Sopenharmony_ci		set_ktext_source(client_nasid, server_nasid);
10862306a36Sopenharmony_ci	}
10962306a36Sopenharmony_ci}
11062306a36Sopenharmony_ci
11162306a36Sopenharmony_ci/*
11262306a36Sopenharmony_ci * Return pfn of first free page of memory on a node. PROM may allocate
11362306a36Sopenharmony_ci * data structures on the first couple of pages of the first slot of each
11462306a36Sopenharmony_ci * node. If this is the case, getfirstfree(node) > getslotstart(node, 0).
11562306a36Sopenharmony_ci */
11662306a36Sopenharmony_ciunsigned long node_getfirstfree(nasid_t nasid)
11762306a36Sopenharmony_ci{
11862306a36Sopenharmony_ci	unsigned long loadbase = REP_BASE;
11962306a36Sopenharmony_ci	unsigned long offset;
12062306a36Sopenharmony_ci
12162306a36Sopenharmony_ci#ifdef CONFIG_MAPPED_KERNEL
12262306a36Sopenharmony_ci	loadbase += 16777216;
12362306a36Sopenharmony_ci#endif
12462306a36Sopenharmony_ci	offset = PAGE_ALIGN((unsigned long)(&_end)) - loadbase;
12562306a36Sopenharmony_ci	if ((nasid == 0) || (node_isset(nasid, ktext_repmask)))
12662306a36Sopenharmony_ci		return TO_NODE(nasid, offset) >> PAGE_SHIFT;
12762306a36Sopenharmony_ci	else
12862306a36Sopenharmony_ci		return KDM_TO_PHYS(PAGE_ALIGN(SYMMON_STK_ADDR(nasid, 0))) >> PAGE_SHIFT;
12962306a36Sopenharmony_ci}
130