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