xref: /titanic_50/usr/src/uts/sun4v/cpu/niagara.c (revision ce8eb11a8717b4a57c68fd77ab9f8aac15b16bf2)
17c478bd9Sstevel@tonic-gate /*
27c478bd9Sstevel@tonic-gate  * CDDL HEADER START
37c478bd9Sstevel@tonic-gate  *
47c478bd9Sstevel@tonic-gate  * The contents of this file are subject to the terms of the
5c56c1e58Sgirish  * Common Development and Distribution License (the "License").
6c56c1e58Sgirish  * You may not use this file except in compliance with the License.
77c478bd9Sstevel@tonic-gate  *
87c478bd9Sstevel@tonic-gate  * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
97c478bd9Sstevel@tonic-gate  * or http://www.opensolaris.org/os/licensing.
107c478bd9Sstevel@tonic-gate  * See the License for the specific language governing permissions
117c478bd9Sstevel@tonic-gate  * and limitations under the License.
127c478bd9Sstevel@tonic-gate  *
137c478bd9Sstevel@tonic-gate  * When distributing Covered Code, include this CDDL HEADER in each
147c478bd9Sstevel@tonic-gate  * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
157c478bd9Sstevel@tonic-gate  * If applicable, add the following below this CDDL HEADER, with the
167c478bd9Sstevel@tonic-gate  * fields enclosed by brackets "[]" replaced with your own identifying
177c478bd9Sstevel@tonic-gate  * information: Portions Copyright [yyyy] [name of copyright owner]
187c478bd9Sstevel@tonic-gate  *
197c478bd9Sstevel@tonic-gate  * CDDL HEADER END
207c478bd9Sstevel@tonic-gate  */
21459190a5Srsmaeda 
227c478bd9Sstevel@tonic-gate /*
23fb2f18f8Sesaxe  * Copyright 2007 Sun Microsystems, Inc.  All rights reserved.
247c478bd9Sstevel@tonic-gate  * Use is subject to license terms.
257c478bd9Sstevel@tonic-gate  */
267c478bd9Sstevel@tonic-gate 
277c478bd9Sstevel@tonic-gate #pragma ident	"%Z%%M%	%I%	%E% SMI"
287c478bd9Sstevel@tonic-gate 
297c478bd9Sstevel@tonic-gate #include <sys/types.h>
307c478bd9Sstevel@tonic-gate #include <sys/systm.h>
317c478bd9Sstevel@tonic-gate #include <sys/archsystm.h>
327c478bd9Sstevel@tonic-gate #include <sys/machparam.h>
337c478bd9Sstevel@tonic-gate #include <sys/machsystm.h>
347c478bd9Sstevel@tonic-gate #include <sys/cpu.h>
357c478bd9Sstevel@tonic-gate #include <sys/elf_SPARC.h>
367c478bd9Sstevel@tonic-gate #include <vm/hat_sfmmu.h>
377c478bd9Sstevel@tonic-gate #include <vm/page.h>
387c478bd9Sstevel@tonic-gate #include <sys/cpuvar.h>
397c478bd9Sstevel@tonic-gate #include <sys/async.h>
407c478bd9Sstevel@tonic-gate #include <sys/cmn_err.h>
417c478bd9Sstevel@tonic-gate #include <sys/debug.h>
427c478bd9Sstevel@tonic-gate #include <sys/dditypes.h>
437c478bd9Sstevel@tonic-gate #include <sys/sunddi.h>
447c478bd9Sstevel@tonic-gate #include <sys/cpu_module.h>
457c478bd9Sstevel@tonic-gate #include <sys/prom_debug.h>
467c478bd9Sstevel@tonic-gate #include <sys/vmsystm.h>
477c478bd9Sstevel@tonic-gate #include <sys/prom_plat.h>
487c478bd9Sstevel@tonic-gate #include <sys/sysmacros.h>
497c478bd9Sstevel@tonic-gate #include <sys/intreg.h>
507c478bd9Sstevel@tonic-gate #include <sys/machtrap.h>
517c478bd9Sstevel@tonic-gate #include <sys/ontrap.h>
527c478bd9Sstevel@tonic-gate #include <sys/ivintr.h>
537c478bd9Sstevel@tonic-gate #include <sys/atomic.h>
547c478bd9Sstevel@tonic-gate #include <sys/panic.h>
557c478bd9Sstevel@tonic-gate #include <sys/dtrace.h>
567c478bd9Sstevel@tonic-gate #include <sys/simulate.h>
577c478bd9Sstevel@tonic-gate #include <sys/fault.h>
58ce0352ebSgirish #include <sys/niagararegs.h>
59ce0352ebSgirish #include <sys/trapstat.h>
60c56c1e58Sgirish #include <sys/hsvc.h>
617c478bd9Sstevel@tonic-gate 
621ae08745Sheppo #define	NI_MMU_PAGESIZE_MASK	((1 << TTE8K) | (1 << TTE64K) | (1 << TTE4M) \
631ae08745Sheppo 				    | (1 << TTE256M))
647c478bd9Sstevel@tonic-gate 
657c478bd9Sstevel@tonic-gate uint_t root_phys_addr_lo_mask = 0xffffffffU;
66ce0352ebSgirish static niagara_mmustat_t *cpu_tstat_va;		/* VA of mmustat buffer */
67ce0352ebSgirish static uint64_t cpu_tstat_pa;			/* PA of mmustat buffer */
68c56c1e58Sgirish char cpu_module_name[] = "SUNW,UltraSPARC-T1";
697c478bd9Sstevel@tonic-gate 
70c56c1e58Sgirish /*
71c56c1e58Sgirish  * Hypervisor services information for the NIAGARA CPU module
72c56c1e58Sgirish  */
73c56c1e58Sgirish static boolean_t niagara_hsvc_available = B_TRUE;
74c56c1e58Sgirish static uint64_t niagara_sup_minor;		/* Supported minor number */
75c56c1e58Sgirish static hsvc_info_t niagara_hsvc = {
76c56c1e58Sgirish 	HSVC_REV_1, NULL, HSVC_GROUP_NIAGARA_CPU, 1, 0, cpu_module_name
77c56c1e58Sgirish };
787c478bd9Sstevel@tonic-gate 
797c478bd9Sstevel@tonic-gate void
807c478bd9Sstevel@tonic-gate cpu_setup(void)
817c478bd9Sstevel@tonic-gate {
827c478bd9Sstevel@tonic-gate 	extern int mmu_exported_pagesize_mask;
837c478bd9Sstevel@tonic-gate 	extern int cpc_has_overflow_intr;
84c56c1e58Sgirish 	int status;
851ae08745Sheppo 	char *ni_isa_set[] = {
861ae08745Sheppo 	    "sparcv9+vis",
871ae08745Sheppo 	    "sparcv9+vis2",
881ae08745Sheppo 	    "sparcv8plus+vis",
891ae08745Sheppo 	    "sparcv8plus+vis2",
901ae08745Sheppo 	    NULL
911ae08745Sheppo 	};
92c56c1e58Sgirish 
93c56c1e58Sgirish 	/*
94c56c1e58Sgirish 	 * Negotiate the API version for Niagara specific hypervisor
95c56c1e58Sgirish 	 * services.
96c56c1e58Sgirish 	 */
97c56c1e58Sgirish 	status = hsvc_register(&niagara_hsvc, &niagara_sup_minor);
98c56c1e58Sgirish 	if (status != 0) {
99c56c1e58Sgirish 		cmn_err(CE_WARN, "%s: cannot negotiate hypervisor services "
10080ab886dSwesolows 		    "group: 0x%lx major: 0x%lx minor: 0x%lx errno: %d\n",
101c56c1e58Sgirish 		    niagara_hsvc.hsvc_modname, niagara_hsvc.hsvc_group,
102c56c1e58Sgirish 		    niagara_hsvc.hsvc_major, niagara_hsvc.hsvc_minor, status);
103c56c1e58Sgirish 		niagara_hsvc_available = B_FALSE;
104c56c1e58Sgirish 	}
1057c478bd9Sstevel@tonic-gate 
1061ae08745Sheppo 	/*
1071ae08745Sheppo 	 * The setup common to all CPU modules is done in cpu_setup_common
1081ae08745Sheppo 	 * routine.
1091ae08745Sheppo 	 */
1101ae08745Sheppo 	cpu_setup_common(ni_isa_set);
1111ae08745Sheppo 
1127c478bd9Sstevel@tonic-gate 	cache |= (CACHE_PTAG | CACHE_IOCOHERENT);
1137c478bd9Sstevel@tonic-gate 
1141ae08745Sheppo 	if (broken_md_flag) {
1157c478bd9Sstevel@tonic-gate 		/*
1161ae08745Sheppo 		 * Turn on the missing bits supported by Niagara CPU in
1171ae08745Sheppo 		 * MMU pagesize mask returned by MD.
1187c478bd9Sstevel@tonic-gate 		 */
1191ae08745Sheppo 		mmu_exported_pagesize_mask |= NI_MMU_PAGESIZE_MASK;
1201ae08745Sheppo 	} else {
1211ae08745Sheppo 		if ((mmu_exported_pagesize_mask &
1221ae08745Sheppo 		    DEFAULT_SUN4V_MMU_PAGESIZE_MASK) !=
1231ae08745Sheppo 		    DEFAULT_SUN4V_MMU_PAGESIZE_MASK)
1241ae08745Sheppo 			cmn_err(CE_PANIC, "machine description"
1251ae08745Sheppo 			    " does not have required sun4v page sizes"
1261ae08745Sheppo 			    " 8K, 64K and 4M: MD mask is 0x%x",
1271ae08745Sheppo 			    mmu_exported_pagesize_mask);
1287c478bd9Sstevel@tonic-gate 	}
1297c478bd9Sstevel@tonic-gate 
1307c478bd9Sstevel@tonic-gate 	cpu_hwcap_flags |= AV_SPARC_ASI_BLK_INIT;
1317c478bd9Sstevel@tonic-gate 
1327c478bd9Sstevel@tonic-gate 	/*
13307e2e5e8Sgirish 	 * Niagara supports a 48-bit subset of the full 64-bit virtual
13407e2e5e8Sgirish 	 * address space. Virtual addresses between 0x0000800000000000
13507e2e5e8Sgirish 	 * and 0xffff.7fff.ffff.ffff inclusive lie within a "VA Hole"
13607e2e5e8Sgirish 	 * and must never be mapped. In addition, software must not use
13707e2e5e8Sgirish 	 * pages within 4GB of the VA hole as instruction pages to
13807e2e5e8Sgirish 	 * avoid problems with prefetching into the VA hole.
1397c478bd9Sstevel@tonic-gate 	 */
1401ae08745Sheppo 	hole_start = (caddr_t)((1ull << (va_bits - 1)) - (1ull << 32));
1411ae08745Sheppo 	hole_end = (caddr_t)((0ull - (1ull << (va_bits - 1))) + (1ull << 32));
1427c478bd9Sstevel@tonic-gate 
1437c478bd9Sstevel@tonic-gate 	/*
1447c478bd9Sstevel@tonic-gate 	 * Niagara has a performance counter overflow interrupt
1457c478bd9Sstevel@tonic-gate 	 */
1467c478bd9Sstevel@tonic-gate 	cpc_has_overflow_intr = 1;
14705d3dc4bSpaulsan 
14805d3dc4bSpaulsan 	shctx_on = 0;
1497c478bd9Sstevel@tonic-gate }
1507c478bd9Sstevel@tonic-gate 
1511ae08745Sheppo #define	MB(n)	((n) * 1024 * 1024)
1527c478bd9Sstevel@tonic-gate /*
1537c478bd9Sstevel@tonic-gate  * Set the magic constants of the implementation.
1547c478bd9Sstevel@tonic-gate  */
1557c478bd9Sstevel@tonic-gate void
1567c478bd9Sstevel@tonic-gate cpu_fiximp(struct cpu_node *cpunode)
1577c478bd9Sstevel@tonic-gate {
1587c478bd9Sstevel@tonic-gate 	/*
1591ae08745Sheppo 	 * The Cache node is optional in MD. Therefore in case "Cache"
1601ae08745Sheppo 	 * node does not exists in MD, set the default L2 cache associativity,
1611ae08745Sheppo 	 * size, linesize.
1627c478bd9Sstevel@tonic-gate 	 */
1637c478bd9Sstevel@tonic-gate 	if (cpunode->ecache_size == 0)
1641ae08745Sheppo 		cpunode->ecache_size = MB(3);
1657c478bd9Sstevel@tonic-gate 	if (cpunode->ecache_linesize == 0)
1667c478bd9Sstevel@tonic-gate 		cpunode->ecache_linesize = 64;
1677c478bd9Sstevel@tonic-gate 	if (cpunode->ecache_associativity == 0)
1687c478bd9Sstevel@tonic-gate 		cpunode->ecache_associativity = 12;
1697c478bd9Sstevel@tonic-gate }
1707c478bd9Sstevel@tonic-gate 
1717c478bd9Sstevel@tonic-gate void
172459190a5Srsmaeda cpu_map_exec_units(struct cpu *cp)
1737c478bd9Sstevel@tonic-gate {
174459190a5Srsmaeda 	ASSERT(MUTEX_HELD(&cpu_lock));
1757c478bd9Sstevel@tonic-gate 
17670f54eadSesaxe 	/*
177fb2f18f8Sesaxe 	 * The cpu_ipipe and cpu_fpu fields are initialized based on
178459190a5Srsmaeda 	 * the execution unit sharing information from the MD. They
179459190a5Srsmaeda 	 * default to the CPU id in the absence of such information.
18070f54eadSesaxe 	 */
1811ae08745Sheppo 	cp->cpu_m.cpu_ipipe = cpunodes[cp->cpu_id].exec_unit_mapping;
1821ae08745Sheppo 	if (cp->cpu_m.cpu_ipipe == NO_EU_MAPPING_FOUND)
1831ae08745Sheppo 		cp->cpu_m.cpu_ipipe = (id_t)(cp->cpu_id);
18470f54eadSesaxe 
185fb2f18f8Sesaxe 	cp->cpu_m.cpu_fpu = cpunodes[cp->cpu_id].fpu_mapping;
186fb2f18f8Sesaxe 	if (cp->cpu_m.cpu_fpu == NO_EU_MAPPING_FOUND)
187fb2f18f8Sesaxe 		cp->cpu_m.cpu_fpu = (id_t)(cp->cpu_id);
188fb2f18f8Sesaxe 
189fb2f18f8Sesaxe 	/*
190fb2f18f8Sesaxe 	 * Niagara defines the the core to be at the ipipe level
191fb2f18f8Sesaxe 	 */
192fb2f18f8Sesaxe 	cp->cpu_m.cpu_core = cp->cpu_m.cpu_ipipe;
19359ac0c16Sdavemq 
19459ac0c16Sdavemq 	/*
19559ac0c16Sdavemq 	 * Niagara systems just have one chip. Therefore, the chip id
196*ce8eb11aSdp78419 	 * mpipe id are always 0.
19759ac0c16Sdavemq 	 */
19859ac0c16Sdavemq 	cp->cpu_m.cpu_chip = 0;
199*ce8eb11aSdp78419 	cp->cpu_m.cpu_mpipe = 0;
200459190a5Srsmaeda }
201459190a5Srsmaeda 
202459190a5Srsmaeda static int niagara_cpucnt;
203459190a5Srsmaeda 
204459190a5Srsmaeda void
205459190a5Srsmaeda cpu_init_private(struct cpu *cp)
206459190a5Srsmaeda {
207459190a5Srsmaeda 	extern void niagara_kstat_init(void);
208fb2f18f8Sesaxe 
2097c478bd9Sstevel@tonic-gate 	ASSERT(MUTEX_HELD(&cpu_lock));
210459190a5Srsmaeda 
211459190a5Srsmaeda 	cpu_map_exec_units(cp);
212459190a5Srsmaeda 
213459190a5Srsmaeda 	if ((niagara_cpucnt++ == 0) && (niagara_hsvc_available == B_TRUE))
214459190a5Srsmaeda 		niagara_kstat_init();
2157c478bd9Sstevel@tonic-gate }
2167c478bd9Sstevel@tonic-gate 
217459190a5Srsmaeda /*ARGSUSED*/
2187c478bd9Sstevel@tonic-gate void
2197c478bd9Sstevel@tonic-gate cpu_uninit_private(struct cpu *cp)
2207c478bd9Sstevel@tonic-gate {
221459190a5Srsmaeda 	extern void niagara_kstat_fini(void);
2227c478bd9Sstevel@tonic-gate 
2237c478bd9Sstevel@tonic-gate 	ASSERT(MUTEX_HELD(&cpu_lock));
224459190a5Srsmaeda 
225459190a5Srsmaeda 	if ((--niagara_cpucnt == 0) && (niagara_hsvc_available == B_TRUE))
226459190a5Srsmaeda 		niagara_kstat_fini();
2277c478bd9Sstevel@tonic-gate }
2287c478bd9Sstevel@tonic-gate 
2297c478bd9Sstevel@tonic-gate /*
2307c478bd9Sstevel@tonic-gate  * On Niagara, any flush will cause all preceding stores to be
2317c478bd9Sstevel@tonic-gate  * synchronized wrt the i$, regardless of address or ASI.  In fact,
2327c478bd9Sstevel@tonic-gate  * the address is ignored, so we always flush address 0.
2337c478bd9Sstevel@tonic-gate  */
2347c478bd9Sstevel@tonic-gate void
2357c478bd9Sstevel@tonic-gate dtrace_flush_sec(uintptr_t addr)
2367c478bd9Sstevel@tonic-gate {
2377c478bd9Sstevel@tonic-gate 	doflush(0);
2387c478bd9Sstevel@tonic-gate }
2397c478bd9Sstevel@tonic-gate 
2407c478bd9Sstevel@tonic-gate #define	IS_FLOAT(i) (((i) & 0x1000000) != 0)
2417c478bd9Sstevel@tonic-gate #define	IS_IBIT_SET(x)	(x & 0x2000)
2427c478bd9Sstevel@tonic-gate #define	IS_VIS1(op, op3)(op == 2 && op3 == 0x36)
2437c478bd9Sstevel@tonic-gate #define	IS_PARTIAL_OR_SHORT_FLOAT_LD_ST(op, op3, asi)		\
2447c478bd9Sstevel@tonic-gate 		(op == 3 && (op3 == IOP_V8_LDDFA ||		\
2457c478bd9Sstevel@tonic-gate 		op3 == IOP_V8_STDFA) &&	asi > ASI_SNFL)
2467c478bd9Sstevel@tonic-gate int
2477c478bd9Sstevel@tonic-gate vis1_partial_support(struct regs *rp, k_siginfo_t *siginfo, uint_t *fault)
2487c478bd9Sstevel@tonic-gate {
2497c478bd9Sstevel@tonic-gate 	char *badaddr;
2507c478bd9Sstevel@tonic-gate 	int instr;
2517c478bd9Sstevel@tonic-gate 	uint_t	optype, op3, asi;
2527c478bd9Sstevel@tonic-gate 	uint_t	rd, ignor;
2537c478bd9Sstevel@tonic-gate 
254efaef81fSarao 	if (!USERMODE(rp->r_tstate))
255efaef81fSarao 		return (-1);
2567c478bd9Sstevel@tonic-gate 
2577c478bd9Sstevel@tonic-gate 	instr = fetch_user_instr((caddr_t)rp->r_pc);
2587c478bd9Sstevel@tonic-gate 
2597c478bd9Sstevel@tonic-gate 	rd = (instr >> 25) & 0x1f;
2607c478bd9Sstevel@tonic-gate 	optype = (instr >> 30) & 0x3;
2617c478bd9Sstevel@tonic-gate 	op3 = (instr >> 19) & 0x3f;
2627c478bd9Sstevel@tonic-gate 	ignor = (instr >> 5) & 0xff;
2637c478bd9Sstevel@tonic-gate 	if (IS_IBIT_SET(instr)) {
2647c478bd9Sstevel@tonic-gate 		asi = (uint32_t)((rp->r_tstate >> TSTATE_ASI_SHIFT) &
2657c478bd9Sstevel@tonic-gate 		    TSTATE_ASI_MASK);
2667c478bd9Sstevel@tonic-gate 	} else {
2677c478bd9Sstevel@tonic-gate 		asi = ignor;
2687c478bd9Sstevel@tonic-gate 	}
2697c478bd9Sstevel@tonic-gate 
2707c478bd9Sstevel@tonic-gate 	if (!IS_VIS1(optype, op3) &&
2717c478bd9Sstevel@tonic-gate 	    !IS_PARTIAL_OR_SHORT_FLOAT_LD_ST(optype, op3, asi)) {
2727c478bd9Sstevel@tonic-gate 		return (-1);
2737c478bd9Sstevel@tonic-gate 	}
2747c478bd9Sstevel@tonic-gate 	switch (simulate_unimp(rp, &badaddr)) {
2757c478bd9Sstevel@tonic-gate 	case SIMU_RETRY:
2767c478bd9Sstevel@tonic-gate 		break;	/* regs are already set up */
2777c478bd9Sstevel@tonic-gate 		/*NOTREACHED*/
2787c478bd9Sstevel@tonic-gate 
2797c478bd9Sstevel@tonic-gate 	case SIMU_SUCCESS:
2807c478bd9Sstevel@tonic-gate 		/*
2817c478bd9Sstevel@tonic-gate 		 * skip the successfully
2827c478bd9Sstevel@tonic-gate 		 * simulated instruction
2837c478bd9Sstevel@tonic-gate 		 */
2847c478bd9Sstevel@tonic-gate 		rp->r_pc = rp->r_npc;
2857c478bd9Sstevel@tonic-gate 		rp->r_npc += 4;
2867c478bd9Sstevel@tonic-gate 		break;
2877c478bd9Sstevel@tonic-gate 		/*NOTREACHED*/
2887c478bd9Sstevel@tonic-gate 
2897c478bd9Sstevel@tonic-gate 	case SIMU_FAULT:
2907c478bd9Sstevel@tonic-gate 		siginfo->si_signo = SIGSEGV;
2917c478bd9Sstevel@tonic-gate 		siginfo->si_code = SEGV_MAPERR;
2927c478bd9Sstevel@tonic-gate 		siginfo->si_addr = badaddr;
2937c478bd9Sstevel@tonic-gate 		*fault = FLTBOUNDS;
2947c478bd9Sstevel@tonic-gate 		break;
2957c478bd9Sstevel@tonic-gate 
2967c478bd9Sstevel@tonic-gate 	case SIMU_DZERO:
2977c478bd9Sstevel@tonic-gate 		siginfo->si_signo = SIGFPE;
2987c478bd9Sstevel@tonic-gate 		siginfo->si_code = FPE_INTDIV;
2997c478bd9Sstevel@tonic-gate 		siginfo->si_addr = (caddr_t)rp->r_pc;
3007c478bd9Sstevel@tonic-gate 		*fault = FLTIZDIV;
3017c478bd9Sstevel@tonic-gate 		break;
3027c478bd9Sstevel@tonic-gate 
3037c478bd9Sstevel@tonic-gate 	case SIMU_UNALIGN:
3047c478bd9Sstevel@tonic-gate 		siginfo->si_signo = SIGBUS;
3057c478bd9Sstevel@tonic-gate 		siginfo->si_code = BUS_ADRALN;
3067c478bd9Sstevel@tonic-gate 		siginfo->si_addr = badaddr;
3077c478bd9Sstevel@tonic-gate 		*fault = FLTACCESS;
3087c478bd9Sstevel@tonic-gate 		break;
3097c478bd9Sstevel@tonic-gate 
3107c478bd9Sstevel@tonic-gate 	case SIMU_ILLEGAL:
3117c478bd9Sstevel@tonic-gate 	default:
3127c478bd9Sstevel@tonic-gate 		siginfo->si_signo = SIGILL;
3137c478bd9Sstevel@tonic-gate 		op3 = (instr >> 19) & 0x3F;
3147c478bd9Sstevel@tonic-gate 		if ((IS_FLOAT(instr) && (op3 == IOP_V8_STQFA) ||
3157c478bd9Sstevel@tonic-gate 		    (op3 == IOP_V8_STDFA)))
3167c478bd9Sstevel@tonic-gate 			siginfo->si_code = ILL_ILLADR;
3177c478bd9Sstevel@tonic-gate 		else
3187c478bd9Sstevel@tonic-gate 			siginfo->si_code = ILL_ILLOPC;
3197c478bd9Sstevel@tonic-gate 		siginfo->si_addr = (caddr_t)rp->r_pc;
3207c478bd9Sstevel@tonic-gate 		*fault = FLTILL;
3217c478bd9Sstevel@tonic-gate 		break;
3227c478bd9Sstevel@tonic-gate 	}
3237c478bd9Sstevel@tonic-gate 	return (0);
3247c478bd9Sstevel@tonic-gate }
325ce0352ebSgirish 
326ce0352ebSgirish /*
327ce0352ebSgirish  * Trapstat support for Niagara processor
328ce0352ebSgirish  */
329ce0352ebSgirish int
330ce0352ebSgirish cpu_trapstat_conf(int cmd)
331ce0352ebSgirish {
332ce0352ebSgirish 	size_t len;
333ce0352ebSgirish 	uint64_t mmustat_pa, hvret;
334ce0352ebSgirish 	int status = 0;
335ce0352ebSgirish 
336c56c1e58Sgirish 	if (niagara_hsvc_available == B_FALSE)
337c56c1e58Sgirish 		return (ENOTSUP);
338c56c1e58Sgirish 
339ce0352ebSgirish 	switch (cmd) {
340ce0352ebSgirish 	case CPU_TSTATCONF_INIT:
341ce0352ebSgirish 		ASSERT(cpu_tstat_va == NULL);
342ce0352ebSgirish 		len = (NCPU+1) * sizeof (niagara_mmustat_t);
343ce0352ebSgirish 		cpu_tstat_va = contig_mem_alloc_align(len,
344ce0352ebSgirish 		    sizeof (niagara_mmustat_t));
345ce0352ebSgirish 		if (cpu_tstat_va == NULL)
346ce0352ebSgirish 			status = EAGAIN;
347ce0352ebSgirish 		else {
348ce0352ebSgirish 			bzero(cpu_tstat_va, len);
349ce0352ebSgirish 			cpu_tstat_pa = va_to_pa(cpu_tstat_va);
350ce0352ebSgirish 		}
351ce0352ebSgirish 		break;
352ce0352ebSgirish 
353ce0352ebSgirish 	case CPU_TSTATCONF_FINI:
354ce0352ebSgirish 		if (cpu_tstat_va) {
355ce0352ebSgirish 			len = (NCPU+1) * sizeof (niagara_mmustat_t);
356ce0352ebSgirish 			contig_mem_free(cpu_tstat_va, len);
357ce0352ebSgirish 			cpu_tstat_va = NULL;
358ce0352ebSgirish 			cpu_tstat_pa = 0;
359ce0352ebSgirish 		}
360ce0352ebSgirish 		break;
361ce0352ebSgirish 
362ce0352ebSgirish 	case CPU_TSTATCONF_ENABLE:
363ce0352ebSgirish 		hvret = hv_niagara_mmustat_conf((cpu_tstat_pa +
364ce0352ebSgirish 		    (CPU->cpu_id+1) * sizeof (niagara_mmustat_t)),
365ce0352ebSgirish 		    (uint64_t *)&mmustat_pa);
366ce0352ebSgirish 		if (hvret != H_EOK)
367ce0352ebSgirish 			status = EINVAL;
368ce0352ebSgirish 		break;
369ce0352ebSgirish 
370ce0352ebSgirish 	case CPU_TSTATCONF_DISABLE:
371ce0352ebSgirish 		hvret = hv_niagara_mmustat_conf(0, (uint64_t *)&mmustat_pa);
372ce0352ebSgirish 		if (hvret != H_EOK)
373ce0352ebSgirish 			status = EINVAL;
374ce0352ebSgirish 		break;
375ce0352ebSgirish 
376ce0352ebSgirish 	default:
377ce0352ebSgirish 		status = EINVAL;
378ce0352ebSgirish 		break;
379ce0352ebSgirish 	}
380ce0352ebSgirish 	return (status);
381ce0352ebSgirish }
382ce0352ebSgirish 
383ce0352ebSgirish void
384ce0352ebSgirish cpu_trapstat_data(void *buf, uint_t tstat_pgszs)
385ce0352ebSgirish {
386ce0352ebSgirish 	niagara_mmustat_t	*mmustatp;
387ce0352ebSgirish 	tstat_pgszdata_t	*tstatp = (tstat_pgszdata_t *)buf;
388ce0352ebSgirish 	int	i, pgcnt;
389ce0352ebSgirish 
390ce0352ebSgirish 	if (cpu_tstat_va == NULL)
391ce0352ebSgirish 		return;
392ce0352ebSgirish 
393ce0352ebSgirish 	mmustatp = &((niagara_mmustat_t *)cpu_tstat_va)[CPU->cpu_id+1];
394ce0352ebSgirish 	if (tstat_pgszs > NIAGARA_MMUSTAT_PGSZS)
395ce0352ebSgirish 		tstat_pgszs = NIAGARA_MMUSTAT_PGSZS;
396ce0352ebSgirish 
397ce0352ebSgirish 	for (i = 0; i < tstat_pgszs; i++, tstatp++) {
398ce0352ebSgirish 		tstatp->tpgsz_kernel.tmode_itlb.ttlb_tlb.tmiss_count =
399ce0352ebSgirish 		    mmustatp->kitsb[i].tsbhit_count;
400ce0352ebSgirish 		tstatp->tpgsz_kernel.tmode_itlb.ttlb_tlb.tmiss_time =
401ce0352ebSgirish 		    mmustatp->kitsb[i].tsbhit_time;
402ce0352ebSgirish 		tstatp->tpgsz_user.tmode_itlb.ttlb_tlb.tmiss_count =
403ce0352ebSgirish 		    mmustatp->uitsb[i].tsbhit_count;
404ce0352ebSgirish 		tstatp->tpgsz_user.tmode_itlb.ttlb_tlb.tmiss_time =
405ce0352ebSgirish 		    mmustatp->uitsb[i].tsbhit_time;
406ce0352ebSgirish 		tstatp->tpgsz_kernel.tmode_dtlb.ttlb_tlb.tmiss_count =
407ce0352ebSgirish 		    mmustatp->kdtsb[i].tsbhit_count;
408ce0352ebSgirish 		tstatp->tpgsz_kernel.tmode_dtlb.ttlb_tlb.tmiss_time =
409ce0352ebSgirish 		    mmustatp->kdtsb[i].tsbhit_time;
410ce0352ebSgirish 		tstatp->tpgsz_user.tmode_dtlb.ttlb_tlb.tmiss_count =
411ce0352ebSgirish 		    mmustatp->udtsb[i].tsbhit_count;
412ce0352ebSgirish 		tstatp->tpgsz_user.tmode_dtlb.ttlb_tlb.tmiss_time =
413ce0352ebSgirish 		    mmustatp->udtsb[i].tsbhit_time;
414ce0352ebSgirish 	}
415ce0352ebSgirish }
416