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 5*ae115bc7Smrj * Common Development and Distribution License (the "License"). 6*ae115bc7Smrj * 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 */ 21*ae115bc7Smrj 227c478bd9Sstevel@tonic-gate /* 23*ae115bc7Smrj * Copyright 2007 Sun Microsystems, Inc. All rights reserved. 247c478bd9Sstevel@tonic-gate * Use is subject to license terms. 257c478bd9Sstevel@tonic-gate */ 26*ae115bc7Smrj 277c478bd9Sstevel@tonic-gate #pragma ident "%Z%%M% %I% %E% SMI" 287c478bd9Sstevel@tonic-gate 297c478bd9Sstevel@tonic-gate #include <sys/systm.h> 307c478bd9Sstevel@tonic-gate #include <sys/cyclic.h> 317c478bd9Sstevel@tonic-gate #include <sys/cyclic_impl.h> 327c478bd9Sstevel@tonic-gate #include <sys/spl.h> 337c478bd9Sstevel@tonic-gate #include <sys/x_call.h> 347c478bd9Sstevel@tonic-gate #include <sys/kmem.h> 357c478bd9Sstevel@tonic-gate #include <sys/machsystm.h> 367c478bd9Sstevel@tonic-gate #include <sys/smp_impldefs.h> 377c478bd9Sstevel@tonic-gate #include <sys/psm_types.h> 38*ae115bc7Smrj #include <sys/psm.h> 397c478bd9Sstevel@tonic-gate #include <sys/atomic.h> 407c478bd9Sstevel@tonic-gate #include <sys/clock.h> 417c478bd9Sstevel@tonic-gate #include <sys/ddi_impldefs.h> 427c478bd9Sstevel@tonic-gate #include <sys/ddi_intr.h> 43e23a7e34Slq150181 #include <sys/avintr.h> 447c478bd9Sstevel@tonic-gate 457c478bd9Sstevel@tonic-gate static int cbe_vector; 467c478bd9Sstevel@tonic-gate static int cbe_ticks = 0; 477c478bd9Sstevel@tonic-gate 487c478bd9Sstevel@tonic-gate static cyc_func_t volatile cbe_xcall_func; 497c478bd9Sstevel@tonic-gate static cpu_t *volatile cbe_xcall_cpu; 507c478bd9Sstevel@tonic-gate static void *cbe_xcall_farg; 517c478bd9Sstevel@tonic-gate static cpuset_t cbe_enabled; 527c478bd9Sstevel@tonic-gate 537c478bd9Sstevel@tonic-gate static ddi_softint_hdl_impl_t cbe_low_hdl = 54e23a7e34Slq150181 {0, NULL, NULL, NULL, 0, NULL, NULL, NULL}; 557c478bd9Sstevel@tonic-gate static ddi_softint_hdl_impl_t cbe_clock_hdl = 56e23a7e34Slq150181 {0, NULL, NULL, NULL, 0, NULL, NULL, NULL}; 577c478bd9Sstevel@tonic-gate 587c478bd9Sstevel@tonic-gate cyclic_id_t cbe_hres_cyclic; 597c478bd9Sstevel@tonic-gate int cbe_psm_timer_mode = TIMER_ONESHOT; 607c478bd9Sstevel@tonic-gate 617c478bd9Sstevel@tonic-gate void cbe_hres_tick(void); 627c478bd9Sstevel@tonic-gate 637c478bd9Sstevel@tonic-gate int 647c478bd9Sstevel@tonic-gate cbe_softclock(void) 657c478bd9Sstevel@tonic-gate { 667c478bd9Sstevel@tonic-gate cyclic_softint(CPU, CY_LOCK_LEVEL); 677c478bd9Sstevel@tonic-gate return (1); 687c478bd9Sstevel@tonic-gate } 697c478bd9Sstevel@tonic-gate 707c478bd9Sstevel@tonic-gate int 717c478bd9Sstevel@tonic-gate cbe_low_level(void) 727c478bd9Sstevel@tonic-gate { 737c478bd9Sstevel@tonic-gate cpu_t *cpu = CPU; 747c478bd9Sstevel@tonic-gate 757c478bd9Sstevel@tonic-gate cyclic_softint(cpu, CY_LOW_LEVEL); 767c478bd9Sstevel@tonic-gate return (1); 777c478bd9Sstevel@tonic-gate } 787c478bd9Sstevel@tonic-gate 797c478bd9Sstevel@tonic-gate /* 807c478bd9Sstevel@tonic-gate * We can be in cbe_fire() either due to a cyclic-induced cross call, or due 817c478bd9Sstevel@tonic-gate * to the timer firing at level-14. Because cyclic_fire() can tolerate 827c478bd9Sstevel@tonic-gate * spurious calls, it would not matter if we called cyclic_fire() in both 837c478bd9Sstevel@tonic-gate * cases. 847c478bd9Sstevel@tonic-gate */ 857c478bd9Sstevel@tonic-gate int 867c478bd9Sstevel@tonic-gate cbe_fire(void) 877c478bd9Sstevel@tonic-gate { 887c478bd9Sstevel@tonic-gate cpu_t *cpu = CPU; 897c478bd9Sstevel@tonic-gate processorid_t me = cpu->cpu_id, i; 907c478bd9Sstevel@tonic-gate int cross_call = (cbe_xcall_func != NULL && cbe_xcall_cpu == cpu); 917c478bd9Sstevel@tonic-gate 927c478bd9Sstevel@tonic-gate cyclic_fire(cpu); 937c478bd9Sstevel@tonic-gate 947c478bd9Sstevel@tonic-gate if (cbe_psm_timer_mode != TIMER_ONESHOT && me == 0 && !cross_call) { 957c478bd9Sstevel@tonic-gate for (i = 1; i < NCPU; i++) { 96*ae115bc7Smrj if (CPU_IN_SET(cbe_enabled, i)) { 97*ae115bc7Smrj XC_TRACE(TT_XC_CBE_FIRE, -1, i); 987c478bd9Sstevel@tonic-gate send_dirint(i, CBE_HIGH_PIL); 997c478bd9Sstevel@tonic-gate } 1007c478bd9Sstevel@tonic-gate } 101*ae115bc7Smrj } 1027c478bd9Sstevel@tonic-gate 1037c478bd9Sstevel@tonic-gate if (cross_call) { 1047c478bd9Sstevel@tonic-gate ASSERT(cbe_xcall_func != NULL && cbe_xcall_cpu == cpu); 1057c478bd9Sstevel@tonic-gate (*cbe_xcall_func)(cbe_xcall_farg); 1067c478bd9Sstevel@tonic-gate cbe_xcall_func = NULL; 1077c478bd9Sstevel@tonic-gate cbe_xcall_cpu = NULL; 1087c478bd9Sstevel@tonic-gate } 1097c478bd9Sstevel@tonic-gate 1107c478bd9Sstevel@tonic-gate return (1); 1117c478bd9Sstevel@tonic-gate } 1127c478bd9Sstevel@tonic-gate 1137c478bd9Sstevel@tonic-gate /*ARGSUSED*/ 1147c478bd9Sstevel@tonic-gate void 1157c478bd9Sstevel@tonic-gate cbe_softint(void *arg, cyc_level_t level) 1167c478bd9Sstevel@tonic-gate { 1177c478bd9Sstevel@tonic-gate switch (level) { 1187c478bd9Sstevel@tonic-gate case CY_LOW_LEVEL: 119e23a7e34Slq150181 (*setsoftint)(CBE_LOW_PIL, cbe_low_hdl.ih_pending); 1207c478bd9Sstevel@tonic-gate break; 1217c478bd9Sstevel@tonic-gate case CY_LOCK_LEVEL: 122e23a7e34Slq150181 (*setsoftint)(CBE_LOCK_PIL, cbe_clock_hdl.ih_pending); 1237c478bd9Sstevel@tonic-gate break; 1247c478bd9Sstevel@tonic-gate default: 1257c478bd9Sstevel@tonic-gate panic("cbe_softint: unexpected soft level %d", level); 1267c478bd9Sstevel@tonic-gate } 1277c478bd9Sstevel@tonic-gate } 1287c478bd9Sstevel@tonic-gate 1297c478bd9Sstevel@tonic-gate /*ARGSUSED*/ 1307c478bd9Sstevel@tonic-gate void 1317c478bd9Sstevel@tonic-gate cbe_reprogram(void *arg, hrtime_t time) 1327c478bd9Sstevel@tonic-gate { 1337c478bd9Sstevel@tonic-gate if (cbe_psm_timer_mode == TIMER_ONESHOT) 1347c478bd9Sstevel@tonic-gate (*psm_timer_reprogram)(time); 1357c478bd9Sstevel@tonic-gate } 1367c478bd9Sstevel@tonic-gate 1377c478bd9Sstevel@tonic-gate /*ARGSUSED*/ 1387c478bd9Sstevel@tonic-gate cyc_cookie_t 1397c478bd9Sstevel@tonic-gate cbe_set_level(void *arg, cyc_level_t level) 1407c478bd9Sstevel@tonic-gate { 1417c478bd9Sstevel@tonic-gate int ipl; 1427c478bd9Sstevel@tonic-gate 1437c478bd9Sstevel@tonic-gate switch (level) { 1447c478bd9Sstevel@tonic-gate case CY_LOW_LEVEL: 1457c478bd9Sstevel@tonic-gate ipl = CBE_LOW_PIL; 1467c478bd9Sstevel@tonic-gate break; 1477c478bd9Sstevel@tonic-gate case CY_LOCK_LEVEL: 1487c478bd9Sstevel@tonic-gate ipl = CBE_LOCK_PIL; 1497c478bd9Sstevel@tonic-gate break; 1507c478bd9Sstevel@tonic-gate case CY_HIGH_LEVEL: 1517c478bd9Sstevel@tonic-gate ipl = CBE_HIGH_PIL; 1527c478bd9Sstevel@tonic-gate break; 1537c478bd9Sstevel@tonic-gate default: 1547c478bd9Sstevel@tonic-gate panic("cbe_set_level: unexpected level %d", level); 1557c478bd9Sstevel@tonic-gate } 1567c478bd9Sstevel@tonic-gate 1577c478bd9Sstevel@tonic-gate return (splr(ipltospl(ipl))); 1587c478bd9Sstevel@tonic-gate } 1597c478bd9Sstevel@tonic-gate 1607c478bd9Sstevel@tonic-gate /*ARGSUSED*/ 1617c478bd9Sstevel@tonic-gate void 1627c478bd9Sstevel@tonic-gate cbe_restore_level(void *arg, cyc_cookie_t cookie) 1637c478bd9Sstevel@tonic-gate { 1647c478bd9Sstevel@tonic-gate splx(cookie); 1657c478bd9Sstevel@tonic-gate } 1667c478bd9Sstevel@tonic-gate 1677c478bd9Sstevel@tonic-gate /*ARGSUSED*/ 1687c478bd9Sstevel@tonic-gate void 1697c478bd9Sstevel@tonic-gate cbe_xcall(void *arg, cpu_t *dest, cyc_func_t func, void *farg) 1707c478bd9Sstevel@tonic-gate { 1717c478bd9Sstevel@tonic-gate kpreempt_disable(); 1727c478bd9Sstevel@tonic-gate 1737c478bd9Sstevel@tonic-gate if (dest == CPU) { 1747c478bd9Sstevel@tonic-gate (*func)(farg); 1757c478bd9Sstevel@tonic-gate kpreempt_enable(); 1767c478bd9Sstevel@tonic-gate return; 1777c478bd9Sstevel@tonic-gate } 1787c478bd9Sstevel@tonic-gate 1797c478bd9Sstevel@tonic-gate ASSERT(cbe_xcall_func == NULL); 1807c478bd9Sstevel@tonic-gate 1817c478bd9Sstevel@tonic-gate cbe_xcall_farg = farg; 1827c478bd9Sstevel@tonic-gate membar_producer(); 1837c478bd9Sstevel@tonic-gate cbe_xcall_cpu = dest; 1847c478bd9Sstevel@tonic-gate cbe_xcall_func = func; 1857c478bd9Sstevel@tonic-gate 186*ae115bc7Smrj XC_TRACE(TT_XC_CBE_XCALL, -1, dest->cpu_id); 1877c478bd9Sstevel@tonic-gate send_dirint(dest->cpu_id, CBE_HIGH_PIL); 1887c478bd9Sstevel@tonic-gate 1897c478bd9Sstevel@tonic-gate while (cbe_xcall_func != NULL || cbe_xcall_cpu != NULL) 1907c478bd9Sstevel@tonic-gate continue; 1917c478bd9Sstevel@tonic-gate 1927c478bd9Sstevel@tonic-gate kpreempt_enable(); 1937c478bd9Sstevel@tonic-gate 1947c478bd9Sstevel@tonic-gate ASSERT(cbe_xcall_func == NULL && cbe_xcall_cpu == NULL); 1957c478bd9Sstevel@tonic-gate } 1967c478bd9Sstevel@tonic-gate 1977c478bd9Sstevel@tonic-gate void * 1987c478bd9Sstevel@tonic-gate cbe_configure(cpu_t *cpu) 1997c478bd9Sstevel@tonic-gate { 2007c478bd9Sstevel@tonic-gate return (cpu); 2017c478bd9Sstevel@tonic-gate } 2027c478bd9Sstevel@tonic-gate 2037c478bd9Sstevel@tonic-gate void 2047c478bd9Sstevel@tonic-gate cbe_enable(void *arg) 2057c478bd9Sstevel@tonic-gate { 2067c478bd9Sstevel@tonic-gate processorid_t me = ((cpu_t *)arg)->cpu_id; 2077c478bd9Sstevel@tonic-gate 208d90554ebSdmick /* neither enable nor disable cpu0 if TIMER_PERIODIC is set */ 2097c478bd9Sstevel@tonic-gate if ((cbe_psm_timer_mode != TIMER_ONESHOT) && (me == 0)) 2107c478bd9Sstevel@tonic-gate return; 2117c478bd9Sstevel@tonic-gate 2127c478bd9Sstevel@tonic-gate ASSERT(!CPU_IN_SET(cbe_enabled, me)); 2137c478bd9Sstevel@tonic-gate CPUSET_ADD(cbe_enabled, me); 2147c478bd9Sstevel@tonic-gate if (cbe_psm_timer_mode == TIMER_ONESHOT) 2157c478bd9Sstevel@tonic-gate (*psm_timer_enable)(); 2167c478bd9Sstevel@tonic-gate } 2177c478bd9Sstevel@tonic-gate 2187c478bd9Sstevel@tonic-gate void 2197c478bd9Sstevel@tonic-gate cbe_disable(void *arg) 2207c478bd9Sstevel@tonic-gate { 2217c478bd9Sstevel@tonic-gate processorid_t me = ((cpu_t *)arg)->cpu_id; 2227c478bd9Sstevel@tonic-gate 223d90554ebSdmick /* neither enable nor disable cpu0 if TIMER_PERIODIC is set */ 224d90554ebSdmick if ((cbe_psm_timer_mode != TIMER_ONESHOT) && (me == 0)) 2257c478bd9Sstevel@tonic-gate return; 2267c478bd9Sstevel@tonic-gate 2277c478bd9Sstevel@tonic-gate ASSERT(CPU_IN_SET(cbe_enabled, me)); 2287c478bd9Sstevel@tonic-gate CPUSET_DEL(cbe_enabled, me); 2297c478bd9Sstevel@tonic-gate if (cbe_psm_timer_mode == TIMER_ONESHOT) 2307c478bd9Sstevel@tonic-gate (*psm_timer_disable)(); 2317c478bd9Sstevel@tonic-gate } 2327c478bd9Sstevel@tonic-gate 2337c478bd9Sstevel@tonic-gate /* 234d90554ebSdmick * Unbound cyclic, called once per tick (every nsec_per_tick ns). 2357c478bd9Sstevel@tonic-gate */ 2367c478bd9Sstevel@tonic-gate void 2377c478bd9Sstevel@tonic-gate cbe_hres_tick(void) 2387c478bd9Sstevel@tonic-gate { 2397c478bd9Sstevel@tonic-gate int s; 2407c478bd9Sstevel@tonic-gate 2417c478bd9Sstevel@tonic-gate dtrace_hres_tick(); 2427c478bd9Sstevel@tonic-gate 2437c478bd9Sstevel@tonic-gate /* 2447c478bd9Sstevel@tonic-gate * Because hres_tick effectively locks hres_lock, we must be at the 2457c478bd9Sstevel@tonic-gate * same PIL as that used for CLOCK_LOCK. 2467c478bd9Sstevel@tonic-gate */ 2477c478bd9Sstevel@tonic-gate s = splr(ipltospl(XC_HI_PIL)); 2487c478bd9Sstevel@tonic-gate hres_tick(); 2497c478bd9Sstevel@tonic-gate splx(s); 2507c478bd9Sstevel@tonic-gate 2517c478bd9Sstevel@tonic-gate if ((cbe_ticks % hz) == 0) 2527c478bd9Sstevel@tonic-gate (*hrtime_tick)(); 2537c478bd9Sstevel@tonic-gate 2547c478bd9Sstevel@tonic-gate cbe_ticks++; 2557c478bd9Sstevel@tonic-gate 2567c478bd9Sstevel@tonic-gate } 2577c478bd9Sstevel@tonic-gate 2587c478bd9Sstevel@tonic-gate void 2597c478bd9Sstevel@tonic-gate cbe_init(void) 2607c478bd9Sstevel@tonic-gate { 2617c478bd9Sstevel@tonic-gate cyc_backend_t cbe = { 2627c478bd9Sstevel@tonic-gate cbe_configure, /* cyb_configure */ 2637c478bd9Sstevel@tonic-gate NULL, /* cyb_unconfigure */ 2647c478bd9Sstevel@tonic-gate cbe_enable, /* cyb_enable */ 2657c478bd9Sstevel@tonic-gate cbe_disable, /* cyb_disable */ 2667c478bd9Sstevel@tonic-gate cbe_reprogram, /* cyb_reprogram */ 2677c478bd9Sstevel@tonic-gate cbe_softint, /* cyb_softint */ 2687c478bd9Sstevel@tonic-gate cbe_set_level, /* cyb_set_level */ 2697c478bd9Sstevel@tonic-gate cbe_restore_level, /* cyb_restore_level */ 2707c478bd9Sstevel@tonic-gate cbe_xcall, /* cyb_xcall */ 2717c478bd9Sstevel@tonic-gate NULL, /* cyb_suspend */ 2727c478bd9Sstevel@tonic-gate NULL /* cyb_resume */ 2737c478bd9Sstevel@tonic-gate }; 2747c478bd9Sstevel@tonic-gate hrtime_t resolution; 2757c478bd9Sstevel@tonic-gate cyc_handler_t hdlr; 2767c478bd9Sstevel@tonic-gate cyc_time_t when; 2777c478bd9Sstevel@tonic-gate 2787c478bd9Sstevel@tonic-gate cbe_vector = (*psm_get_clockirq)(CBE_HIGH_PIL); 2797c478bd9Sstevel@tonic-gate 2807c478bd9Sstevel@tonic-gate CPUSET_ZERO(cbe_enabled); 2817c478bd9Sstevel@tonic-gate 2827c478bd9Sstevel@tonic-gate resolution = (*clkinitf)(TIMER_ONESHOT, &cbe_psm_timer_mode); 2837c478bd9Sstevel@tonic-gate 2847c478bd9Sstevel@tonic-gate mutex_enter(&cpu_lock); 2857c478bd9Sstevel@tonic-gate cyclic_init(&cbe, resolution); 2867c478bd9Sstevel@tonic-gate mutex_exit(&cpu_lock); 2877c478bd9Sstevel@tonic-gate 2887c478bd9Sstevel@tonic-gate (void) add_avintr(NULL, CBE_HIGH_PIL, (avfunc)cbe_fire, 2897a364d25Sschwartz "cbe_fire_master", cbe_vector, 0, NULL, NULL, NULL); 2907c478bd9Sstevel@tonic-gate 2917c478bd9Sstevel@tonic-gate if (psm_get_ipivect != NULL) { 2927c478bd9Sstevel@tonic-gate (void) add_avintr(NULL, CBE_HIGH_PIL, (avfunc)cbe_fire, 2937c478bd9Sstevel@tonic-gate "cbe_fire_slave", 2947c478bd9Sstevel@tonic-gate (*psm_get_ipivect)(CBE_HIGH_PIL, PSM_INTR_IPI_HI), 2957a364d25Sschwartz 0, NULL, NULL, NULL); 2967c478bd9Sstevel@tonic-gate } 2977c478bd9Sstevel@tonic-gate 2987c478bd9Sstevel@tonic-gate (void) add_avsoftintr((void *)&cbe_clock_hdl, CBE_LOCK_PIL, 2997c478bd9Sstevel@tonic-gate (avfunc)cbe_softclock, "softclock", NULL, NULL); 3007c478bd9Sstevel@tonic-gate 3017c478bd9Sstevel@tonic-gate (void) add_avsoftintr((void *)&cbe_low_hdl, CBE_LOW_PIL, 3027c478bd9Sstevel@tonic-gate (avfunc)cbe_low_level, "low level", NULL, NULL); 3037c478bd9Sstevel@tonic-gate 3047c478bd9Sstevel@tonic-gate mutex_enter(&cpu_lock); 3057c478bd9Sstevel@tonic-gate 3067c478bd9Sstevel@tonic-gate hdlr.cyh_level = CY_HIGH_LEVEL; 3077c478bd9Sstevel@tonic-gate hdlr.cyh_func = (cyc_func_t)cbe_hres_tick; 3087c478bd9Sstevel@tonic-gate hdlr.cyh_arg = NULL; 3097c478bd9Sstevel@tonic-gate 3107c478bd9Sstevel@tonic-gate when.cyt_when = 0; 3117c478bd9Sstevel@tonic-gate when.cyt_interval = nsec_per_tick; 3127c478bd9Sstevel@tonic-gate 3137c478bd9Sstevel@tonic-gate cbe_hres_cyclic = cyclic_add(&hdlr, &when); 3147c478bd9Sstevel@tonic-gate 3157c478bd9Sstevel@tonic-gate if (psm_post_cyclic_setup != NULL) 3167c478bd9Sstevel@tonic-gate (*psm_post_cyclic_setup)(NULL); 3177c478bd9Sstevel@tonic-gate 3187c478bd9Sstevel@tonic-gate mutex_exit(&cpu_lock); 3197c478bd9Sstevel@tonic-gate } 320