1dfe7b3bfSKonstantin Belousov /*- 2dfe7b3bfSKonstantin Belousov * Copyright (c) 2003 Peter Wemm. 3dfe7b3bfSKonstantin Belousov * Copyright (c) 1992 Terrence R. Lambert. 4dfe7b3bfSKonstantin Belousov * Copyright (c) 1982, 1987, 1990 The Regents of the University of California. 5dfe7b3bfSKonstantin Belousov * All rights reserved. 6dfe7b3bfSKonstantin Belousov * 7dfe7b3bfSKonstantin Belousov * This code is derived from software contributed to Berkeley by 8dfe7b3bfSKonstantin Belousov * William Jolitz. 9dfe7b3bfSKonstantin Belousov * 10dfe7b3bfSKonstantin Belousov * Redistribution and use in source and binary forms, with or without 11dfe7b3bfSKonstantin Belousov * modification, are permitted provided that the following conditions 12dfe7b3bfSKonstantin Belousov * are met: 13dfe7b3bfSKonstantin Belousov * 1. Redistributions of source code must retain the above copyright 14dfe7b3bfSKonstantin Belousov * notice, this list of conditions and the following disclaimer. 15dfe7b3bfSKonstantin Belousov * 2. Redistributions in binary form must reproduce the above copyright 16dfe7b3bfSKonstantin Belousov * notice, this list of conditions and the following disclaimer in the 17dfe7b3bfSKonstantin Belousov * documentation and/or other materials provided with the distribution. 18dfe7b3bfSKonstantin Belousov * 3. All advertising materials mentioning features or use of this software 19dfe7b3bfSKonstantin Belousov * must display the following acknowledgement: 20dfe7b3bfSKonstantin Belousov * This product includes software developed by the University of 21dfe7b3bfSKonstantin Belousov * California, Berkeley and its contributors. 22dfe7b3bfSKonstantin Belousov * 4. Neither the name of the University nor the names of its contributors 23dfe7b3bfSKonstantin Belousov * may be used to endorse or promote products derived from this software 24dfe7b3bfSKonstantin Belousov * without specific prior written permission. 25dfe7b3bfSKonstantin Belousov * 26dfe7b3bfSKonstantin Belousov * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 27dfe7b3bfSKonstantin Belousov * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 28dfe7b3bfSKonstantin Belousov * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 29dfe7b3bfSKonstantin Belousov * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 30dfe7b3bfSKonstantin Belousov * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 31dfe7b3bfSKonstantin Belousov * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 32dfe7b3bfSKonstantin Belousov * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 33dfe7b3bfSKonstantin Belousov * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 34dfe7b3bfSKonstantin Belousov * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 35dfe7b3bfSKonstantin Belousov * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 36dfe7b3bfSKonstantin Belousov * SUCH DAMAGE. 37dfe7b3bfSKonstantin Belousov * 38dfe7b3bfSKonstantin Belousov * from: @(#)machdep.c 7.4 (Berkeley) 6/3/91 39dfe7b3bfSKonstantin Belousov */ 40dfe7b3bfSKonstantin Belousov 41dfe7b3bfSKonstantin Belousov #include <sys/cdefs.h> 42dfe7b3bfSKonstantin Belousov __FBSDID("$FreeBSD$"); 43dfe7b3bfSKonstantin Belousov 44*7705dd4dSKonstantin Belousov #include "opt_acpi.h" 45dfe7b3bfSKonstantin Belousov #include "opt_atpic.h" 46dfe7b3bfSKonstantin Belousov #include "opt_cpu.h" 47dfe7b3bfSKonstantin Belousov #include "opt_ddb.h" 48dfe7b3bfSKonstantin Belousov #include "opt_inet.h" 49dfe7b3bfSKonstantin Belousov #include "opt_isa.h" 50835c2787SKonstantin Belousov #include "opt_kdb.h" 51dfe7b3bfSKonstantin Belousov #include "opt_kstack_pages.h" 52dfe7b3bfSKonstantin Belousov #include "opt_maxmem.h" 53dfe7b3bfSKonstantin Belousov #include "opt_mp_watchdog.h" 54dfe7b3bfSKonstantin Belousov #include "opt_platform.h" 55dfe7b3bfSKonstantin Belousov #ifdef __i386__ 56dfe7b3bfSKonstantin Belousov #include "opt_apic.h" 57dfe7b3bfSKonstantin Belousov #endif 58dfe7b3bfSKonstantin Belousov 59dfe7b3bfSKonstantin Belousov #include <sys/param.h> 60dfe7b3bfSKonstantin Belousov #include <sys/proc.h> 61dfe7b3bfSKonstantin Belousov #include <sys/systm.h> 62dfe7b3bfSKonstantin Belousov #include <sys/bus.h> 63dfe7b3bfSKonstantin Belousov #include <sys/cpu.h> 64dfe7b3bfSKonstantin Belousov #include <sys/kdb.h> 65dfe7b3bfSKonstantin Belousov #include <sys/kernel.h> 66dfe7b3bfSKonstantin Belousov #include <sys/ktr.h> 67dfe7b3bfSKonstantin Belousov #include <sys/lock.h> 68dfe7b3bfSKonstantin Belousov #include <sys/malloc.h> 69dfe7b3bfSKonstantin Belousov #include <sys/mutex.h> 70dfe7b3bfSKonstantin Belousov #include <sys/pcpu.h> 71dfe7b3bfSKonstantin Belousov #include <sys/rwlock.h> 72dfe7b3bfSKonstantin Belousov #include <sys/sched.h> 73dfe7b3bfSKonstantin Belousov #include <sys/smp.h> 74dfe7b3bfSKonstantin Belousov #include <sys/sysctl.h> 75dfe7b3bfSKonstantin Belousov 76dfe7b3bfSKonstantin Belousov #include <machine/clock.h> 77dfe7b3bfSKonstantin Belousov #include <machine/cpu.h> 78dfe7b3bfSKonstantin Belousov #include <machine/cputypes.h> 79dfe7b3bfSKonstantin Belousov #include <machine/specialreg.h> 80dfe7b3bfSKonstantin Belousov #include <machine/md_var.h> 81dfe7b3bfSKonstantin Belousov #include <machine/mp_watchdog.h> 82dfe7b3bfSKonstantin Belousov #include <machine/tss.h> 83dfe7b3bfSKonstantin Belousov #ifdef SMP 84dfe7b3bfSKonstantin Belousov #include <machine/smp.h> 85dfe7b3bfSKonstantin Belousov #endif 863da25bdbSAndriy Gapon #ifdef CPU_ELAN 873da25bdbSAndriy Gapon #include <machine/elan_mmcr.h> 883da25bdbSAndriy Gapon #endif 89b57a73f8SKonstantin Belousov #include <x86/acpica_machdep.h> 90dfe7b3bfSKonstantin Belousov 91dfe7b3bfSKonstantin Belousov #include <vm/vm.h> 92dfe7b3bfSKonstantin Belousov #include <vm/vm_extern.h> 93dfe7b3bfSKonstantin Belousov #include <vm/vm_kern.h> 94dfe7b3bfSKonstantin Belousov #include <vm/vm_page.h> 95dfe7b3bfSKonstantin Belousov #include <vm/vm_map.h> 96dfe7b3bfSKonstantin Belousov #include <vm/vm_object.h> 97dfe7b3bfSKonstantin Belousov #include <vm/vm_pager.h> 98dfe7b3bfSKonstantin Belousov #include <vm/vm_param.h> 99dfe7b3bfSKonstantin Belousov 1008428d0f1SAndriy Gapon #include <isa/isareg.h> 1018428d0f1SAndriy Gapon 102*7705dd4dSKonstantin Belousov #include <contrib/dev/acpica/include/acpi.h> 103*7705dd4dSKonstantin Belousov 104d9e8bbb6SKonstantin Belousov #define STATE_RUNNING 0x0 105d9e8bbb6SKonstantin Belousov #define STATE_MWAIT 0x1 106d9e8bbb6SKonstantin Belousov #define STATE_SLEEPING 0x2 107d9e8bbb6SKonstantin Belousov 1088428d0f1SAndriy Gapon #ifdef SMP 1098428d0f1SAndriy Gapon static u_int cpu_reset_proxyid; 1108428d0f1SAndriy Gapon static volatile u_int cpu_reset_proxy_active; 1118428d0f1SAndriy Gapon #endif 1128428d0f1SAndriy Gapon 1138428d0f1SAndriy Gapon 114dfe7b3bfSKonstantin Belousov /* 115dfe7b3bfSKonstantin Belousov * Machine dependent boot() routine 116dfe7b3bfSKonstantin Belousov * 117dfe7b3bfSKonstantin Belousov * I haven't seen anything to put here yet 118dfe7b3bfSKonstantin Belousov * Possibly some stuff might be grafted back here from boot() 119dfe7b3bfSKonstantin Belousov */ 120dfe7b3bfSKonstantin Belousov void 121dfe7b3bfSKonstantin Belousov cpu_boot(int howto) 122dfe7b3bfSKonstantin Belousov { 123dfe7b3bfSKonstantin Belousov } 124dfe7b3bfSKonstantin Belousov 125dfe7b3bfSKonstantin Belousov /* 126dfe7b3bfSKonstantin Belousov * Flush the D-cache for non-DMA I/O so that the I-cache can 127dfe7b3bfSKonstantin Belousov * be made coherent later. 128dfe7b3bfSKonstantin Belousov */ 129dfe7b3bfSKonstantin Belousov void 130dfe7b3bfSKonstantin Belousov cpu_flush_dcache(void *ptr, size_t len) 131dfe7b3bfSKonstantin Belousov { 132dfe7b3bfSKonstantin Belousov /* Not applicable */ 133dfe7b3bfSKonstantin Belousov } 134dfe7b3bfSKonstantin Belousov 135b57a73f8SKonstantin Belousov void 136b57a73f8SKonstantin Belousov acpi_cpu_c1(void) 137b57a73f8SKonstantin Belousov { 138b57a73f8SKonstantin Belousov 139b57a73f8SKonstantin Belousov __asm __volatile("sti; hlt"); 140b57a73f8SKonstantin Belousov } 141b57a73f8SKonstantin Belousov 14219d4720bSJonathan T. Looney /* 14319d4720bSJonathan T. Looney * Use mwait to pause execution while waiting for an interrupt or 14419d4720bSJonathan T. Looney * another thread to signal that there is more work. 14519d4720bSJonathan T. Looney * 14619d4720bSJonathan T. Looney * NOTE: Interrupts will cause a wakeup; however, this function does 14719d4720bSJonathan T. Looney * not enable interrupt handling. The caller is responsible to enable 14819d4720bSJonathan T. Looney * interrupts. 14919d4720bSJonathan T. Looney */ 150b57a73f8SKonstantin Belousov void 151b57a73f8SKonstantin Belousov acpi_cpu_idle_mwait(uint32_t mwait_hint) 152b57a73f8SKonstantin Belousov { 153b57a73f8SKonstantin Belousov int *state; 1543621ba1eSKonstantin Belousov uint64_t v; 155b57a73f8SKonstantin Belousov 156b57a73f8SKonstantin Belousov /* 157319117fdSKonstantin Belousov * A comment in Linux patch claims that 'CPUs run faster with 158319117fdSKonstantin Belousov * speculation protection disabled. All CPU threads in a core 159319117fdSKonstantin Belousov * must disable speculation protection for it to be 160319117fdSKonstantin Belousov * disabled. Disable it while we are idle so the other 161319117fdSKonstantin Belousov * hyperthread can run fast.' 162319117fdSKonstantin Belousov * 163b57a73f8SKonstantin Belousov * XXXKIB. Software coordination mode should be supported, 164b57a73f8SKonstantin Belousov * but all Intel CPUs provide hardware coordination. 165b57a73f8SKonstantin Belousov */ 166d9e8bbb6SKonstantin Belousov 167d9e8bbb6SKonstantin Belousov state = (int *)PCPU_PTR(monitorbuf); 168a5bd21d0SKonstantin Belousov KASSERT(atomic_load_int(state) == STATE_SLEEPING, 169d9e8bbb6SKonstantin Belousov ("cpu_mwait_cx: wrong monitorbuf state")); 170a5bd21d0SKonstantin Belousov atomic_store_int(state, STATE_MWAIT); 1713621ba1eSKonstantin Belousov if (PCPU_GET(ibpb_set) || hw_ssb_active) { 1723621ba1eSKonstantin Belousov v = rdmsr(MSR_IA32_SPEC_CTRL); 1733621ba1eSKonstantin Belousov wrmsr(MSR_IA32_SPEC_CTRL, v & ~(IA32_SPEC_CTRL_IBRS | 1743621ba1eSKonstantin Belousov IA32_SPEC_CTRL_STIBP | IA32_SPEC_CTRL_SSBD)); 1753621ba1eSKonstantin Belousov } else { 1763621ba1eSKonstantin Belousov v = 0; 1773621ba1eSKonstantin Belousov } 178b57a73f8SKonstantin Belousov cpu_monitor(state, 0, 0); 179a5bd21d0SKonstantin Belousov if (atomic_load_int(state) == STATE_MWAIT) 180b57a73f8SKonstantin Belousov cpu_mwait(MWAIT_INTRBREAK, mwait_hint); 1813621ba1eSKonstantin Belousov 1823621ba1eSKonstantin Belousov /* 1833621ba1eSKonstantin Belousov * SSB cannot be disabled while we sleep, or rather, if it was 1843621ba1eSKonstantin Belousov * disabled, the sysctl thread will bind to our cpu to tweak 1853621ba1eSKonstantin Belousov * MSR. 1863621ba1eSKonstantin Belousov */ 1873621ba1eSKonstantin Belousov if (v != 0) 1883621ba1eSKonstantin Belousov wrmsr(MSR_IA32_SPEC_CTRL, v); 189d9e8bbb6SKonstantin Belousov 190d9e8bbb6SKonstantin Belousov /* 191d9e8bbb6SKonstantin Belousov * We should exit on any event that interrupts mwait, because 192d9e8bbb6SKonstantin Belousov * that event might be a wanted interrupt. 193d9e8bbb6SKonstantin Belousov */ 194a5bd21d0SKonstantin Belousov atomic_store_int(state, STATE_RUNNING); 195b57a73f8SKonstantin Belousov } 196b57a73f8SKonstantin Belousov 197dfe7b3bfSKonstantin Belousov /* Get current clock frequency for the given cpu id. */ 198dfe7b3bfSKonstantin Belousov int 199dfe7b3bfSKonstantin Belousov cpu_est_clockrate(int cpu_id, uint64_t *rate) 200dfe7b3bfSKonstantin Belousov { 201dfe7b3bfSKonstantin Belousov uint64_t tsc1, tsc2; 202dfe7b3bfSKonstantin Belousov uint64_t acnt, mcnt, perf; 203dfe7b3bfSKonstantin Belousov register_t reg; 204dfe7b3bfSKonstantin Belousov 205dfe7b3bfSKonstantin Belousov if (pcpu_find(cpu_id) == NULL || rate == NULL) 206dfe7b3bfSKonstantin Belousov return (EINVAL); 207dfe7b3bfSKonstantin Belousov #ifdef __i386__ 208dfe7b3bfSKonstantin Belousov if ((cpu_feature & CPUID_TSC) == 0) 209dfe7b3bfSKonstantin Belousov return (EOPNOTSUPP); 210dfe7b3bfSKonstantin Belousov #endif 211dfe7b3bfSKonstantin Belousov 212dfe7b3bfSKonstantin Belousov /* 213dfe7b3bfSKonstantin Belousov * If TSC is P-state invariant and APERF/MPERF MSRs do not exist, 214dfe7b3bfSKonstantin Belousov * DELAY(9) based logic fails. 215dfe7b3bfSKonstantin Belousov */ 216dfe7b3bfSKonstantin Belousov if (tsc_is_invariant && !tsc_perf_stat) 217dfe7b3bfSKonstantin Belousov return (EOPNOTSUPP); 218dfe7b3bfSKonstantin Belousov 219dfe7b3bfSKonstantin Belousov #ifdef SMP 220dfe7b3bfSKonstantin Belousov if (smp_cpus > 1) { 221dfe7b3bfSKonstantin Belousov /* Schedule ourselves on the indicated cpu. */ 222dfe7b3bfSKonstantin Belousov thread_lock(curthread); 223dfe7b3bfSKonstantin Belousov sched_bind(curthread, cpu_id); 224dfe7b3bfSKonstantin Belousov thread_unlock(curthread); 225dfe7b3bfSKonstantin Belousov } 226dfe7b3bfSKonstantin Belousov #endif 227dfe7b3bfSKonstantin Belousov 228dfe7b3bfSKonstantin Belousov /* Calibrate by measuring a short delay. */ 229dfe7b3bfSKonstantin Belousov reg = intr_disable(); 230dfe7b3bfSKonstantin Belousov if (tsc_is_invariant) { 231dfe7b3bfSKonstantin Belousov wrmsr(MSR_MPERF, 0); 232dfe7b3bfSKonstantin Belousov wrmsr(MSR_APERF, 0); 233dfe7b3bfSKonstantin Belousov tsc1 = rdtsc(); 234dfe7b3bfSKonstantin Belousov DELAY(1000); 235dfe7b3bfSKonstantin Belousov mcnt = rdmsr(MSR_MPERF); 236dfe7b3bfSKonstantin Belousov acnt = rdmsr(MSR_APERF); 237dfe7b3bfSKonstantin Belousov tsc2 = rdtsc(); 238dfe7b3bfSKonstantin Belousov intr_restore(reg); 239dfe7b3bfSKonstantin Belousov perf = 1000 * acnt / mcnt; 240dfe7b3bfSKonstantin Belousov *rate = (tsc2 - tsc1) * perf; 241dfe7b3bfSKonstantin Belousov } else { 242dfe7b3bfSKonstantin Belousov tsc1 = rdtsc(); 243dfe7b3bfSKonstantin Belousov DELAY(1000); 244dfe7b3bfSKonstantin Belousov tsc2 = rdtsc(); 245dfe7b3bfSKonstantin Belousov intr_restore(reg); 246dfe7b3bfSKonstantin Belousov *rate = (tsc2 - tsc1) * 1000; 247dfe7b3bfSKonstantin Belousov } 248dfe7b3bfSKonstantin Belousov 249dfe7b3bfSKonstantin Belousov #ifdef SMP 250dfe7b3bfSKonstantin Belousov if (smp_cpus > 1) { 251dfe7b3bfSKonstantin Belousov thread_lock(curthread); 252dfe7b3bfSKonstantin Belousov sched_unbind(curthread); 253dfe7b3bfSKonstantin Belousov thread_unlock(curthread); 254dfe7b3bfSKonstantin Belousov } 255dfe7b3bfSKonstantin Belousov #endif 256dfe7b3bfSKonstantin Belousov 257dfe7b3bfSKonstantin Belousov return (0); 258dfe7b3bfSKonstantin Belousov } 259dfe7b3bfSKonstantin Belousov 260dfe7b3bfSKonstantin Belousov /* 261dfe7b3bfSKonstantin Belousov * Shutdown the CPU as much as possible 262dfe7b3bfSKonstantin Belousov */ 263dfe7b3bfSKonstantin Belousov void 264dfe7b3bfSKonstantin Belousov cpu_halt(void) 265dfe7b3bfSKonstantin Belousov { 266dfe7b3bfSKonstantin Belousov for (;;) 267dfe7b3bfSKonstantin Belousov halt(); 268dfe7b3bfSKonstantin Belousov } 269dfe7b3bfSKonstantin Belousov 2708428d0f1SAndriy Gapon static void 271b7b25af0SAndriy Gapon cpu_reset_real(void) 2728428d0f1SAndriy Gapon { 2738428d0f1SAndriy Gapon struct region_descriptor null_idt; 2748428d0f1SAndriy Gapon int b; 2758428d0f1SAndriy Gapon 2768428d0f1SAndriy Gapon disable_intr(); 2778428d0f1SAndriy Gapon #ifdef CPU_ELAN 2788428d0f1SAndriy Gapon if (elan_mmcr != NULL) 2798428d0f1SAndriy Gapon elan_mmcr->RESCFG = 1; 2808428d0f1SAndriy Gapon #endif 2818428d0f1SAndriy Gapon #ifdef __i386__ 2828428d0f1SAndriy Gapon if (cpu == CPU_GEODE1100) { 2838428d0f1SAndriy Gapon /* Attempt Geode's own reset */ 2848428d0f1SAndriy Gapon outl(0xcf8, 0x80009044ul); 2858428d0f1SAndriy Gapon outl(0xcfc, 0xf); 2868428d0f1SAndriy Gapon } 2878428d0f1SAndriy Gapon #endif 2888428d0f1SAndriy Gapon #if !defined(BROKEN_KEYBOARD_RESET) 2898428d0f1SAndriy Gapon /* 2908428d0f1SAndriy Gapon * Attempt to do a CPU reset via the keyboard controller, 2918428d0f1SAndriy Gapon * do not turn off GateA20, as any machine that fails 2928428d0f1SAndriy Gapon * to do the reset here would then end up in no man's land. 2938428d0f1SAndriy Gapon */ 2948428d0f1SAndriy Gapon outb(IO_KBD + 4, 0xFE); 2958428d0f1SAndriy Gapon DELAY(500000); /* wait 0.5 sec to see if that did it */ 2968428d0f1SAndriy Gapon #endif 2978428d0f1SAndriy Gapon 2988428d0f1SAndriy Gapon /* 2998428d0f1SAndriy Gapon * Attempt to force a reset via the Reset Control register at 3008428d0f1SAndriy Gapon * I/O port 0xcf9. Bit 2 forces a system reset when it 3018428d0f1SAndriy Gapon * transitions from 0 to 1. Bit 1 selects the type of reset 3028428d0f1SAndriy Gapon * to attempt: 0 selects a "soft" reset, and 1 selects a 3038428d0f1SAndriy Gapon * "hard" reset. We try a "hard" reset. The first write sets 3048428d0f1SAndriy Gapon * bit 1 to select a "hard" reset and clears bit 2. The 3058428d0f1SAndriy Gapon * second write forces a 0 -> 1 transition in bit 2 to trigger 3068428d0f1SAndriy Gapon * a reset. 3078428d0f1SAndriy Gapon */ 3088428d0f1SAndriy Gapon outb(0xcf9, 0x2); 3098428d0f1SAndriy Gapon outb(0xcf9, 0x6); 3108428d0f1SAndriy Gapon DELAY(500000); /* wait 0.5 sec to see if that did it */ 3118428d0f1SAndriy Gapon 3128428d0f1SAndriy Gapon /* 3138428d0f1SAndriy Gapon * Attempt to force a reset via the Fast A20 and Init register 3148428d0f1SAndriy Gapon * at I/O port 0x92. Bit 1 serves as an alternate A20 gate. 3158428d0f1SAndriy Gapon * Bit 0 asserts INIT# when set to 1. We are careful to only 3168428d0f1SAndriy Gapon * preserve bit 1 while setting bit 0. We also must clear bit 3178428d0f1SAndriy Gapon * 0 before setting it if it isn't already clear. 3188428d0f1SAndriy Gapon */ 3198428d0f1SAndriy Gapon b = inb(0x92); 3208428d0f1SAndriy Gapon if (b != 0xff) { 3218428d0f1SAndriy Gapon if ((b & 0x1) != 0) 3228428d0f1SAndriy Gapon outb(0x92, b & 0xfe); 3238428d0f1SAndriy Gapon outb(0x92, b | 0x1); 3248428d0f1SAndriy Gapon DELAY(500000); /* wait 0.5 sec to see if that did it */ 3258428d0f1SAndriy Gapon } 3268428d0f1SAndriy Gapon 3278428d0f1SAndriy Gapon printf("No known reset method worked, attempting CPU shutdown\n"); 3288428d0f1SAndriy Gapon DELAY(1000000); /* wait 1 sec for printf to complete */ 3298428d0f1SAndriy Gapon 3308428d0f1SAndriy Gapon /* Wipe the IDT. */ 3318428d0f1SAndriy Gapon null_idt.rd_limit = 0; 3328428d0f1SAndriy Gapon null_idt.rd_base = 0; 3338428d0f1SAndriy Gapon lidt(&null_idt); 3348428d0f1SAndriy Gapon 3358428d0f1SAndriy Gapon /* "good night, sweet prince .... <THUNK!>" */ 3368428d0f1SAndriy Gapon breakpoint(); 3378428d0f1SAndriy Gapon 3388428d0f1SAndriy Gapon /* NOTREACHED */ 3398428d0f1SAndriy Gapon while(1); 3408428d0f1SAndriy Gapon } 3418428d0f1SAndriy Gapon 3428428d0f1SAndriy Gapon #ifdef SMP 3438428d0f1SAndriy Gapon static void 344b7b25af0SAndriy Gapon cpu_reset_proxy(void) 3458428d0f1SAndriy Gapon { 3468428d0f1SAndriy Gapon 3478428d0f1SAndriy Gapon cpu_reset_proxy_active = 1; 3488428d0f1SAndriy Gapon while (cpu_reset_proxy_active == 1) 3498428d0f1SAndriy Gapon ia32_pause(); /* Wait for other cpu to see that we've started */ 3508428d0f1SAndriy Gapon 3518428d0f1SAndriy Gapon printf("cpu_reset_proxy: Stopped CPU %d\n", cpu_reset_proxyid); 3528428d0f1SAndriy Gapon DELAY(1000000); 3538428d0f1SAndriy Gapon cpu_reset_real(); 3548428d0f1SAndriy Gapon } 3558428d0f1SAndriy Gapon #endif 3568428d0f1SAndriy Gapon 3578428d0f1SAndriy Gapon void 358b7b25af0SAndriy Gapon cpu_reset(void) 3598428d0f1SAndriy Gapon { 3608428d0f1SAndriy Gapon #ifdef SMP 3618428d0f1SAndriy Gapon cpuset_t map; 3628428d0f1SAndriy Gapon u_int cnt; 3638428d0f1SAndriy Gapon 3648428d0f1SAndriy Gapon if (smp_started) { 3658428d0f1SAndriy Gapon map = all_cpus; 3668428d0f1SAndriy Gapon CPU_CLR(PCPU_GET(cpuid), &map); 3678428d0f1SAndriy Gapon CPU_NAND(&map, &stopped_cpus); 3688428d0f1SAndriy Gapon if (!CPU_EMPTY(&map)) { 3698428d0f1SAndriy Gapon printf("cpu_reset: Stopping other CPUs\n"); 3708428d0f1SAndriy Gapon stop_cpus(map); 3718428d0f1SAndriy Gapon } 3728428d0f1SAndriy Gapon 3738428d0f1SAndriy Gapon if (PCPU_GET(cpuid) != 0) { 3748428d0f1SAndriy Gapon cpu_reset_proxyid = PCPU_GET(cpuid); 3758428d0f1SAndriy Gapon cpustop_restartfunc = cpu_reset_proxy; 3768428d0f1SAndriy Gapon cpu_reset_proxy_active = 0; 3778428d0f1SAndriy Gapon printf("cpu_reset: Restarting BSP\n"); 3788428d0f1SAndriy Gapon 3798428d0f1SAndriy Gapon /* Restart CPU #0. */ 3808428d0f1SAndriy Gapon CPU_SETOF(0, &started_cpus); 3818428d0f1SAndriy Gapon wmb(); 3828428d0f1SAndriy Gapon 3838428d0f1SAndriy Gapon cnt = 0; 3848428d0f1SAndriy Gapon while (cpu_reset_proxy_active == 0 && cnt < 10000000) { 3858428d0f1SAndriy Gapon ia32_pause(); 3868428d0f1SAndriy Gapon cnt++; /* Wait for BSP to announce restart */ 3878428d0f1SAndriy Gapon } 3888428d0f1SAndriy Gapon if (cpu_reset_proxy_active == 0) { 3898428d0f1SAndriy Gapon printf("cpu_reset: Failed to restart BSP\n"); 3908428d0f1SAndriy Gapon } else { 3918428d0f1SAndriy Gapon cpu_reset_proxy_active = 2; 3928428d0f1SAndriy Gapon while (1) 3938428d0f1SAndriy Gapon ia32_pause(); 3948428d0f1SAndriy Gapon /* NOTREACHED */ 3958428d0f1SAndriy Gapon } 3968428d0f1SAndriy Gapon } 3978428d0f1SAndriy Gapon 3988428d0f1SAndriy Gapon DELAY(1000000); 3998428d0f1SAndriy Gapon } 4008428d0f1SAndriy Gapon #endif 4018428d0f1SAndriy Gapon cpu_reset_real(); 4028428d0f1SAndriy Gapon /* NOTREACHED */ 4038428d0f1SAndriy Gapon } 4048428d0f1SAndriy Gapon 405b57a73f8SKonstantin Belousov bool 406b57a73f8SKonstantin Belousov cpu_mwait_usable(void) 407b57a73f8SKonstantin Belousov { 408b57a73f8SKonstantin Belousov 409b57a73f8SKonstantin Belousov return ((cpu_feature2 & CPUID2_MON) != 0 && ((cpu_mon_mwait_flags & 410b57a73f8SKonstantin Belousov (CPUID5_MON_MWAIT_EXT | CPUID5_MWAIT_INTRBREAK)) == 411b57a73f8SKonstantin Belousov (CPUID5_MON_MWAIT_EXT | CPUID5_MWAIT_INTRBREAK))); 412b57a73f8SKonstantin Belousov } 413b57a73f8SKonstantin Belousov 414dfe7b3bfSKonstantin Belousov void (*cpu_idle_hook)(sbintime_t) = NULL; /* ACPI idle hook. */ 415dfe7b3bfSKonstantin Belousov static int cpu_ident_amdc1e = 0; /* AMD C1E supported. */ 416dfe7b3bfSKonstantin Belousov static int idle_mwait = 1; /* Use MONITOR/MWAIT for short idle. */ 417dfe7b3bfSKonstantin Belousov SYSCTL_INT(_machdep, OID_AUTO, idle_mwait, CTLFLAG_RWTUN, &idle_mwait, 418dfe7b3bfSKonstantin Belousov 0, "Use MONITOR/MWAIT for short idle"); 419dfe7b3bfSKonstantin Belousov 420dfe7b3bfSKonstantin Belousov static void 421dfe7b3bfSKonstantin Belousov cpu_idle_acpi(sbintime_t sbt) 422dfe7b3bfSKonstantin Belousov { 423dfe7b3bfSKonstantin Belousov int *state; 424dfe7b3bfSKonstantin Belousov 425dfe7b3bfSKonstantin Belousov state = (int *)PCPU_PTR(monitorbuf); 426a5bd21d0SKonstantin Belousov atomic_store_int(state, STATE_SLEEPING); 427dfe7b3bfSKonstantin Belousov 428dfe7b3bfSKonstantin Belousov /* See comments in cpu_idle_hlt(). */ 429dfe7b3bfSKonstantin Belousov disable_intr(); 430dfe7b3bfSKonstantin Belousov if (sched_runnable()) 431dfe7b3bfSKonstantin Belousov enable_intr(); 432dfe7b3bfSKonstantin Belousov else if (cpu_idle_hook) 433dfe7b3bfSKonstantin Belousov cpu_idle_hook(sbt); 434dfe7b3bfSKonstantin Belousov else 435b57a73f8SKonstantin Belousov acpi_cpu_c1(); 436a5bd21d0SKonstantin Belousov atomic_store_int(state, STATE_RUNNING); 437dfe7b3bfSKonstantin Belousov } 438dfe7b3bfSKonstantin Belousov 439dfe7b3bfSKonstantin Belousov static void 440dfe7b3bfSKonstantin Belousov cpu_idle_hlt(sbintime_t sbt) 441dfe7b3bfSKonstantin Belousov { 442dfe7b3bfSKonstantin Belousov int *state; 443dfe7b3bfSKonstantin Belousov 444dfe7b3bfSKonstantin Belousov state = (int *)PCPU_PTR(monitorbuf); 445a5bd21d0SKonstantin Belousov atomic_store_int(state, STATE_SLEEPING); 446dfe7b3bfSKonstantin Belousov 447dfe7b3bfSKonstantin Belousov /* 448dfe7b3bfSKonstantin Belousov * Since we may be in a critical section from cpu_idle(), if 449dfe7b3bfSKonstantin Belousov * an interrupt fires during that critical section we may have 450dfe7b3bfSKonstantin Belousov * a pending preemption. If the CPU halts, then that thread 451dfe7b3bfSKonstantin Belousov * may not execute until a later interrupt awakens the CPU. 452dfe7b3bfSKonstantin Belousov * To handle this race, check for a runnable thread after 453dfe7b3bfSKonstantin Belousov * disabling interrupts and immediately return if one is 454dfe7b3bfSKonstantin Belousov * found. Also, we must absolutely guarentee that hlt is 455dfe7b3bfSKonstantin Belousov * the next instruction after sti. This ensures that any 456dfe7b3bfSKonstantin Belousov * interrupt that fires after the call to disable_intr() will 457dfe7b3bfSKonstantin Belousov * immediately awaken the CPU from hlt. Finally, please note 458dfe7b3bfSKonstantin Belousov * that on x86 this works fine because of interrupts enabled only 459dfe7b3bfSKonstantin Belousov * after the instruction following sti takes place, while IF is set 460dfe7b3bfSKonstantin Belousov * to 1 immediately, allowing hlt instruction to acknowledge the 461dfe7b3bfSKonstantin Belousov * interrupt. 462dfe7b3bfSKonstantin Belousov */ 463dfe7b3bfSKonstantin Belousov disable_intr(); 464dfe7b3bfSKonstantin Belousov if (sched_runnable()) 465dfe7b3bfSKonstantin Belousov enable_intr(); 466dfe7b3bfSKonstantin Belousov else 467b57a73f8SKonstantin Belousov acpi_cpu_c1(); 468a5bd21d0SKonstantin Belousov atomic_store_int(state, STATE_RUNNING); 469dfe7b3bfSKonstantin Belousov } 470dfe7b3bfSKonstantin Belousov 471dfe7b3bfSKonstantin Belousov static void 472dfe7b3bfSKonstantin Belousov cpu_idle_mwait(sbintime_t sbt) 473dfe7b3bfSKonstantin Belousov { 474dfe7b3bfSKonstantin Belousov int *state; 475dfe7b3bfSKonstantin Belousov 476dfe7b3bfSKonstantin Belousov state = (int *)PCPU_PTR(monitorbuf); 477a5bd21d0SKonstantin Belousov atomic_store_int(state, STATE_MWAIT); 478dfe7b3bfSKonstantin Belousov 479dfe7b3bfSKonstantin Belousov /* See comments in cpu_idle_hlt(). */ 480dfe7b3bfSKonstantin Belousov disable_intr(); 481dfe7b3bfSKonstantin Belousov if (sched_runnable()) { 482a5bd21d0SKonstantin Belousov atomic_store_int(state, STATE_RUNNING); 483dfe7b3bfSKonstantin Belousov enable_intr(); 484dfe7b3bfSKonstantin Belousov return; 485dfe7b3bfSKonstantin Belousov } 486a5bd21d0SKonstantin Belousov 487dfe7b3bfSKonstantin Belousov cpu_monitor(state, 0, 0); 488a5bd21d0SKonstantin Belousov if (atomic_load_int(state) == STATE_MWAIT) 489dfe7b3bfSKonstantin Belousov __asm __volatile("sti; mwait" : : "a" (MWAIT_C1), "c" (0)); 490dfe7b3bfSKonstantin Belousov else 491dfe7b3bfSKonstantin Belousov enable_intr(); 492a5bd21d0SKonstantin Belousov atomic_store_int(state, STATE_RUNNING); 493dfe7b3bfSKonstantin Belousov } 494dfe7b3bfSKonstantin Belousov 495dfe7b3bfSKonstantin Belousov static void 496dfe7b3bfSKonstantin Belousov cpu_idle_spin(sbintime_t sbt) 497dfe7b3bfSKonstantin Belousov { 498dfe7b3bfSKonstantin Belousov int *state; 499dfe7b3bfSKonstantin Belousov int i; 500dfe7b3bfSKonstantin Belousov 501dfe7b3bfSKonstantin Belousov state = (int *)PCPU_PTR(monitorbuf); 502a5bd21d0SKonstantin Belousov atomic_store_int(state, STATE_RUNNING); 503dfe7b3bfSKonstantin Belousov 504dfe7b3bfSKonstantin Belousov /* 505dfe7b3bfSKonstantin Belousov * The sched_runnable() call is racy but as long as there is 506dfe7b3bfSKonstantin Belousov * a loop missing it one time will have just a little impact if any 507dfe7b3bfSKonstantin Belousov * (and it is much better than missing the check at all). 508dfe7b3bfSKonstantin Belousov */ 509dfe7b3bfSKonstantin Belousov for (i = 0; i < 1000; i++) { 510dfe7b3bfSKonstantin Belousov if (sched_runnable()) 511dfe7b3bfSKonstantin Belousov return; 512dfe7b3bfSKonstantin Belousov cpu_spinwait(); 513dfe7b3bfSKonstantin Belousov } 514dfe7b3bfSKonstantin Belousov } 515dfe7b3bfSKonstantin Belousov 516dfe7b3bfSKonstantin Belousov /* 517dfe7b3bfSKonstantin Belousov * C1E renders the local APIC timer dead, so we disable it by 518dfe7b3bfSKonstantin Belousov * reading the Interrupt Pending Message register and clearing 519dfe7b3bfSKonstantin Belousov * both C1eOnCmpHalt (bit 28) and SmiOnCmpHalt (bit 27). 520dfe7b3bfSKonstantin Belousov * 521dfe7b3bfSKonstantin Belousov * Reference: 522dfe7b3bfSKonstantin Belousov * "BIOS and Kernel Developer's Guide for AMD NPT Family 0Fh Processors" 523dfe7b3bfSKonstantin Belousov * #32559 revision 3.00+ 524dfe7b3bfSKonstantin Belousov */ 525dfe7b3bfSKonstantin Belousov #define MSR_AMDK8_IPM 0xc0010055 526dfe7b3bfSKonstantin Belousov #define AMDK8_SMIONCMPHALT (1ULL << 27) 527dfe7b3bfSKonstantin Belousov #define AMDK8_C1EONCMPHALT (1ULL << 28) 528dfe7b3bfSKonstantin Belousov #define AMDK8_CMPHALT (AMDK8_SMIONCMPHALT | AMDK8_C1EONCMPHALT) 529dfe7b3bfSKonstantin Belousov 530dfe7b3bfSKonstantin Belousov void 531dfe7b3bfSKonstantin Belousov cpu_probe_amdc1e(void) 532dfe7b3bfSKonstantin Belousov { 533dfe7b3bfSKonstantin Belousov 534dfe7b3bfSKonstantin Belousov /* 535dfe7b3bfSKonstantin Belousov * Detect the presence of C1E capability mostly on latest 536dfe7b3bfSKonstantin Belousov * dual-cores (or future) k8 family. 537dfe7b3bfSKonstantin Belousov */ 538dfe7b3bfSKonstantin Belousov if (cpu_vendor_id == CPU_VENDOR_AMD && 539dfe7b3bfSKonstantin Belousov (cpu_id & 0x00000f00) == 0x00000f00 && 540dfe7b3bfSKonstantin Belousov (cpu_id & 0x0fff0000) >= 0x00040000) { 541dfe7b3bfSKonstantin Belousov cpu_ident_amdc1e = 1; 542dfe7b3bfSKonstantin Belousov } 543dfe7b3bfSKonstantin Belousov } 544dfe7b3bfSKonstantin Belousov 545dfe7b3bfSKonstantin Belousov void (*cpu_idle_fn)(sbintime_t) = cpu_idle_acpi; 546dfe7b3bfSKonstantin Belousov 547dfe7b3bfSKonstantin Belousov void 548dfe7b3bfSKonstantin Belousov cpu_idle(int busy) 549dfe7b3bfSKonstantin Belousov { 550dfe7b3bfSKonstantin Belousov uint64_t msr; 551dfe7b3bfSKonstantin Belousov sbintime_t sbt = -1; 552dfe7b3bfSKonstantin Belousov 553dfe7b3bfSKonstantin Belousov CTR2(KTR_SPARE2, "cpu_idle(%d) at %d", 554dfe7b3bfSKonstantin Belousov busy, curcpu); 555ed95805eSJohn Baldwin #ifdef MP_WATCHDOG 556dfe7b3bfSKonstantin Belousov ap_watchdog(PCPU_GET(cpuid)); 557dfe7b3bfSKonstantin Belousov #endif 558ed95805eSJohn Baldwin 559dfe7b3bfSKonstantin Belousov /* If we are busy - try to use fast methods. */ 560dfe7b3bfSKonstantin Belousov if (busy) { 561dfe7b3bfSKonstantin Belousov if ((cpu_feature2 & CPUID2_MON) && idle_mwait) { 562dfe7b3bfSKonstantin Belousov cpu_idle_mwait(busy); 563dfe7b3bfSKonstantin Belousov goto out; 564dfe7b3bfSKonstantin Belousov } 565dfe7b3bfSKonstantin Belousov } 566dfe7b3bfSKonstantin Belousov 567dfe7b3bfSKonstantin Belousov /* If we have time - switch timers into idle mode. */ 568dfe7b3bfSKonstantin Belousov if (!busy) { 569dfe7b3bfSKonstantin Belousov critical_enter(); 570dfe7b3bfSKonstantin Belousov sbt = cpu_idleclock(); 571dfe7b3bfSKonstantin Belousov } 572dfe7b3bfSKonstantin Belousov 573dfe7b3bfSKonstantin Belousov /* Apply AMD APIC timer C1E workaround. */ 574dfe7b3bfSKonstantin Belousov if (cpu_ident_amdc1e && cpu_disable_c3_sleep) { 575dfe7b3bfSKonstantin Belousov msr = rdmsr(MSR_AMDK8_IPM); 576dfe7b3bfSKonstantin Belousov if (msr & AMDK8_CMPHALT) 577dfe7b3bfSKonstantin Belousov wrmsr(MSR_AMDK8_IPM, msr & ~AMDK8_CMPHALT); 578dfe7b3bfSKonstantin Belousov } 579dfe7b3bfSKonstantin Belousov 580dfe7b3bfSKonstantin Belousov /* Call main idle method. */ 581dfe7b3bfSKonstantin Belousov cpu_idle_fn(sbt); 582dfe7b3bfSKonstantin Belousov 583dfe7b3bfSKonstantin Belousov /* Switch timers back into active mode. */ 584dfe7b3bfSKonstantin Belousov if (!busy) { 585dfe7b3bfSKonstantin Belousov cpu_activeclock(); 586dfe7b3bfSKonstantin Belousov critical_exit(); 587dfe7b3bfSKonstantin Belousov } 588dfe7b3bfSKonstantin Belousov out: 589dfe7b3bfSKonstantin Belousov CTR2(KTR_SPARE2, "cpu_idle(%d) at %d done", 590dfe7b3bfSKonstantin Belousov busy, curcpu); 591dfe7b3bfSKonstantin Belousov } 592dfe7b3bfSKonstantin Belousov 5933f3937b4SKonstantin Belousov static int cpu_idle_apl31_workaround; 5943f3937b4SKonstantin Belousov SYSCTL_INT(_machdep, OID_AUTO, idle_apl31, CTLFLAG_RW, 5953f3937b4SKonstantin Belousov &cpu_idle_apl31_workaround, 0, 596160be7ccSKonstantin Belousov "Apollo Lake APL31 MWAIT bug workaround"); 5973f3937b4SKonstantin Belousov 598dfe7b3bfSKonstantin Belousov int 599dfe7b3bfSKonstantin Belousov cpu_idle_wakeup(int cpu) 600dfe7b3bfSKonstantin Belousov { 601dfe7b3bfSKonstantin Belousov int *state; 602dfe7b3bfSKonstantin Belousov 603a5bd21d0SKonstantin Belousov state = (int *)pcpu_find(cpu)->pc_monitorbuf; 604a5bd21d0SKonstantin Belousov switch (atomic_load_int(state)) { 605a5bd21d0SKonstantin Belousov case STATE_SLEEPING: 606dfe7b3bfSKonstantin Belousov return (0); 607a5bd21d0SKonstantin Belousov case STATE_MWAIT: 608a5bd21d0SKonstantin Belousov atomic_store_int(state, STATE_RUNNING); 6093f3937b4SKonstantin Belousov return (cpu_idle_apl31_workaround ? 0 : 1); 610a5bd21d0SKonstantin Belousov case STATE_RUNNING: 611a5bd21d0SKonstantin Belousov return (1); 612a5bd21d0SKonstantin Belousov default: 613a5bd21d0SKonstantin Belousov panic("bad monitor state"); 614a5bd21d0SKonstantin Belousov return (1); 615a5bd21d0SKonstantin Belousov } 616dfe7b3bfSKonstantin Belousov } 617dfe7b3bfSKonstantin Belousov 618dfe7b3bfSKonstantin Belousov /* 619dfe7b3bfSKonstantin Belousov * Ordered by speed/power consumption. 620dfe7b3bfSKonstantin Belousov */ 621a5f472c5SKonstantin Belousov static struct { 622dfe7b3bfSKonstantin Belousov void *id_fn; 623dfe7b3bfSKonstantin Belousov char *id_name; 624a5f472c5SKonstantin Belousov int id_cpuid2_flag; 625dfe7b3bfSKonstantin Belousov } idle_tbl[] = { 626a5f472c5SKonstantin Belousov { .id_fn = cpu_idle_spin, .id_name = "spin" }, 627a5f472c5SKonstantin Belousov { .id_fn = cpu_idle_mwait, .id_name = "mwait", 628a5f472c5SKonstantin Belousov .id_cpuid2_flag = CPUID2_MON }, 629a5f472c5SKonstantin Belousov { .id_fn = cpu_idle_hlt, .id_name = "hlt" }, 630a5f472c5SKonstantin Belousov { .id_fn = cpu_idle_acpi, .id_name = "acpi" }, 631dfe7b3bfSKonstantin Belousov }; 632dfe7b3bfSKonstantin Belousov 633dfe7b3bfSKonstantin Belousov static int 634dfe7b3bfSKonstantin Belousov idle_sysctl_available(SYSCTL_HANDLER_ARGS) 635dfe7b3bfSKonstantin Belousov { 636dfe7b3bfSKonstantin Belousov char *avail, *p; 637dfe7b3bfSKonstantin Belousov int error; 638dfe7b3bfSKonstantin Belousov int i; 639dfe7b3bfSKonstantin Belousov 640dfe7b3bfSKonstantin Belousov avail = malloc(256, M_TEMP, M_WAITOK); 641dfe7b3bfSKonstantin Belousov p = avail; 642a5f472c5SKonstantin Belousov for (i = 0; i < nitems(idle_tbl); i++) { 643a5f472c5SKonstantin Belousov if (idle_tbl[i].id_cpuid2_flag != 0 && 644a5f472c5SKonstantin Belousov (cpu_feature2 & idle_tbl[i].id_cpuid2_flag) == 0) 645dfe7b3bfSKonstantin Belousov continue; 646dfe7b3bfSKonstantin Belousov if (strcmp(idle_tbl[i].id_name, "acpi") == 0 && 647dfe7b3bfSKonstantin Belousov cpu_idle_hook == NULL) 648dfe7b3bfSKonstantin Belousov continue; 649dfe7b3bfSKonstantin Belousov p += sprintf(p, "%s%s", p != avail ? ", " : "", 650dfe7b3bfSKonstantin Belousov idle_tbl[i].id_name); 651dfe7b3bfSKonstantin Belousov } 652dfe7b3bfSKonstantin Belousov error = sysctl_handle_string(oidp, avail, 0, req); 653dfe7b3bfSKonstantin Belousov free(avail, M_TEMP); 654dfe7b3bfSKonstantin Belousov return (error); 655dfe7b3bfSKonstantin Belousov } 656dfe7b3bfSKonstantin Belousov 657dfe7b3bfSKonstantin Belousov SYSCTL_PROC(_machdep, OID_AUTO, idle_available, CTLTYPE_STRING | CTLFLAG_RD, 658dfe7b3bfSKonstantin Belousov 0, 0, idle_sysctl_available, "A", "list of available idle functions"); 659dfe7b3bfSKonstantin Belousov 66055ba21d4SKonstantin Belousov static bool 661a5f472c5SKonstantin Belousov cpu_idle_selector(const char *new_idle_name) 66255ba21d4SKonstantin Belousov { 66355ba21d4SKonstantin Belousov int i; 66455ba21d4SKonstantin Belousov 665a5f472c5SKonstantin Belousov for (i = 0; i < nitems(idle_tbl); i++) { 666a5f472c5SKonstantin Belousov if (idle_tbl[i].id_cpuid2_flag != 0 && 667a5f472c5SKonstantin Belousov (cpu_feature2 & idle_tbl[i].id_cpuid2_flag) == 0) 66855ba21d4SKonstantin Belousov continue; 66955ba21d4SKonstantin Belousov if (strcmp(idle_tbl[i].id_name, "acpi") == 0 && 67055ba21d4SKonstantin Belousov cpu_idle_hook == NULL) 67155ba21d4SKonstantin Belousov continue; 67255ba21d4SKonstantin Belousov if (strcmp(idle_tbl[i].id_name, new_idle_name)) 67355ba21d4SKonstantin Belousov continue; 67455ba21d4SKonstantin Belousov cpu_idle_fn = idle_tbl[i].id_fn; 67555ba21d4SKonstantin Belousov if (bootverbose) 67655ba21d4SKonstantin Belousov printf("CPU idle set to %s\n", idle_tbl[i].id_name); 67755ba21d4SKonstantin Belousov return (true); 67855ba21d4SKonstantin Belousov } 67955ba21d4SKonstantin Belousov return (false); 68055ba21d4SKonstantin Belousov } 68155ba21d4SKonstantin Belousov 682dfe7b3bfSKonstantin Belousov static int 683a5f472c5SKonstantin Belousov cpu_idle_sysctl(SYSCTL_HANDLER_ARGS) 684dfe7b3bfSKonstantin Belousov { 68555ba21d4SKonstantin Belousov char buf[16], *p; 68655ba21d4SKonstantin Belousov int error, i; 687dfe7b3bfSKonstantin Belousov 688dfe7b3bfSKonstantin Belousov p = "unknown"; 689a5f472c5SKonstantin Belousov for (i = 0; i < nitems(idle_tbl); i++) { 690dfe7b3bfSKonstantin Belousov if (idle_tbl[i].id_fn == cpu_idle_fn) { 691dfe7b3bfSKonstantin Belousov p = idle_tbl[i].id_name; 692dfe7b3bfSKonstantin Belousov break; 693dfe7b3bfSKonstantin Belousov } 694dfe7b3bfSKonstantin Belousov } 695dfe7b3bfSKonstantin Belousov strncpy(buf, p, sizeof(buf)); 696dfe7b3bfSKonstantin Belousov error = sysctl_handle_string(oidp, buf, sizeof(buf), req); 697dfe7b3bfSKonstantin Belousov if (error != 0 || req->newptr == NULL) 698dfe7b3bfSKonstantin Belousov return (error); 699a5f472c5SKonstantin Belousov return (cpu_idle_selector(buf) ? 0 : EINVAL); 700dfe7b3bfSKonstantin Belousov } 701dfe7b3bfSKonstantin Belousov 702dfe7b3bfSKonstantin Belousov SYSCTL_PROC(_machdep, OID_AUTO, idle, CTLTYPE_STRING | CTLFLAG_RW, 0, 0, 703a5f472c5SKonstantin Belousov cpu_idle_sysctl, "A", "currently selected idle function"); 704835c2787SKonstantin Belousov 70555ba21d4SKonstantin Belousov static void 706a5f472c5SKonstantin Belousov cpu_idle_tun(void *unused __unused) 70755ba21d4SKonstantin Belousov { 70855ba21d4SKonstantin Belousov char tunvar[16]; 70955ba21d4SKonstantin Belousov 71055ba21d4SKonstantin Belousov if (TUNABLE_STR_FETCH("machdep.idle", tunvar, sizeof(tunvar))) 711a5f472c5SKonstantin Belousov cpu_idle_selector(tunvar); 7123f3937b4SKonstantin Belousov if (cpu_vendor_id == CPU_VENDOR_INTEL && cpu_id == 0x506c9) { 7133f3937b4SKonstantin Belousov /* 714160be7ccSKonstantin Belousov * Apollo Lake errata APL31 (public errata APL30). 715160be7ccSKonstantin Belousov * Stores to the armed address range may not trigger 716160be7ccSKonstantin Belousov * MWAIT to resume execution. OS needs to use 717160be7ccSKonstantin Belousov * interrupts to wake processors from MWAIT-induced 718160be7ccSKonstantin Belousov * sleep states. 7193f3937b4SKonstantin Belousov */ 7203f3937b4SKonstantin Belousov cpu_idle_apl31_workaround = 1; 7213f3937b4SKonstantin Belousov } 7223f3937b4SKonstantin Belousov TUNABLE_INT_FETCH("machdep.idle_apl31", &cpu_idle_apl31_workaround); 72355ba21d4SKonstantin Belousov } 724a5f472c5SKonstantin Belousov SYSINIT(cpu_idle_tun, SI_SUB_CPU, SI_ORDER_MIDDLE, cpu_idle_tun, NULL); 72555ba21d4SKonstantin Belousov 726295f4b6cSKonstantin Belousov static int panic_on_nmi = 1; 727295f4b6cSKonstantin Belousov SYSCTL_INT(_machdep, OID_AUTO, panic_on_nmi, CTLFLAG_RWTUN, 728295f4b6cSKonstantin Belousov &panic_on_nmi, 0, 729413ed27cSAndriy Gapon "Panic on NMI raised by hardware failure"); 730835c2787SKonstantin Belousov int nmi_is_broadcast = 1; 731835c2787SKonstantin Belousov SYSCTL_INT(_machdep, OID_AUTO, nmi_is_broadcast, CTLFLAG_RWTUN, 732835c2787SKonstantin Belousov &nmi_is_broadcast, 0, 733835c2787SKonstantin Belousov "Chipset NMI is broadcast"); 734835c2787SKonstantin Belousov #ifdef KDB 735835c2787SKonstantin Belousov int kdb_on_nmi = 1; 736835c2787SKonstantin Belousov SYSCTL_INT(_machdep, OID_AUTO, kdb_on_nmi, CTLFLAG_RWTUN, 737835c2787SKonstantin Belousov &kdb_on_nmi, 0, 738413ed27cSAndriy Gapon "Go to KDB on NMI with unknown source"); 739835c2787SKonstantin Belousov #endif 740835c2787SKonstantin Belousov 741295f4b6cSKonstantin Belousov void 742295f4b6cSKonstantin Belousov nmi_call_kdb(u_int cpu, u_int type, struct trapframe *frame) 743835c2787SKonstantin Belousov { 7440fb3a72aSAndriy Gapon bool claimed = false; 745835c2787SKonstantin Belousov 7460fb3a72aSAndriy Gapon #ifdef DEV_ISA 747835c2787SKonstantin Belousov /* machine/parity/power fail/"kitchen sink" faults */ 7480fb3a72aSAndriy Gapon if (isa_nmi(frame->tf_err)) { 7490fb3a72aSAndriy Gapon claimed = true; 7500fb3a72aSAndriy Gapon if (panic_on_nmi) 7510fb3a72aSAndriy Gapon panic("NMI indicates hardware failure"); 7520fb3a72aSAndriy Gapon } 7530fb3a72aSAndriy Gapon #endif /* DEV_ISA */ 754835c2787SKonstantin Belousov #ifdef KDB 7550fb3a72aSAndriy Gapon if (!claimed && kdb_on_nmi) { 756835c2787SKonstantin Belousov /* 757835c2787SKonstantin Belousov * NMI can be hooked up to a pushbutton for debugging. 758835c2787SKonstantin Belousov */ 759835c2787SKonstantin Belousov printf("NMI/cpu%d ... going to debugger\n", cpu); 760835c2787SKonstantin Belousov kdb_trap(type, 0, frame); 761835c2787SKonstantin Belousov } 762835c2787SKonstantin Belousov #endif /* KDB */ 763295f4b6cSKonstantin Belousov } 764835c2787SKonstantin Belousov 765295f4b6cSKonstantin Belousov void 766295f4b6cSKonstantin Belousov nmi_handle_intr(u_int type, struct trapframe *frame) 767835c2787SKonstantin Belousov { 768835c2787SKonstantin Belousov 769835c2787SKonstantin Belousov #ifdef SMP 770295f4b6cSKonstantin Belousov if (nmi_is_broadcast) { 771295f4b6cSKonstantin Belousov nmi_call_kdb_smp(type, frame); 772295f4b6cSKonstantin Belousov return; 773295f4b6cSKonstantin Belousov } 774835c2787SKonstantin Belousov #endif 7751d6dfd12SKonstantin Belousov nmi_call_kdb(PCPU_GET(cpuid), type, frame); 776835c2787SKonstantin Belousov } 777319117fdSKonstantin Belousov 778319117fdSKonstantin Belousov int hw_ibrs_active; 779319117fdSKonstantin Belousov int hw_ibrs_disable = 1; 780319117fdSKonstantin Belousov 781319117fdSKonstantin Belousov SYSCTL_INT(_hw, OID_AUTO, ibrs_active, CTLFLAG_RD, &hw_ibrs_active, 0, 782b31b965eSKonstantin Belousov "Indirect Branch Restricted Speculation active"); 783319117fdSKonstantin Belousov 784319117fdSKonstantin Belousov void 785319117fdSKonstantin Belousov hw_ibrs_recalculate(void) 786319117fdSKonstantin Belousov { 787319117fdSKonstantin Belousov uint64_t v; 788319117fdSKonstantin Belousov 789319117fdSKonstantin Belousov if ((cpu_ia32_arch_caps & IA32_ARCH_CAP_IBRS_ALL) != 0) { 790319117fdSKonstantin Belousov if (hw_ibrs_disable) { 791319117fdSKonstantin Belousov v = rdmsr(MSR_IA32_SPEC_CTRL); 792c688c905SKonstantin Belousov v &= ~(uint64_t)IA32_SPEC_CTRL_IBRS; 793319117fdSKonstantin Belousov wrmsr(MSR_IA32_SPEC_CTRL, v); 794319117fdSKonstantin Belousov } else { 795319117fdSKonstantin Belousov v = rdmsr(MSR_IA32_SPEC_CTRL); 796319117fdSKonstantin Belousov v |= IA32_SPEC_CTRL_IBRS; 797319117fdSKonstantin Belousov wrmsr(MSR_IA32_SPEC_CTRL, v); 798319117fdSKonstantin Belousov } 799319117fdSKonstantin Belousov return; 800319117fdSKonstantin Belousov } 801319117fdSKonstantin Belousov hw_ibrs_active = (cpu_stdext_feature3 & CPUID_STDEXT3_IBPB) != 0 && 802319117fdSKonstantin Belousov !hw_ibrs_disable; 803319117fdSKonstantin Belousov } 804319117fdSKonstantin Belousov 805319117fdSKonstantin Belousov static int 806319117fdSKonstantin Belousov hw_ibrs_disable_handler(SYSCTL_HANDLER_ARGS) 807319117fdSKonstantin Belousov { 808319117fdSKonstantin Belousov int error, val; 809319117fdSKonstantin Belousov 810319117fdSKonstantin Belousov val = hw_ibrs_disable; 811319117fdSKonstantin Belousov error = sysctl_handle_int(oidp, &val, 0, req); 812319117fdSKonstantin Belousov if (error != 0 || req->newptr == NULL) 813319117fdSKonstantin Belousov return (error); 814319117fdSKonstantin Belousov hw_ibrs_disable = val != 0; 815319117fdSKonstantin Belousov hw_ibrs_recalculate(); 816319117fdSKonstantin Belousov return (0); 817319117fdSKonstantin Belousov } 818319117fdSKonstantin Belousov SYSCTL_PROC(_hw, OID_AUTO, ibrs_disable, CTLTYPE_INT | CTLFLAG_RWTUN | 819319117fdSKonstantin Belousov CTLFLAG_NOFETCH | CTLFLAG_MPSAFE, NULL, 0, hw_ibrs_disable_handler, "I", 820b31b965eSKonstantin Belousov "Disable Indirect Branch Restricted Speculation"); 8218fbcc334SKonstantin Belousov 8223621ba1eSKonstantin Belousov int hw_ssb_active; 8233621ba1eSKonstantin Belousov int hw_ssb_disable; 8243621ba1eSKonstantin Belousov 8253621ba1eSKonstantin Belousov SYSCTL_INT(_hw, OID_AUTO, spec_store_bypass_disable_active, CTLFLAG_RD, 8263621ba1eSKonstantin Belousov &hw_ssb_active, 0, 8273621ba1eSKonstantin Belousov "Speculative Store Bypass Disable active"); 8283621ba1eSKonstantin Belousov 8293621ba1eSKonstantin Belousov static void 8303621ba1eSKonstantin Belousov hw_ssb_set_one(bool enable) 8313621ba1eSKonstantin Belousov { 8323621ba1eSKonstantin Belousov uint64_t v; 8333621ba1eSKonstantin Belousov 8343621ba1eSKonstantin Belousov v = rdmsr(MSR_IA32_SPEC_CTRL); 8353621ba1eSKonstantin Belousov if (enable) 8363621ba1eSKonstantin Belousov v |= (uint64_t)IA32_SPEC_CTRL_SSBD; 8373621ba1eSKonstantin Belousov else 8383621ba1eSKonstantin Belousov v &= ~(uint64_t)IA32_SPEC_CTRL_SSBD; 8393621ba1eSKonstantin Belousov wrmsr(MSR_IA32_SPEC_CTRL, v); 8403621ba1eSKonstantin Belousov } 8413621ba1eSKonstantin Belousov 8423621ba1eSKonstantin Belousov static void 8433621ba1eSKonstantin Belousov hw_ssb_set(bool enable, bool for_all_cpus) 8443621ba1eSKonstantin Belousov { 8453621ba1eSKonstantin Belousov struct thread *td; 8463621ba1eSKonstantin Belousov int bound_cpu, i, is_bound; 8473621ba1eSKonstantin Belousov 8483621ba1eSKonstantin Belousov if ((cpu_stdext_feature3 & CPUID_STDEXT3_SSBD) == 0) { 8493621ba1eSKonstantin Belousov hw_ssb_active = 0; 8503621ba1eSKonstantin Belousov return; 8513621ba1eSKonstantin Belousov } 8523621ba1eSKonstantin Belousov hw_ssb_active = enable; 8533621ba1eSKonstantin Belousov if (for_all_cpus) { 8543621ba1eSKonstantin Belousov td = curthread; 8553621ba1eSKonstantin Belousov thread_lock(td); 8563621ba1eSKonstantin Belousov is_bound = sched_is_bound(td); 8573621ba1eSKonstantin Belousov bound_cpu = td->td_oncpu; 8583621ba1eSKonstantin Belousov CPU_FOREACH(i) { 8593621ba1eSKonstantin Belousov sched_bind(td, i); 8603621ba1eSKonstantin Belousov hw_ssb_set_one(enable); 8613621ba1eSKonstantin Belousov } 8623621ba1eSKonstantin Belousov if (is_bound) 8633621ba1eSKonstantin Belousov sched_bind(td, bound_cpu); 8643621ba1eSKonstantin Belousov else 8653621ba1eSKonstantin Belousov sched_unbind(td); 8663621ba1eSKonstantin Belousov thread_unlock(td); 8673621ba1eSKonstantin Belousov } else { 8683621ba1eSKonstantin Belousov hw_ssb_set_one(enable); 8693621ba1eSKonstantin Belousov } 8703621ba1eSKonstantin Belousov } 8713621ba1eSKonstantin Belousov 8723621ba1eSKonstantin Belousov void 8733621ba1eSKonstantin Belousov hw_ssb_recalculate(bool all_cpus) 8743621ba1eSKonstantin Belousov { 8753621ba1eSKonstantin Belousov 8763621ba1eSKonstantin Belousov switch (hw_ssb_disable) { 8773621ba1eSKonstantin Belousov default: 8783621ba1eSKonstantin Belousov hw_ssb_disable = 0; 8793621ba1eSKonstantin Belousov /* FALLTHROUGH */ 8803621ba1eSKonstantin Belousov case 0: /* off */ 8813621ba1eSKonstantin Belousov hw_ssb_set(false, all_cpus); 8823621ba1eSKonstantin Belousov break; 8833621ba1eSKonstantin Belousov case 1: /* on */ 8843621ba1eSKonstantin Belousov hw_ssb_set(true, all_cpus); 8853621ba1eSKonstantin Belousov break; 8863621ba1eSKonstantin Belousov case 2: /* auto */ 8873621ba1eSKonstantin Belousov hw_ssb_set((cpu_ia32_arch_caps & IA32_ARCH_CAP_SSBD_NO) != 0 ? 8883621ba1eSKonstantin Belousov false : true, all_cpus); 8893621ba1eSKonstantin Belousov break; 8903621ba1eSKonstantin Belousov } 8913621ba1eSKonstantin Belousov } 8923621ba1eSKonstantin Belousov 8933621ba1eSKonstantin Belousov static int 8943621ba1eSKonstantin Belousov hw_ssb_disable_handler(SYSCTL_HANDLER_ARGS) 8953621ba1eSKonstantin Belousov { 8963621ba1eSKonstantin Belousov int error, val; 8973621ba1eSKonstantin Belousov 8983621ba1eSKonstantin Belousov val = hw_ssb_disable; 8993621ba1eSKonstantin Belousov error = sysctl_handle_int(oidp, &val, 0, req); 9003621ba1eSKonstantin Belousov if (error != 0 || req->newptr == NULL) 9013621ba1eSKonstantin Belousov return (error); 9023621ba1eSKonstantin Belousov hw_ssb_disable = val; 9033621ba1eSKonstantin Belousov hw_ssb_recalculate(true); 9043621ba1eSKonstantin Belousov return (0); 9053621ba1eSKonstantin Belousov } 9063621ba1eSKonstantin Belousov SYSCTL_PROC(_hw, OID_AUTO, spec_store_bypass_disable, CTLTYPE_INT | 9073621ba1eSKonstantin Belousov CTLFLAG_RWTUN | CTLFLAG_NOFETCH | CTLFLAG_MPSAFE, NULL, 0, 9083621ba1eSKonstantin Belousov hw_ssb_disable_handler, "I", 9093621ba1eSKonstantin Belousov "Speculative Store Bypass Disable (0 - off, 1 - on, 2 - auto"); 9103621ba1eSKonstantin Belousov 9118fbcc334SKonstantin Belousov /* 9128fbcc334SKonstantin Belousov * Enable and restore kernel text write permissions. 9138fbcc334SKonstantin Belousov * Callers must ensure that disable_wp()/restore_wp() are executed 9148fbcc334SKonstantin Belousov * without rescheduling on the same core. 9158fbcc334SKonstantin Belousov */ 9168fbcc334SKonstantin Belousov bool 9178fbcc334SKonstantin Belousov disable_wp(void) 9188fbcc334SKonstantin Belousov { 9198fbcc334SKonstantin Belousov u_int cr0; 9208fbcc334SKonstantin Belousov 9218fbcc334SKonstantin Belousov cr0 = rcr0(); 9228fbcc334SKonstantin Belousov if ((cr0 & CR0_WP) == 0) 9238fbcc334SKonstantin Belousov return (false); 9248fbcc334SKonstantin Belousov load_cr0(cr0 & ~CR0_WP); 9258fbcc334SKonstantin Belousov return (true); 9268fbcc334SKonstantin Belousov } 9278fbcc334SKonstantin Belousov 9288fbcc334SKonstantin Belousov void 9298fbcc334SKonstantin Belousov restore_wp(bool old_wp) 9308fbcc334SKonstantin Belousov { 9318fbcc334SKonstantin Belousov 9328fbcc334SKonstantin Belousov if (old_wp) 9338fbcc334SKonstantin Belousov load_cr0(rcr0() | CR0_WP); 9348fbcc334SKonstantin Belousov } 9358fbcc334SKonstantin Belousov 936*7705dd4dSKonstantin Belousov bool 937*7705dd4dSKonstantin Belousov acpi_get_fadt_bootflags(uint16_t *flagsp) 938*7705dd4dSKonstantin Belousov { 939*7705dd4dSKonstantin Belousov #ifdef DEV_ACPI 940*7705dd4dSKonstantin Belousov ACPI_TABLE_FADT *fadt; 941*7705dd4dSKonstantin Belousov vm_paddr_t physaddr; 942*7705dd4dSKonstantin Belousov 943*7705dd4dSKonstantin Belousov physaddr = acpi_find_table(ACPI_SIG_FADT); 944*7705dd4dSKonstantin Belousov if (physaddr == 0) 945*7705dd4dSKonstantin Belousov return (false); 946*7705dd4dSKonstantin Belousov fadt = acpi_map_table(physaddr, ACPI_SIG_FADT); 947*7705dd4dSKonstantin Belousov if (fadt == NULL) 948*7705dd4dSKonstantin Belousov return (false); 949*7705dd4dSKonstantin Belousov *flagsp = fadt->BootFlags; 950*7705dd4dSKonstantin Belousov acpi_unmap_table(fadt); 951*7705dd4dSKonstantin Belousov return (true); 952*7705dd4dSKonstantin Belousov #else 953*7705dd4dSKonstantin Belousov return (false); 954*7705dd4dSKonstantin Belousov #endif 955*7705dd4dSKonstantin Belousov } 956