niagara2.c revision 7ec363dc481bba196d724969022171de4687989f
4496171313bed39e96f21bc2f9faf2868e267ae3girish/*
4496171313bed39e96f21bc2f9faf2868e267ae3girish * CDDL HEADER START
4496171313bed39e96f21bc2f9faf2868e267ae3girish *
4496171313bed39e96f21bc2f9faf2868e267ae3girish * The contents of this file are subject to the terms of the
4496171313bed39e96f21bc2f9faf2868e267ae3girish * Common Development and Distribution License (the "License").
4496171313bed39e96f21bc2f9faf2868e267ae3girish * You may not use this file except in compliance with the License.
4496171313bed39e96f21bc2f9faf2868e267ae3girish *
4496171313bed39e96f21bc2f9faf2868e267ae3girish * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
4496171313bed39e96f21bc2f9faf2868e267ae3girish * or http://www.opensolaris.org/os/licensing.
4496171313bed39e96f21bc2f9faf2868e267ae3girish * See the License for the specific language governing permissions
4496171313bed39e96f21bc2f9faf2868e267ae3girish * and limitations under the License.
4496171313bed39e96f21bc2f9faf2868e267ae3girish *
4496171313bed39e96f21bc2f9faf2868e267ae3girish * When distributing Covered Code, include this CDDL HEADER in each
4496171313bed39e96f21bc2f9faf2868e267ae3girish * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
4496171313bed39e96f21bc2f9faf2868e267ae3girish * If applicable, add the following below this CDDL HEADER, with the
4496171313bed39e96f21bc2f9faf2868e267ae3girish * fields enclosed by brackets "[]" replaced with your own identifying
4496171313bed39e96f21bc2f9faf2868e267ae3girish * information: Portions Copyright [yyyy] [name of copyright owner]
4496171313bed39e96f21bc2f9faf2868e267ae3girish *
4496171313bed39e96f21bc2f9faf2868e267ae3girish * CDDL HEADER END
4496171313bed39e96f21bc2f9faf2868e267ae3girish */
459190a5c46206e7885f6a649a055ceb46be49a7rsmaeda
4496171313bed39e96f21bc2f9faf2868e267ae3girish/*
fb2f18f820d90b001aea4fb27dd654bc1263c440esaxe * Copyright 2007 Sun Microsystems, Inc. All rights reserved.
4496171313bed39e96f21bc2f9faf2868e267ae3girish * Use is subject to license terms.
4496171313bed39e96f21bc2f9faf2868e267ae3girish */
4496171313bed39e96f21bc2f9faf2868e267ae3girish
4496171313bed39e96f21bc2f9faf2868e267ae3girish#pragma ident "%Z%%M% %I% %E% SMI"
4496171313bed39e96f21bc2f9faf2868e267ae3girish
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/types.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/systm.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/archsystm.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/machparam.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/machsystm.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/cpu.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/elf_SPARC.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <vm/hat_sfmmu.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <vm/page.h>
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp#include <vm/vm_dep.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/cpuvar.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/async.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/cmn_err.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/debug.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/dditypes.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/sunddi.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/cpu_module.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/prom_debug.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/vmsystm.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/prom_plat.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/sysmacros.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/intreg.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/machtrap.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/ontrap.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/ivintr.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/atomic.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/panic.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/dtrace.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/simulate.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/fault.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/niagara2regs.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/hsvc.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish#include <sys/trapstat.h>
4496171313bed39e96f21bc2f9faf2868e267ae3girish
4496171313bed39e96f21bc2f9faf2868e267ae3girishuint_t root_phys_addr_lo_mask = 0xffffffffU;
59ac0c1669407488b67ae9e273667a340dccc611davemq#if defined(NIAGARA2_IMPL)
4496171313bed39e96f21bc2f9faf2868e267ae3girishchar cpu_module_name[] = "SUNW,UltraSPARC-T2";
59ac0c1669407488b67ae9e273667a340dccc611davemq#elif defined(VFALLS_IMPL)
59ac0c1669407488b67ae9e273667a340dccc611davemqchar cpu_module_name[] = "SUNW,UltraSPARC-T2+";
59ac0c1669407488b67ae9e273667a340dccc611davemq#endif
4496171313bed39e96f21bc2f9faf2868e267ae3girish
4496171313bed39e96f21bc2f9faf2868e267ae3girish/*
59ac0c1669407488b67ae9e273667a340dccc611davemq * Hypervisor services information for the NIAGARA2 and Victoria Falls
59ac0c1669407488b67ae9e273667a340dccc611davemq * CPU module
4496171313bed39e96f21bc2f9faf2868e267ae3girish */
59ac0c1669407488b67ae9e273667a340dccc611davemqstatic boolean_t cpu_hsvc_available = B_TRUE;
59ac0c1669407488b67ae9e273667a340dccc611davemqstatic uint64_t cpu_sup_minor; /* Supported minor number */
59ac0c1669407488b67ae9e273667a340dccc611davemq#if defined(NIAGARA2_IMPL)
59ac0c1669407488b67ae9e273667a340dccc611davemqstatic hsvc_info_t cpu_hsvc = {
4496171313bed39e96f21bc2f9faf2868e267ae3girish HSVC_REV_1, NULL, HSVC_GROUP_NIAGARA2_CPU, NIAGARA2_HSVC_MAJOR,
4496171313bed39e96f21bc2f9faf2868e267ae3girish NIAGARA2_HSVC_MINOR, cpu_module_name
4496171313bed39e96f21bc2f9faf2868e267ae3girish};
59ac0c1669407488b67ae9e273667a340dccc611davemq#elif defined(VFALLS_IMPL)
59ac0c1669407488b67ae9e273667a340dccc611davemqstatic hsvc_info_t cpu_hsvc = {
59ac0c1669407488b67ae9e273667a340dccc611davemq HSVC_REV_1, NULL, HSVC_GROUP_VFALLS_CPU, VFALLS_HSVC_MAJOR,
59ac0c1669407488b67ae9e273667a340dccc611davemq VFALLS_HSVC_MINOR, cpu_module_name
59ac0c1669407488b67ae9e273667a340dccc611davemq};
59ac0c1669407488b67ae9e273667a340dccc611davemq#endif
4496171313bed39e96f21bc2f9faf2868e267ae3girish
4496171313bed39e96f21bc2f9faf2868e267ae3girishvoid
4496171313bed39e96f21bc2f9faf2868e267ae3girishcpu_setup(void)
4496171313bed39e96f21bc2f9faf2868e267ae3girish{
4496171313bed39e96f21bc2f9faf2868e267ae3girish extern int mmu_exported_pagesize_mask;
4496171313bed39e96f21bc2f9faf2868e267ae3girish extern int cpc_has_overflow_intr;
7ec363dc481bba196d724969022171de4687989fwh extern size_t contig_mem_prealloc_base_size;
4496171313bed39e96f21bc2f9faf2868e267ae3girish int status;
4496171313bed39e96f21bc2f9faf2868e267ae3girish
4496171313bed39e96f21bc2f9faf2868e267ae3girish /*
4496171313bed39e96f21bc2f9faf2868e267ae3girish * Negotiate the API version for Niagara2 specific hypervisor
4496171313bed39e96f21bc2f9faf2868e267ae3girish * services.
4496171313bed39e96f21bc2f9faf2868e267ae3girish */
59ac0c1669407488b67ae9e273667a340dccc611davemq status = hsvc_register(&cpu_hsvc, &cpu_sup_minor);
4496171313bed39e96f21bc2f9faf2868e267ae3girish if (status != 0) {
4496171313bed39e96f21bc2f9faf2868e267ae3girish cmn_err(CE_WARN, "%s: cannot negotiate hypervisor services "
4496171313bed39e96f21bc2f9faf2868e267ae3girish "group: 0x%lx major: 0x%lx minor: 0x%lx errno: %d",
59ac0c1669407488b67ae9e273667a340dccc611davemq cpu_hsvc.hsvc_modname, cpu_hsvc.hsvc_group,
59ac0c1669407488b67ae9e273667a340dccc611davemq cpu_hsvc.hsvc_major, cpu_hsvc.hsvc_minor, status);
59ac0c1669407488b67ae9e273667a340dccc611davemq cpu_hsvc_available = B_FALSE;
4496171313bed39e96f21bc2f9faf2868e267ae3girish }
4496171313bed39e96f21bc2f9faf2868e267ae3girish
4496171313bed39e96f21bc2f9faf2868e267ae3girish /*
4496171313bed39e96f21bc2f9faf2868e267ae3girish * The setup common to all CPU modules is done in cpu_setup_common
4496171313bed39e96f21bc2f9faf2868e267ae3girish * routine.
4496171313bed39e96f21bc2f9faf2868e267ae3girish */
4496171313bed39e96f21bc2f9faf2868e267ae3girish cpu_setup_common(NULL);
4496171313bed39e96f21bc2f9faf2868e267ae3girish
4496171313bed39e96f21bc2f9faf2868e267ae3girish cache |= (CACHE_PTAG | CACHE_IOCOHERENT);
4496171313bed39e96f21bc2f9faf2868e267ae3girish
4496171313bed39e96f21bc2f9faf2868e267ae3girish if ((mmu_exported_pagesize_mask &
4496171313bed39e96f21bc2f9faf2868e267ae3girish DEFAULT_SUN4V_MMU_PAGESIZE_MASK) !=
4496171313bed39e96f21bc2f9faf2868e267ae3girish DEFAULT_SUN4V_MMU_PAGESIZE_MASK)
4496171313bed39e96f21bc2f9faf2868e267ae3girish cmn_err(CE_PANIC, "machine description"
4496171313bed39e96f21bc2f9faf2868e267ae3girish " does not have required sun4v page sizes"
4496171313bed39e96f21bc2f9faf2868e267ae3girish " 8K, 64K and 4M: MD mask is 0x%x",
4496171313bed39e96f21bc2f9faf2868e267ae3girish mmu_exported_pagesize_mask);
4496171313bed39e96f21bc2f9faf2868e267ae3girish
4496171313bed39e96f21bc2f9faf2868e267ae3girish cpu_hwcap_flags = AV_SPARC_VIS | AV_SPARC_VIS2 | AV_SPARC_ASI_BLK_INIT;
4496171313bed39e96f21bc2f9faf2868e267ae3girish
4496171313bed39e96f21bc2f9faf2868e267ae3girish /*
4496171313bed39e96f21bc2f9faf2868e267ae3girish * Niagara2 supports a 48-bit subset of the full 64-bit virtual
4496171313bed39e96f21bc2f9faf2868e267ae3girish * address space. Virtual addresses between 0x0000800000000000
4496171313bed39e96f21bc2f9faf2868e267ae3girish * and 0xffff.7fff.ffff.ffff inclusive lie within a "VA Hole"
4496171313bed39e96f21bc2f9faf2868e267ae3girish * and must never be mapped. In addition, software must not use
4496171313bed39e96f21bc2f9faf2868e267ae3girish * pages within 4GB of the VA hole as instruction pages to
4496171313bed39e96f21bc2f9faf2868e267ae3girish * avoid problems with prefetching into the VA hole.
4496171313bed39e96f21bc2f9faf2868e267ae3girish */
4496171313bed39e96f21bc2f9faf2868e267ae3girish hole_start = (caddr_t)((1ull << (va_bits - 1)) - (1ull << 32));
4496171313bed39e96f21bc2f9faf2868e267ae3girish hole_end = (caddr_t)((0ull - (1ull << (va_bits - 1))) + (1ull << 32));
4496171313bed39e96f21bc2f9faf2868e267ae3girish
4496171313bed39e96f21bc2f9faf2868e267ae3girish /*
4496171313bed39e96f21bc2f9faf2868e267ae3girish * Niagara2 has a performance counter overflow interrupt
4496171313bed39e96f21bc2f9faf2868e267ae3girish */
4496171313bed39e96f21bc2f9faf2868e267ae3girish cpc_has_overflow_intr = 1;
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp /*
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp * Enable 4M pages for OOB.
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp */
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp max_uheap_lpsize = MMU_PAGESIZE4M;
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp max_ustack_lpsize = MMU_PAGESIZE4M;
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp max_privmap_lpsize = MMU_PAGESIZE4M;
aaa10e6791d1614700651df2821f84d490c094bfha
7ec363dc481bba196d724969022171de4687989fwh#ifdef SUN4V_CONTIG_MEM_PREALLOC_SIZE_MB
7ec363dc481bba196d724969022171de4687989fwh /*
7ec363dc481bba196d724969022171de4687989fwh * Use CPU Makefile specific compile time define (if exists)
7ec363dc481bba196d724969022171de4687989fwh * to add to the contig preallocation size.
7ec363dc481bba196d724969022171de4687989fwh */
7ec363dc481bba196d724969022171de4687989fwh contig_mem_prealloc_base_size = MB(SUN4V_CONTIG_MEM_PREALLOC_SIZE_MB);
7ec363dc481bba196d724969022171de4687989fwh#endif
4496171313bed39e96f21bc2f9faf2868e267ae3girish}
4496171313bed39e96f21bc2f9faf2868e267ae3girish
4496171313bed39e96f21bc2f9faf2868e267ae3girish/*
4496171313bed39e96f21bc2f9faf2868e267ae3girish * Set the magic constants of the implementation.
4496171313bed39e96f21bc2f9faf2868e267ae3girish */
4496171313bed39e96f21bc2f9faf2868e267ae3girishvoid
4496171313bed39e96f21bc2f9faf2868e267ae3girishcpu_fiximp(struct cpu_node *cpunode)
4496171313bed39e96f21bc2f9faf2868e267ae3girish{
4496171313bed39e96f21bc2f9faf2868e267ae3girish /*
4496171313bed39e96f21bc2f9faf2868e267ae3girish * The Cache node is optional in MD. Therefore in case "Cache"
4496171313bed39e96f21bc2f9faf2868e267ae3girish * node does not exists in MD, set the default L2 cache associativity,
4496171313bed39e96f21bc2f9faf2868e267ae3girish * size, linesize.
4496171313bed39e96f21bc2f9faf2868e267ae3girish */
4496171313bed39e96f21bc2f9faf2868e267ae3girish if (cpunode->ecache_size == 0)
4496171313bed39e96f21bc2f9faf2868e267ae3girish cpunode->ecache_size = L2CACHE_SIZE;
4496171313bed39e96f21bc2f9faf2868e267ae3girish if (cpunode->ecache_linesize == 0)
4496171313bed39e96f21bc2f9faf2868e267ae3girish cpunode->ecache_linesize = L2CACHE_LINESIZE;
4496171313bed39e96f21bc2f9faf2868e267ae3girish if (cpunode->ecache_associativity == 0)
4496171313bed39e96f21bc2f9faf2868e267ae3girish cpunode->ecache_associativity = L2CACHE_ASSOCIATIVITY;
4496171313bed39e96f21bc2f9faf2868e267ae3girish}
4496171313bed39e96f21bc2f9faf2868e267ae3girish
4496171313bed39e96f21bc2f9faf2868e267ae3girishvoid
459190a5c46206e7885f6a649a055ceb46be49a7rsmaedacpu_map_exec_units(struct cpu *cp)
4496171313bed39e96f21bc2f9faf2868e267ae3girish{
459190a5c46206e7885f6a649a055ceb46be49a7rsmaeda ASSERT(MUTEX_HELD(&cpu_lock));
4496171313bed39e96f21bc2f9faf2868e267ae3girish
4496171313bed39e96f21bc2f9faf2868e267ae3girish /*
fb2f18f820d90b001aea4fb27dd654bc1263c440esaxe * The cpu_ipipe and cpu_fpu fields are initialized based on
459190a5c46206e7885f6a649a055ceb46be49a7rsmaeda * the execution unit sharing information from the MD. They
459190a5c46206e7885f6a649a055ceb46be49a7rsmaeda * default to the CPU id in the absence of such information.
4496171313bed39e96f21bc2f9faf2868e267ae3girish */
4496171313bed39e96f21bc2f9faf2868e267ae3girish cp->cpu_m.cpu_ipipe = cpunodes[cp->cpu_id].exec_unit_mapping;
4496171313bed39e96f21bc2f9faf2868e267ae3girish if (cp->cpu_m.cpu_ipipe == NO_EU_MAPPING_FOUND)
4496171313bed39e96f21bc2f9faf2868e267ae3girish cp->cpu_m.cpu_ipipe = (id_t)(cp->cpu_id);
4496171313bed39e96f21bc2f9faf2868e267ae3girish
fb2f18f820d90b001aea4fb27dd654bc1263c440esaxe cp->cpu_m.cpu_fpu = cpunodes[cp->cpu_id].fpu_mapping;
fb2f18f820d90b001aea4fb27dd654bc1263c440esaxe if (cp->cpu_m.cpu_fpu == NO_EU_MAPPING_FOUND)
fb2f18f820d90b001aea4fb27dd654bc1263c440esaxe cp->cpu_m.cpu_fpu = (id_t)(cp->cpu_id);
fb2f18f820d90b001aea4fb27dd654bc1263c440esaxe
fb2f18f820d90b001aea4fb27dd654bc1263c440esaxe /*
fb2f18f820d90b001aea4fb27dd654bc1263c440esaxe * Niagara 2 defines the core to be at the FPU level
fb2f18f820d90b001aea4fb27dd654bc1263c440esaxe */
fb2f18f820d90b001aea4fb27dd654bc1263c440esaxe cp->cpu_m.cpu_core = cp->cpu_m.cpu_fpu;
59ac0c1669407488b67ae9e273667a340dccc611davemq
59ac0c1669407488b67ae9e273667a340dccc611davemq /*
59ac0c1669407488b67ae9e273667a340dccc611davemq * The cpu_chip field is initialized based on the information
59ac0c1669407488b67ae9e273667a340dccc611davemq * in the MD and assume that all cpus within a chip
59ac0c1669407488b67ae9e273667a340dccc611davemq * share the same L2 cache. If no such info is available, we
59ac0c1669407488b67ae9e273667a340dccc611davemq * set the cpu to belong to the defacto chip 0.
59ac0c1669407488b67ae9e273667a340dccc611davemq */
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp cp->cpu_m.cpu_mpipe = cpunodes[cp->cpu_id].l2_cache_mapping;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp if (cp->cpu_m.cpu_mpipe == NO_L2_CACHE_MAPPING_FOUND)
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp cp->cpu_m.cpu_mpipe = CPU_L2_CACHEID_INVALID;
e853d8c363bb48f997502f6e034877de20256ab0jc
e853d8c363bb48f997502f6e034877de20256ab0jc cp->cpu_m.cpu_chip = cpunodes[cp->cpu_id].l2_cache_mapping;
e853d8c363bb48f997502f6e034877de20256ab0jc if (cp->cpu_m.cpu_chip == NO_L2_CACHE_MAPPING_FOUND)
e853d8c363bb48f997502f6e034877de20256ab0jc cp->cpu_m.cpu_chip = CPU_CHIPID_INVALID;
459190a5c46206e7885f6a649a055ceb46be49a7rsmaeda}
459190a5c46206e7885f6a649a055ceb46be49a7rsmaeda
59ac0c1669407488b67ae9e273667a340dccc611davemqstatic int cpucnt;
459190a5c46206e7885f6a649a055ceb46be49a7rsmaeda
459190a5c46206e7885f6a649a055ceb46be49a7rsmaedavoid
459190a5c46206e7885f6a649a055ceb46be49a7rsmaedacpu_init_private(struct cpu *cp)
459190a5c46206e7885f6a649a055ceb46be49a7rsmaeda{
459190a5c46206e7885f6a649a055ceb46be49a7rsmaeda extern void niagara_kstat_init(void);
fb2f18f820d90b001aea4fb27dd654bc1263c440esaxe
4496171313bed39e96f21bc2f9faf2868e267ae3girish ASSERT(MUTEX_HELD(&cpu_lock));
459190a5c46206e7885f6a649a055ceb46be49a7rsmaeda
459190a5c46206e7885f6a649a055ceb46be49a7rsmaeda cpu_map_exec_units(cp);
459190a5c46206e7885f6a649a055ceb46be49a7rsmaeda
59ac0c1669407488b67ae9e273667a340dccc611davemq if ((cpucnt++ == 0) && (cpu_hsvc_available == B_TRUE))
59ac0c1669407488b67ae9e273667a340dccc611davemq (void) niagara_kstat_init();
4496171313bed39e96f21bc2f9faf2868e267ae3girish}
4496171313bed39e96f21bc2f9faf2868e267ae3girish
4496171313bed39e96f21bc2f9faf2868e267ae3girish/*ARGSUSED*/
4496171313bed39e96f21bc2f9faf2868e267ae3girishvoid
4496171313bed39e96f21bc2f9faf2868e267ae3girishcpu_uninit_private(struct cpu *cp)
4496171313bed39e96f21bc2f9faf2868e267ae3girish{
459190a5c46206e7885f6a649a055ceb46be49a7rsmaeda extern void niagara_kstat_fini(void);
4496171313bed39e96f21bc2f9faf2868e267ae3girish
4496171313bed39e96f21bc2f9faf2868e267ae3girish ASSERT(MUTEX_HELD(&cpu_lock));
59ac0c1669407488b67ae9e273667a340dccc611davemq if ((--cpucnt == 0) && (cpu_hsvc_available == B_TRUE))
59ac0c1669407488b67ae9e273667a340dccc611davemq (void) niagara_kstat_fini();
4496171313bed39e96f21bc2f9faf2868e267ae3girish}
4496171313bed39e96f21bc2f9faf2868e267ae3girish
4496171313bed39e96f21bc2f9faf2868e267ae3girish/*
4496171313bed39e96f21bc2f9faf2868e267ae3girish * On Niagara2, any flush will cause all preceding stores to be
4496171313bed39e96f21bc2f9faf2868e267ae3girish * synchronized wrt the i$, regardless of address or ASI. In fact,
4496171313bed39e96f21bc2f9faf2868e267ae3girish * the address is ignored, so we always flush address 0.
4496171313bed39e96f21bc2f9faf2868e267ae3girish */
4496171313bed39e96f21bc2f9faf2868e267ae3girish/*ARGSUSED*/
4496171313bed39e96f21bc2f9faf2868e267ae3girishvoid
4496171313bed39e96f21bc2f9faf2868e267ae3girishdtrace_flush_sec(uintptr_t addr)
4496171313bed39e96f21bc2f9faf2868e267ae3girish{
4496171313bed39e96f21bc2f9faf2868e267ae3girish doflush(0);
4496171313bed39e96f21bc2f9faf2868e267ae3girish}
4496171313bed39e96f21bc2f9faf2868e267ae3girish
4496171313bed39e96f21bc2f9faf2868e267ae3girish/*
4496171313bed39e96f21bc2f9faf2868e267ae3girish * Trapstat support for Niagara2 processor
4496171313bed39e96f21bc2f9faf2868e267ae3girish * The Niagara2 provides HWTW support for TSB lookup and with HWTW
4496171313bed39e96f21bc2f9faf2868e267ae3girish * enabled no TSB hit information will be available. Therefore setting
4496171313bed39e96f21bc2f9faf2868e267ae3girish * the time spent in TLB miss handler for TSB hits to 0.
4496171313bed39e96f21bc2f9faf2868e267ae3girish */
4496171313bed39e96f21bc2f9faf2868e267ae3girishint
4496171313bed39e96f21bc2f9faf2868e267ae3girishcpu_trapstat_conf(int cmd)
4496171313bed39e96f21bc2f9faf2868e267ae3girish{
4496171313bed39e96f21bc2f9faf2868e267ae3girish int status = 0;
4496171313bed39e96f21bc2f9faf2868e267ae3girish
4496171313bed39e96f21bc2f9faf2868e267ae3girish switch (cmd) {
4496171313bed39e96f21bc2f9faf2868e267ae3girish case CPU_TSTATCONF_INIT:
4496171313bed39e96f21bc2f9faf2868e267ae3girish case CPU_TSTATCONF_FINI:
4496171313bed39e96f21bc2f9faf2868e267ae3girish case CPU_TSTATCONF_ENABLE:
4496171313bed39e96f21bc2f9faf2868e267ae3girish case CPU_TSTATCONF_DISABLE:
4496171313bed39e96f21bc2f9faf2868e267ae3girish break;
4496171313bed39e96f21bc2f9faf2868e267ae3girish default:
4496171313bed39e96f21bc2f9faf2868e267ae3girish status = EINVAL;
4496171313bed39e96f21bc2f9faf2868e267ae3girish break;
4496171313bed39e96f21bc2f9faf2868e267ae3girish }
4496171313bed39e96f21bc2f9faf2868e267ae3girish return (status);
4496171313bed39e96f21bc2f9faf2868e267ae3girish}
4496171313bed39e96f21bc2f9faf2868e267ae3girish
4496171313bed39e96f21bc2f9faf2868e267ae3girishvoid
4496171313bed39e96f21bc2f9faf2868e267ae3girishcpu_trapstat_data(void *buf, uint_t tstat_pgszs)
4496171313bed39e96f21bc2f9faf2868e267ae3girish{
4496171313bed39e96f21bc2f9faf2868e267ae3girish tstat_pgszdata_t *tstatp = (tstat_pgszdata_t *)buf;
4496171313bed39e96f21bc2f9faf2868e267ae3girish int i;
4496171313bed39e96f21bc2f9faf2868e267ae3girish
4496171313bed39e96f21bc2f9faf2868e267ae3girish for (i = 0; i < tstat_pgszs; i++, tstatp++) {
4496171313bed39e96f21bc2f9faf2868e267ae3girish tstatp->tpgsz_kernel.tmode_itlb.ttlb_tlb.tmiss_count = 0;
4496171313bed39e96f21bc2f9faf2868e267ae3girish tstatp->tpgsz_kernel.tmode_itlb.ttlb_tlb.tmiss_time = 0;
4496171313bed39e96f21bc2f9faf2868e267ae3girish tstatp->tpgsz_user.tmode_itlb.ttlb_tlb.tmiss_count = 0;
4496171313bed39e96f21bc2f9faf2868e267ae3girish tstatp->tpgsz_user.tmode_itlb.ttlb_tlb.tmiss_time = 0;
4496171313bed39e96f21bc2f9faf2868e267ae3girish tstatp->tpgsz_kernel.tmode_dtlb.ttlb_tlb.tmiss_count = 0;
4496171313bed39e96f21bc2f9faf2868e267ae3girish tstatp->tpgsz_kernel.tmode_dtlb.ttlb_tlb.tmiss_time = 0;
4496171313bed39e96f21bc2f9faf2868e267ae3girish tstatp->tpgsz_user.tmode_dtlb.ttlb_tlb.tmiss_count = 0;
4496171313bed39e96f21bc2f9faf2868e267ae3girish tstatp->tpgsz_user.tmode_dtlb.ttlb_tlb.tmiss_time = 0;
4496171313bed39e96f21bc2f9faf2868e267ae3girish }
4496171313bed39e96f21bc2f9faf2868e267ae3girish}
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp/*
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp * Page coloring support for hashed cache index mode
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp */
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp/*
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp * Node id bits from machine description (MD). Node id distinguishes
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp * local versus remote memory. Because of MPO, page allocation does
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp * not cross node boundaries. Therefore, remove the node id bits from
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp * the color, since they are fixed. Either bit 30, or 31:30 in
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp * Victoria Falls processors.
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp * The number of node id bits is always 0 in Niagara2.
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp */
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dptypedef struct n2color {
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp uchar_t nnbits; /* number of node id bits */
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp uchar_t nnmask; /* mask for node id bits */
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp uchar_t lomask; /* mask for bits below node id */
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp uchar_t lobits; /* number of bits below node id */
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp} n2color_t;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dpn2color_t n2color[MMU_PAGE_SIZES];
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dpstatic uchar_t nhbits[] = {7, 7, 6, 5, 5, 5};
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp/*
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp * Remove node id bits from color bits 32:28.
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp * This will reduce the number of colors.
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp * No change if number of node bits is zero.
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp */
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dpstatic inline uint_t
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dpn2_hash2color(uint_t color, uchar_t szc)
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp{
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp n2color_t m = n2color[szc];
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp if (m.nnbits > 0) {
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp color = ((color >> m.nnbits) & ~m.lomask) | (color & m.lomask);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp ASSERT((color & ~(hw_page_array[szc].hp_colors - 1)) == 0);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp }
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp return (color);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp}
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp/*
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp * Restore node id bits into page color.
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp * This will increase the number of colors to match N2.
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp * No change if number of node bits is zero.
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp */
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dpstatic inline uint_t
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dpn2_color2hash(uint_t color, uchar_t szc, uint_t node)
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp{
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp n2color_t m = n2color[szc];
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp if (m.nnbits > 0) {
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp color = ((color & ~m.lomask) << m.nnbits) | (color & m.lomask);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp color |= (node & m.nnmask) << m.lobits;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp }
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp return (color);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp}
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp/* NI2 L2$ index is pa[32:28]^pa[17:13].pa[19:18]^pa[12:11].pa[10:6] */
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp/*
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp * iterator NULL means pfn is VA, do not adjust ra_to_pa
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp * iterator (-1) means pfn is RA, need to convert to PA
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp * iterator non-null means pfn is RA, use ra_to_pa
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp */
102033aa92edf302ad31b3bdd7c6fcd2d6910903dpuint_t
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dppage_pfn_2_color_cpu(pfn_t pfn, uchar_t szc, void *cookie)
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp{
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp mem_node_iterator_t *it = cookie;
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp uint_t color;
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp ASSERT(szc <= TTE256M);
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp if (it == ((mem_node_iterator_t *)(-1))) {
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp pfn = plat_rapfn_to_papfn(pfn);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp } else if (it != NULL) {
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp ASSERT(pfn >= it->mi_mblock_base && pfn <= it->mi_mblock_end);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp pfn = pfn + it->mi_ra_to_pa;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp }
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp pfn = PFN_BASE(pfn, szc);
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp color = ((pfn >> 15) ^ pfn) & 0x1f;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp if (szc < TTE4M) {
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp /* 19:18 */
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp color = (color << 2) | ((pfn >> 5) & 0x3);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp if (szc > TTE64K)
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp color >>= 1; /* 19 */
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp }
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp return (n2_hash2color(color, szc));
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp}
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dpstatic uint_t
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dppage_papfn_2_color_cpu(pfn_t papfn, uchar_t szc)
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp{
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp uint_t color;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp ASSERT(szc <= TTE256M);
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp papfn = PFN_BASE(papfn, szc);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp color = ((papfn >> 15) ^ papfn) & 0x1f;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp if (szc < TTE4M) {
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp /* 19:18 */
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp color = (color << 2) | ((papfn >> 5) & 0x3);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp if (szc > TTE64K)
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp color >>= 1; /* 19 */
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp }
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp return (color);
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp}
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp#if TTE256M != 5
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp#error TTE256M is not 5
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp#endif
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
102033aa92edf302ad31b3bdd7c6fcd2d6910903dpuint_t
102033aa92edf302ad31b3bdd7c6fcd2d6910903dppage_get_nsz_color_mask_cpu(uchar_t szc, uint_t mask)
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp{
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp static uint_t ni2_color_masks[5] = {0x63, 0x1e, 0x3e, 0x1f, 0x1f};
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp ASSERT(szc < TTE256M);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp mask = n2_color2hash(mask, szc, 0);
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp mask &= ni2_color_masks[szc];
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp if (szc == TTE64K || szc == TTE512K)
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp mask >>= 1;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp return (n2_hash2color(mask, szc + 1));
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp}
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
102033aa92edf302ad31b3bdd7c6fcd2d6910903dpuint_t
102033aa92edf302ad31b3bdd7c6fcd2d6910903dppage_get_nsz_color_cpu(uchar_t szc, uint_t color)
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp{
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp ASSERT(szc < TTE256M);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp color = n2_color2hash(color, szc, 0);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp if (szc == TTE64K || szc == TTE512K)
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp color >>= 1;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp return (n2_hash2color(color, szc + 1));
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp}
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
102033aa92edf302ad31b3bdd7c6fcd2d6910903dpuint_t
102033aa92edf302ad31b3bdd7c6fcd2d6910903dppage_get_color_shift_cpu(uchar_t szc, uchar_t nszc)
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp{
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp uint_t s;
ef29e9078142ba78702f73f4854d952174aca80bsusans ASSERT(nszc >= szc);
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp ASSERT(nszc <= TTE256M);
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp s = nhbits[szc] - n2color[szc].nnbits;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp s -= nhbits[nszc] - n2color[nszc].nnbits;
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp return (s);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp}
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dpuint_t
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dppage_convert_color_cpu(uint_t ncolor, uchar_t szc, uchar_t nszc)
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp{
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp uint_t color;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp ASSERT(nszc > szc);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp ASSERT(nszc <= TTE256M);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp ncolor = n2_color2hash(ncolor, nszc, 0);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp color = ncolor << (nhbits[szc] - nhbits[nszc]);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp color = n2_hash2color(color, szc);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp return (color);
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp}
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp#define PAPFN_2_MNODE(pfn) \
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp (((pfn) & it->mi_mnode_pfn_mask) >> it->mi_mnode_pfn_shift)
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp/*ARGSUSED*/
102033aa92edf302ad31b3bdd7c6fcd2d6910903dppfn_t
102033aa92edf302ad31b3bdd7c6fcd2d6910903dppage_next_pfn_for_color_cpu(pfn_t pfn, uchar_t szc, uint_t color,
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp uint_t ceq_mask, uint_t color_mask, void *cookie)
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp{
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp mem_node_iterator_t *it = cookie;
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp pfn_t pstep = PNUM_SIZE(szc);
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp pfn_t npfn, pfn_ceq_mask, pfn_color;
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp pfn_t tmpmask, mask = (pfn_t)-1;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp uint_t pfnmn;
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp ASSERT((color & ~ceq_mask) == 0);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp ASSERT(pfn >= it->mi_mblock_base && pfn <= it->mi_mblock_end);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp /* convert RA to PA for accurate color calculation */
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp if (it->mi_init) {
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp /* first call after it, so cache these values */
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp it->mi_hash_ceq_mask =
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp n2_color2hash(ceq_mask, szc, it->mi_mnode_mask);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp it->mi_hash_color =
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp n2_color2hash(color, szc, it->mi_mnode);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp it->mi_init = 0;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp } else {
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp ASSERT(it->mi_hash_ceq_mask ==
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp n2_color2hash(ceq_mask, szc, it->mi_mnode_mask));
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp ASSERT(it->mi_hash_color ==
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp n2_color2hash(color, szc, it->mi_mnode));
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp }
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp ceq_mask = it->mi_hash_ceq_mask;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp color = it->mi_hash_color;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp pfn += it->mi_ra_to_pa;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp /* restart here when we switch memblocks */
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dpnext_mem_block:
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp if (szc <= TTE64K) {
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp pfnmn = PAPFN_2_MNODE(pfn);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp }
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp if (((page_papfn_2_color_cpu(pfn, szc) ^ color) & ceq_mask) == 0 &&
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp (szc > TTE64K || pfnmn == it->mi_mnode)) {
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp /* we start from the page with correct color */
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp if (szc >= TTE512K) {
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp if (szc >= TTE4M) {
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp /* page color is PA[32:28] */
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp pfn_ceq_mask = ceq_mask << 15;
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp } else {
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp /* page color is PA[32:28].PA[19:19] */
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp pfn_ceq_mask = ((ceq_mask & 1) << 6) |
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp ((ceq_mask >> 1) << 15);
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp }
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp npfn = ADD_MASKED(pfn, pstep, pfn_ceq_mask, mask);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp goto done;
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp } else {
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp /*
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp * We deal 64K or 8K page. Check if we could the
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp * satisfy the request without changing PA[32:28]
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp */
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp pfn_ceq_mask = ((ceq_mask & 3) << 5) | (ceq_mask >> 2);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp pfn_ceq_mask |= it->mi_mnode_pfn_mask;
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp npfn = ADD_MASKED(pfn, pstep, pfn_ceq_mask, mask);
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp if ((((npfn ^ pfn) >> 15) & 0x1f) == 0)
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp goto done;
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp /*
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp * for next pfn we have to change bits PA[32:28]
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp * set PA[63:28] and PA[19:18] of the next pfn
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp */
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp npfn = (pfn >> 15) << 15;
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp npfn |= (ceq_mask & color & 3) << 5;
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp pfn_ceq_mask = (szc == TTE8K) ? 0 :
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp (ceq_mask & 0x1c) << 13;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp pfn_ceq_mask |= it->mi_mnode_pfn_mask;
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp npfn = ADD_MASKED(npfn, (1 << 15), pfn_ceq_mask, mask);
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp /*
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp * set bits PA[17:13] to match the color
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp */
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp npfn |= ((npfn >> 15) ^ (color >> 2)) & (ceq_mask >> 2);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp goto done;
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp }
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp }
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp /*
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp * we start from the page with incorrect color - rare case
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp */
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp if (szc >= TTE512K) {
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp if (szc >= TTE4M) {
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp /* page color is in bits PA[32:28] */
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp npfn = ((pfn >> 20) << 20) | (color << 15);
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp pfn_ceq_mask = (ceq_mask << 15) | 0x7fff;
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp } else {
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp /* try get the right color by changing bit PA[19:19] */
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp npfn = pfn + pstep;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp if (((page_papfn_2_color_cpu(npfn, szc) ^ color) &
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp ceq_mask) == 0)
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp goto done;
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp /* page color is PA[32:28].PA[19:19] */
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp pfn_ceq_mask = ((ceq_mask & 1) << 6) |
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp ((ceq_mask >> 1) << 15) | (0xff << 7);
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp pfn_color = ((color & 1) << 6) | ((color >> 1) << 15);
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp npfn = ((pfn >> 20) << 20) | pfn_color;
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp }
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp while (npfn <= pfn) {
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp npfn = ADD_MASKED(npfn, pstep, pfn_ceq_mask, mask);
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp }
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp goto done;
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp }
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp /*
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp * We deal 64K or 8K page of incorrect color.
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp * Try correcting color without changing PA[32:28]
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp */
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp pfn_ceq_mask = ((ceq_mask & 3) << 5) | (ceq_mask >> 2);
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp pfn_color = ((color & 3) << 5) | (color >> 2);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp if (pfnmn == it->mi_mnode) {
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp npfn = (pfn & ~(pfn_t)0x7f);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp npfn |= (((pfn >> 15) & 0x1f) ^ pfn_color) & pfn_ceq_mask;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp npfn = (szc == TTE64K) ? (npfn & ~(pfn_t)0x7) : npfn;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp if (((page_papfn_2_color_cpu(npfn, szc) ^ color) &
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp ceq_mask) == 0) {
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp /* the color is fixed - find the next page */
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp pfn_ceq_mask |= it->mi_mnode_pfn_mask;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp while (npfn <= pfn) {
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp npfn = ADD_MASKED(npfn, pstep, pfn_ceq_mask,
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp mask);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp }
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp if ((((npfn ^ pfn) >> 15) & 0x1f) == 0)
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp goto done;
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp }
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp }
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp /* to fix the color need to touch PA[32:28] */
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp npfn = (szc == TTE8K) ? ((pfn >> 15) << 15) :
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp (((pfn >> 18) << 18) | ((color & 0x1c) << 13));
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp /* fix mnode if input pfn is in the wrong mnode. */
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp if ((pfnmn = PAPFN_2_MNODE(npfn)) != it->mi_mnode) {
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp npfn += ((it->mi_mnode - pfnmn) & it->mi_mnode_mask) <<
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp it->mi_mnode_pfn_shift;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp }
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp tmpmask = (szc == TTE8K) ? 0 : (ceq_mask & 0x1c) << 13;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp tmpmask |= it->mi_mnode_pfn_mask;
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp while (npfn <= pfn) {
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp npfn = ADD_MASKED(npfn, (1 << 15), tmpmask, mask);
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp }
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp /* set bits PA[19:13] to match the color */
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp npfn |= (((npfn >> 15) & 0x1f) ^ pfn_color) & pfn_ceq_mask;
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp npfn = (szc == TTE64K) ? (npfn & ~(pfn_t)0x7) : npfn;
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dpdone:
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp ASSERT(((page_papfn_2_color_cpu(npfn, szc) ^ color) & ceq_mask) == 0);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp ASSERT(PAPFN_2_MNODE(npfn) == it->mi_mnode);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp /* PA to RA */
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp npfn -= it->mi_ra_to_pa;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp /* check for possible memblock switch */
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp if (npfn > it->mi_mblock_end) {
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp pfn = plat_mem_node_iterator_init(npfn, it->mi_mnode, it, 0);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp if (pfn == (pfn_t)-1)
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp return (pfn);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp ASSERT(pfn >= it->mi_mblock_base && pfn <= it->mi_mblock_end);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp pfn += it->mi_ra_to_pa;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp goto next_mem_block;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp }
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp return (npfn);
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp}
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp/*
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp * init page coloring
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp * VF encodes node_id for an L-group in either bit 30 or 31:30,
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp * which effectively reduces the number of colors available per mnode.
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp */
102033aa92edf302ad31b3bdd7c6fcd2d6910903dpvoid
102033aa92edf302ad31b3bdd7c6fcd2d6910903dppage_coloring_init_cpu()
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp{
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp int i;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp uchar_t id;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp uchar_t lo;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp uchar_t hi;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp n2color_t m;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp mem_node_iterator_t it;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp static uchar_t idmask[] = {0, 0x7, 0x1f, 0x1f, 0x1f, 0x1f};
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp
284953f54477c99e3ce09e49b06e66684ec582bcdp for (i = 0; i < max_mem_nodes; i++) {
284953f54477c99e3ce09e49b06e66684ec582bcdp memset(&it, 0, sizeof (it));
284953f54477c99e3ce09e49b06e66684ec582bcdp if (plat_mem_node_iterator_init(0, i, &it, 1) != (pfn_t)-1)
284953f54477c99e3ce09e49b06e66684ec582bcdp break;
284953f54477c99e3ce09e49b06e66684ec582bcdp }
284953f54477c99e3ce09e49b06e66684ec582bcdp ASSERT(i < max_mem_nodes);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp for (i = 0; i < mmu_page_sizes; i++) {
b02e9a2d4d2071d770e5aa9ae8f83f2bbe1f2cedsvemuri (void) memset(&m, 0, sizeof (m));
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp id = it.mi_mnode_pfn_mask >> 15; /* node id mask */
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp id &= idmask[i];
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp lo = lowbit(id);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp if (lo > 0) {
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp hi = highbit(id);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp m.nnbits = hi - lo + 1;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp m.nnmask = (1 << m.nnbits) - 1;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp lo += nhbits[i] - 5;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp m.lomask = (1 << (lo - 1)) - 1;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp m.lobits = lo - 1;
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp }
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp hw_page_array[i].hp_colors = 1 << (nhbits[i] - m.nnbits);
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp n2color[i] = m;
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp }
102033aa92edf302ad31b3bdd7c6fcd2d6910903dp}
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp/*
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp * group colorequiv colors on N2 by low order bits of the color first
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp */
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdpvoid
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdppage_set_colorequiv_arr_cpu(void)
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp{
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp static uint_t nequiv_shades_log2[MMU_PAGE_SIZES] = {2, 5, 0, 0, 0, 0};
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp
ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2dp nequiv_shades_log2[1] -= n2color[1].nnbits;
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp if (colorequiv > 1) {
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp int i;
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp uint_t sv_a = lowbit(colorequiv) - 1;
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp if (sv_a > 15)
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp sv_a = 15;
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp for (i = 0; i < MMU_PAGE_SIZES; i++) {
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp uint_t colors;
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp uint_t a = sv_a;
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp if ((colors = hw_page_array[i].hp_colors) <= 1)
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp continue;
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp while ((colors >> a) == 0)
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp a--;
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp if (a > (colorequivszc[i] & 0xf) +
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp (colorequivszc[i] >> 4)) {
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp if (a <= nequiv_shades_log2[i]) {
59ac0c1669407488b67ae9e273667a340dccc611davemq colorequivszc[i] = (uchar_t)a;
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp } else {
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp colorequivszc[i] =
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp ((a - nequiv_shades_log2[i]) << 4) |
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp nequiv_shades_log2[i];
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp }
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp }
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp }
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp }
fe70c9cf90dfc23d18485fb7b4b20a1175d53a8bdp}