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 44dfe7b3bfSKonstantin Belousov #include "opt_atpic.h" 45dfe7b3bfSKonstantin Belousov #include "opt_cpu.h" 46dfe7b3bfSKonstantin Belousov #include "opt_ddb.h" 47dfe7b3bfSKonstantin Belousov #include "opt_inet.h" 48dfe7b3bfSKonstantin Belousov #include "opt_isa.h" 49835c2787SKonstantin Belousov #include "opt_kdb.h" 50dfe7b3bfSKonstantin Belousov #include "opt_kstack_pages.h" 51dfe7b3bfSKonstantin Belousov #include "opt_maxmem.h" 52dfe7b3bfSKonstantin Belousov #include "opt_mp_watchdog.h" 53dfe7b3bfSKonstantin Belousov #include "opt_platform.h" 54dfe7b3bfSKonstantin Belousov #ifdef __i386__ 55dfe7b3bfSKonstantin Belousov #include "opt_apic.h" 56dfe7b3bfSKonstantin Belousov #endif 57dfe7b3bfSKonstantin Belousov 58dfe7b3bfSKonstantin Belousov #include <sys/param.h> 59dfe7b3bfSKonstantin Belousov #include <sys/proc.h> 60dfe7b3bfSKonstantin Belousov #include <sys/systm.h> 61dfe7b3bfSKonstantin Belousov #include <sys/bus.h> 62dfe7b3bfSKonstantin Belousov #include <sys/cpu.h> 63dfe7b3bfSKonstantin Belousov #include <sys/kdb.h> 64dfe7b3bfSKonstantin Belousov #include <sys/kernel.h> 65dfe7b3bfSKonstantin Belousov #include <sys/ktr.h> 66dfe7b3bfSKonstantin Belousov #include <sys/lock.h> 67dfe7b3bfSKonstantin Belousov #include <sys/malloc.h> 68dfe7b3bfSKonstantin Belousov #include <sys/mutex.h> 69dfe7b3bfSKonstantin Belousov #include <sys/pcpu.h> 70dfe7b3bfSKonstantin Belousov #include <sys/rwlock.h> 71dfe7b3bfSKonstantin Belousov #include <sys/sched.h> 72dfe7b3bfSKonstantin Belousov #ifdef SMP 73dfe7b3bfSKonstantin Belousov #include <sys/smp.h> 74dfe7b3bfSKonstantin Belousov #endif 75dfe7b3bfSKonstantin Belousov #include <sys/sysctl.h> 76dfe7b3bfSKonstantin Belousov 77dfe7b3bfSKonstantin Belousov #include <machine/clock.h> 78dfe7b3bfSKonstantin Belousov #include <machine/cpu.h> 79dfe7b3bfSKonstantin Belousov #include <machine/cputypes.h> 80dfe7b3bfSKonstantin Belousov #include <machine/specialreg.h> 81dfe7b3bfSKonstantin Belousov #include <machine/md_var.h> 82dfe7b3bfSKonstantin Belousov #include <machine/mp_watchdog.h> 83dfe7b3bfSKonstantin Belousov #include <machine/tss.h> 84dfe7b3bfSKonstantin Belousov #ifdef SMP 85dfe7b3bfSKonstantin Belousov #include <machine/smp.h> 86dfe7b3bfSKonstantin Belousov #endif 873da25bdbSAndriy Gapon #ifdef CPU_ELAN 883da25bdbSAndriy Gapon #include <machine/elan_mmcr.h> 893da25bdbSAndriy Gapon #endif 90b57a73f8SKonstantin Belousov #include <x86/acpica_machdep.h> 91dfe7b3bfSKonstantin Belousov 92dfe7b3bfSKonstantin Belousov #include <vm/vm.h> 93dfe7b3bfSKonstantin Belousov #include <vm/vm_extern.h> 94dfe7b3bfSKonstantin Belousov #include <vm/vm_kern.h> 95dfe7b3bfSKonstantin Belousov #include <vm/vm_page.h> 96dfe7b3bfSKonstantin Belousov #include <vm/vm_map.h> 97dfe7b3bfSKonstantin Belousov #include <vm/vm_object.h> 98dfe7b3bfSKonstantin Belousov #include <vm/vm_pager.h> 99dfe7b3bfSKonstantin Belousov #include <vm/vm_param.h> 100dfe7b3bfSKonstantin Belousov 1018428d0f1SAndriy Gapon #include <isa/isareg.h> 1028428d0f1SAndriy Gapon 103d9e8bbb6SKonstantin Belousov #define STATE_RUNNING 0x0 104d9e8bbb6SKonstantin Belousov #define STATE_MWAIT 0x1 105d9e8bbb6SKonstantin Belousov #define STATE_SLEEPING 0x2 106d9e8bbb6SKonstantin Belousov 1078428d0f1SAndriy Gapon #ifdef SMP 1088428d0f1SAndriy Gapon static u_int cpu_reset_proxyid; 1098428d0f1SAndriy Gapon static volatile u_int cpu_reset_proxy_active; 1108428d0f1SAndriy Gapon #endif 1118428d0f1SAndriy Gapon 1128428d0f1SAndriy Gapon 113dfe7b3bfSKonstantin Belousov /* 114dfe7b3bfSKonstantin Belousov * Machine dependent boot() routine 115dfe7b3bfSKonstantin Belousov * 116dfe7b3bfSKonstantin Belousov * I haven't seen anything to put here yet 117dfe7b3bfSKonstantin Belousov * Possibly some stuff might be grafted back here from boot() 118dfe7b3bfSKonstantin Belousov */ 119dfe7b3bfSKonstantin Belousov void 120dfe7b3bfSKonstantin Belousov cpu_boot(int howto) 121dfe7b3bfSKonstantin Belousov { 122dfe7b3bfSKonstantin Belousov } 123dfe7b3bfSKonstantin Belousov 124dfe7b3bfSKonstantin Belousov /* 125dfe7b3bfSKonstantin Belousov * Flush the D-cache for non-DMA I/O so that the I-cache can 126dfe7b3bfSKonstantin Belousov * be made coherent later. 127dfe7b3bfSKonstantin Belousov */ 128dfe7b3bfSKonstantin Belousov void 129dfe7b3bfSKonstantin Belousov cpu_flush_dcache(void *ptr, size_t len) 130dfe7b3bfSKonstantin Belousov { 131dfe7b3bfSKonstantin Belousov /* Not applicable */ 132dfe7b3bfSKonstantin Belousov } 133dfe7b3bfSKonstantin Belousov 134b57a73f8SKonstantin Belousov void 135b57a73f8SKonstantin Belousov acpi_cpu_c1(void) 136b57a73f8SKonstantin Belousov { 137b57a73f8SKonstantin Belousov 138b57a73f8SKonstantin Belousov __asm __volatile("sti; hlt"); 139b57a73f8SKonstantin Belousov } 140b57a73f8SKonstantin Belousov 14119d4720bSJonathan T. Looney /* 14219d4720bSJonathan T. Looney * Use mwait to pause execution while waiting for an interrupt or 14319d4720bSJonathan T. Looney * another thread to signal that there is more work. 14419d4720bSJonathan T. Looney * 14519d4720bSJonathan T. Looney * NOTE: Interrupts will cause a wakeup; however, this function does 14619d4720bSJonathan T. Looney * not enable interrupt handling. The caller is responsible to enable 14719d4720bSJonathan T. Looney * interrupts. 14819d4720bSJonathan T. Looney */ 149b57a73f8SKonstantin Belousov void 150b57a73f8SKonstantin Belousov acpi_cpu_idle_mwait(uint32_t mwait_hint) 151b57a73f8SKonstantin Belousov { 152b57a73f8SKonstantin Belousov int *state; 153b57a73f8SKonstantin Belousov 154b57a73f8SKonstantin Belousov /* 155319117fdSKonstantin Belousov * A comment in Linux patch claims that 'CPUs run faster with 156319117fdSKonstantin Belousov * speculation protection disabled. All CPU threads in a core 157319117fdSKonstantin Belousov * must disable speculation protection for it to be 158319117fdSKonstantin Belousov * disabled. Disable it while we are idle so the other 159319117fdSKonstantin Belousov * hyperthread can run fast.' 160319117fdSKonstantin Belousov * 161b57a73f8SKonstantin Belousov * XXXKIB. Software coordination mode should be supported, 162b57a73f8SKonstantin Belousov * but all Intel CPUs provide hardware coordination. 163b57a73f8SKonstantin Belousov */ 164d9e8bbb6SKonstantin Belousov 165d9e8bbb6SKonstantin Belousov state = (int *)PCPU_PTR(monitorbuf); 166*a5bd21d0SKonstantin Belousov KASSERT(atomic_load_int(state) == STATE_SLEEPING, 167d9e8bbb6SKonstantin Belousov ("cpu_mwait_cx: wrong monitorbuf state")); 168*a5bd21d0SKonstantin Belousov atomic_store_int(state, STATE_MWAIT); 169319117fdSKonstantin Belousov handle_ibrs_entry(); 170b57a73f8SKonstantin Belousov cpu_monitor(state, 0, 0); 171*a5bd21d0SKonstantin Belousov if (atomic_load_int(state) == STATE_MWAIT) 172b57a73f8SKonstantin Belousov cpu_mwait(MWAIT_INTRBREAK, mwait_hint); 173319117fdSKonstantin Belousov handle_ibrs_exit(); 174d9e8bbb6SKonstantin Belousov 175d9e8bbb6SKonstantin Belousov /* 176d9e8bbb6SKonstantin Belousov * We should exit on any event that interrupts mwait, because 177d9e8bbb6SKonstantin Belousov * that event might be a wanted interrupt. 178d9e8bbb6SKonstantin Belousov */ 179*a5bd21d0SKonstantin Belousov atomic_store_int(state, STATE_RUNNING); 180b57a73f8SKonstantin Belousov } 181b57a73f8SKonstantin Belousov 182dfe7b3bfSKonstantin Belousov /* Get current clock frequency for the given cpu id. */ 183dfe7b3bfSKonstantin Belousov int 184dfe7b3bfSKonstantin Belousov cpu_est_clockrate(int cpu_id, uint64_t *rate) 185dfe7b3bfSKonstantin Belousov { 186dfe7b3bfSKonstantin Belousov uint64_t tsc1, tsc2; 187dfe7b3bfSKonstantin Belousov uint64_t acnt, mcnt, perf; 188dfe7b3bfSKonstantin Belousov register_t reg; 189dfe7b3bfSKonstantin Belousov 190dfe7b3bfSKonstantin Belousov if (pcpu_find(cpu_id) == NULL || rate == NULL) 191dfe7b3bfSKonstantin Belousov return (EINVAL); 192dfe7b3bfSKonstantin Belousov #ifdef __i386__ 193dfe7b3bfSKonstantin Belousov if ((cpu_feature & CPUID_TSC) == 0) 194dfe7b3bfSKonstantin Belousov return (EOPNOTSUPP); 195dfe7b3bfSKonstantin Belousov #endif 196dfe7b3bfSKonstantin Belousov 197dfe7b3bfSKonstantin Belousov /* 198dfe7b3bfSKonstantin Belousov * If TSC is P-state invariant and APERF/MPERF MSRs do not exist, 199dfe7b3bfSKonstantin Belousov * DELAY(9) based logic fails. 200dfe7b3bfSKonstantin Belousov */ 201dfe7b3bfSKonstantin Belousov if (tsc_is_invariant && !tsc_perf_stat) 202dfe7b3bfSKonstantin Belousov return (EOPNOTSUPP); 203dfe7b3bfSKonstantin Belousov 204dfe7b3bfSKonstantin Belousov #ifdef SMP 205dfe7b3bfSKonstantin Belousov if (smp_cpus > 1) { 206dfe7b3bfSKonstantin Belousov /* Schedule ourselves on the indicated cpu. */ 207dfe7b3bfSKonstantin Belousov thread_lock(curthread); 208dfe7b3bfSKonstantin Belousov sched_bind(curthread, cpu_id); 209dfe7b3bfSKonstantin Belousov thread_unlock(curthread); 210dfe7b3bfSKonstantin Belousov } 211dfe7b3bfSKonstantin Belousov #endif 212dfe7b3bfSKonstantin Belousov 213dfe7b3bfSKonstantin Belousov /* Calibrate by measuring a short delay. */ 214dfe7b3bfSKonstantin Belousov reg = intr_disable(); 215dfe7b3bfSKonstantin Belousov if (tsc_is_invariant) { 216dfe7b3bfSKonstantin Belousov wrmsr(MSR_MPERF, 0); 217dfe7b3bfSKonstantin Belousov wrmsr(MSR_APERF, 0); 218dfe7b3bfSKonstantin Belousov tsc1 = rdtsc(); 219dfe7b3bfSKonstantin Belousov DELAY(1000); 220dfe7b3bfSKonstantin Belousov mcnt = rdmsr(MSR_MPERF); 221dfe7b3bfSKonstantin Belousov acnt = rdmsr(MSR_APERF); 222dfe7b3bfSKonstantin Belousov tsc2 = rdtsc(); 223dfe7b3bfSKonstantin Belousov intr_restore(reg); 224dfe7b3bfSKonstantin Belousov perf = 1000 * acnt / mcnt; 225dfe7b3bfSKonstantin Belousov *rate = (tsc2 - tsc1) * perf; 226dfe7b3bfSKonstantin Belousov } else { 227dfe7b3bfSKonstantin Belousov tsc1 = rdtsc(); 228dfe7b3bfSKonstantin Belousov DELAY(1000); 229dfe7b3bfSKonstantin Belousov tsc2 = rdtsc(); 230dfe7b3bfSKonstantin Belousov intr_restore(reg); 231dfe7b3bfSKonstantin Belousov *rate = (tsc2 - tsc1) * 1000; 232dfe7b3bfSKonstantin Belousov } 233dfe7b3bfSKonstantin Belousov 234dfe7b3bfSKonstantin Belousov #ifdef SMP 235dfe7b3bfSKonstantin Belousov if (smp_cpus > 1) { 236dfe7b3bfSKonstantin Belousov thread_lock(curthread); 237dfe7b3bfSKonstantin Belousov sched_unbind(curthread); 238dfe7b3bfSKonstantin Belousov thread_unlock(curthread); 239dfe7b3bfSKonstantin Belousov } 240dfe7b3bfSKonstantin Belousov #endif 241dfe7b3bfSKonstantin Belousov 242dfe7b3bfSKonstantin Belousov return (0); 243dfe7b3bfSKonstantin Belousov } 244dfe7b3bfSKonstantin Belousov 245dfe7b3bfSKonstantin Belousov /* 246dfe7b3bfSKonstantin Belousov * Shutdown the CPU as much as possible 247dfe7b3bfSKonstantin Belousov */ 248dfe7b3bfSKonstantin Belousov void 249dfe7b3bfSKonstantin Belousov cpu_halt(void) 250dfe7b3bfSKonstantin Belousov { 251dfe7b3bfSKonstantin Belousov for (;;) 252dfe7b3bfSKonstantin Belousov halt(); 253dfe7b3bfSKonstantin Belousov } 254dfe7b3bfSKonstantin Belousov 2558428d0f1SAndriy Gapon static void 256b7b25af0SAndriy Gapon cpu_reset_real(void) 2578428d0f1SAndriy Gapon { 2588428d0f1SAndriy Gapon struct region_descriptor null_idt; 2598428d0f1SAndriy Gapon int b; 2608428d0f1SAndriy Gapon 2618428d0f1SAndriy Gapon disable_intr(); 2628428d0f1SAndriy Gapon #ifdef CPU_ELAN 2638428d0f1SAndriy Gapon if (elan_mmcr != NULL) 2648428d0f1SAndriy Gapon elan_mmcr->RESCFG = 1; 2658428d0f1SAndriy Gapon #endif 2668428d0f1SAndriy Gapon #ifdef __i386__ 2678428d0f1SAndriy Gapon if (cpu == CPU_GEODE1100) { 2688428d0f1SAndriy Gapon /* Attempt Geode's own reset */ 2698428d0f1SAndriy Gapon outl(0xcf8, 0x80009044ul); 2708428d0f1SAndriy Gapon outl(0xcfc, 0xf); 2718428d0f1SAndriy Gapon } 2728428d0f1SAndriy Gapon #endif 2738428d0f1SAndriy Gapon #if !defined(BROKEN_KEYBOARD_RESET) 2748428d0f1SAndriy Gapon /* 2758428d0f1SAndriy Gapon * Attempt to do a CPU reset via the keyboard controller, 2768428d0f1SAndriy Gapon * do not turn off GateA20, as any machine that fails 2778428d0f1SAndriy Gapon * to do the reset here would then end up in no man's land. 2788428d0f1SAndriy Gapon */ 2798428d0f1SAndriy Gapon outb(IO_KBD + 4, 0xFE); 2808428d0f1SAndriy Gapon DELAY(500000); /* wait 0.5 sec to see if that did it */ 2818428d0f1SAndriy Gapon #endif 2828428d0f1SAndriy Gapon 2838428d0f1SAndriy Gapon /* 2848428d0f1SAndriy Gapon * Attempt to force a reset via the Reset Control register at 2858428d0f1SAndriy Gapon * I/O port 0xcf9. Bit 2 forces a system reset when it 2868428d0f1SAndriy Gapon * transitions from 0 to 1. Bit 1 selects the type of reset 2878428d0f1SAndriy Gapon * to attempt: 0 selects a "soft" reset, and 1 selects a 2888428d0f1SAndriy Gapon * "hard" reset. We try a "hard" reset. The first write sets 2898428d0f1SAndriy Gapon * bit 1 to select a "hard" reset and clears bit 2. The 2908428d0f1SAndriy Gapon * second write forces a 0 -> 1 transition in bit 2 to trigger 2918428d0f1SAndriy Gapon * a reset. 2928428d0f1SAndriy Gapon */ 2938428d0f1SAndriy Gapon outb(0xcf9, 0x2); 2948428d0f1SAndriy Gapon outb(0xcf9, 0x6); 2958428d0f1SAndriy Gapon DELAY(500000); /* wait 0.5 sec to see if that did it */ 2968428d0f1SAndriy Gapon 2978428d0f1SAndriy Gapon /* 2988428d0f1SAndriy Gapon * Attempt to force a reset via the Fast A20 and Init register 2998428d0f1SAndriy Gapon * at I/O port 0x92. Bit 1 serves as an alternate A20 gate. 3008428d0f1SAndriy Gapon * Bit 0 asserts INIT# when set to 1. We are careful to only 3018428d0f1SAndriy Gapon * preserve bit 1 while setting bit 0. We also must clear bit 3028428d0f1SAndriy Gapon * 0 before setting it if it isn't already clear. 3038428d0f1SAndriy Gapon */ 3048428d0f1SAndriy Gapon b = inb(0x92); 3058428d0f1SAndriy Gapon if (b != 0xff) { 3068428d0f1SAndriy Gapon if ((b & 0x1) != 0) 3078428d0f1SAndriy Gapon outb(0x92, b & 0xfe); 3088428d0f1SAndriy Gapon outb(0x92, b | 0x1); 3098428d0f1SAndriy Gapon DELAY(500000); /* wait 0.5 sec to see if that did it */ 3108428d0f1SAndriy Gapon } 3118428d0f1SAndriy Gapon 3128428d0f1SAndriy Gapon printf("No known reset method worked, attempting CPU shutdown\n"); 3138428d0f1SAndriy Gapon DELAY(1000000); /* wait 1 sec for printf to complete */ 3148428d0f1SAndriy Gapon 3158428d0f1SAndriy Gapon /* Wipe the IDT. */ 3168428d0f1SAndriy Gapon null_idt.rd_limit = 0; 3178428d0f1SAndriy Gapon null_idt.rd_base = 0; 3188428d0f1SAndriy Gapon lidt(&null_idt); 3198428d0f1SAndriy Gapon 3208428d0f1SAndriy Gapon /* "good night, sweet prince .... <THUNK!>" */ 3218428d0f1SAndriy Gapon breakpoint(); 3228428d0f1SAndriy Gapon 3238428d0f1SAndriy Gapon /* NOTREACHED */ 3248428d0f1SAndriy Gapon while(1); 3258428d0f1SAndriy Gapon } 3268428d0f1SAndriy Gapon 3278428d0f1SAndriy Gapon #ifdef SMP 3288428d0f1SAndriy Gapon static void 329b7b25af0SAndriy Gapon cpu_reset_proxy(void) 3308428d0f1SAndriy Gapon { 3318428d0f1SAndriy Gapon 3328428d0f1SAndriy Gapon cpu_reset_proxy_active = 1; 3338428d0f1SAndriy Gapon while (cpu_reset_proxy_active == 1) 3348428d0f1SAndriy Gapon ia32_pause(); /* Wait for other cpu to see that we've started */ 3358428d0f1SAndriy Gapon 3368428d0f1SAndriy Gapon printf("cpu_reset_proxy: Stopped CPU %d\n", cpu_reset_proxyid); 3378428d0f1SAndriy Gapon DELAY(1000000); 3388428d0f1SAndriy Gapon cpu_reset_real(); 3398428d0f1SAndriy Gapon } 3408428d0f1SAndriy Gapon #endif 3418428d0f1SAndriy Gapon 3428428d0f1SAndriy Gapon void 343b7b25af0SAndriy Gapon cpu_reset(void) 3448428d0f1SAndriy Gapon { 3458428d0f1SAndriy Gapon #ifdef SMP 3468428d0f1SAndriy Gapon cpuset_t map; 3478428d0f1SAndriy Gapon u_int cnt; 3488428d0f1SAndriy Gapon 3498428d0f1SAndriy Gapon if (smp_started) { 3508428d0f1SAndriy Gapon map = all_cpus; 3518428d0f1SAndriy Gapon CPU_CLR(PCPU_GET(cpuid), &map); 3528428d0f1SAndriy Gapon CPU_NAND(&map, &stopped_cpus); 3538428d0f1SAndriy Gapon if (!CPU_EMPTY(&map)) { 3548428d0f1SAndriy Gapon printf("cpu_reset: Stopping other CPUs\n"); 3558428d0f1SAndriy Gapon stop_cpus(map); 3568428d0f1SAndriy Gapon } 3578428d0f1SAndriy Gapon 3588428d0f1SAndriy Gapon if (PCPU_GET(cpuid) != 0) { 3598428d0f1SAndriy Gapon cpu_reset_proxyid = PCPU_GET(cpuid); 3608428d0f1SAndriy Gapon cpustop_restartfunc = cpu_reset_proxy; 3618428d0f1SAndriy Gapon cpu_reset_proxy_active = 0; 3628428d0f1SAndriy Gapon printf("cpu_reset: Restarting BSP\n"); 3638428d0f1SAndriy Gapon 3648428d0f1SAndriy Gapon /* Restart CPU #0. */ 3658428d0f1SAndriy Gapon CPU_SETOF(0, &started_cpus); 3668428d0f1SAndriy Gapon wmb(); 3678428d0f1SAndriy Gapon 3688428d0f1SAndriy Gapon cnt = 0; 3698428d0f1SAndriy Gapon while (cpu_reset_proxy_active == 0 && cnt < 10000000) { 3708428d0f1SAndriy Gapon ia32_pause(); 3718428d0f1SAndriy Gapon cnt++; /* Wait for BSP to announce restart */ 3728428d0f1SAndriy Gapon } 3738428d0f1SAndriy Gapon if (cpu_reset_proxy_active == 0) { 3748428d0f1SAndriy Gapon printf("cpu_reset: Failed to restart BSP\n"); 3758428d0f1SAndriy Gapon } else { 3768428d0f1SAndriy Gapon cpu_reset_proxy_active = 2; 3778428d0f1SAndriy Gapon while (1) 3788428d0f1SAndriy Gapon ia32_pause(); 3798428d0f1SAndriy Gapon /* NOTREACHED */ 3808428d0f1SAndriy Gapon } 3818428d0f1SAndriy Gapon } 3828428d0f1SAndriy Gapon 3838428d0f1SAndriy Gapon DELAY(1000000); 3848428d0f1SAndriy Gapon } 3858428d0f1SAndriy Gapon #endif 3868428d0f1SAndriy Gapon cpu_reset_real(); 3878428d0f1SAndriy Gapon /* NOTREACHED */ 3888428d0f1SAndriy Gapon } 3898428d0f1SAndriy Gapon 390b57a73f8SKonstantin Belousov bool 391b57a73f8SKonstantin Belousov cpu_mwait_usable(void) 392b57a73f8SKonstantin Belousov { 393b57a73f8SKonstantin Belousov 394b57a73f8SKonstantin Belousov return ((cpu_feature2 & CPUID2_MON) != 0 && ((cpu_mon_mwait_flags & 395b57a73f8SKonstantin Belousov (CPUID5_MON_MWAIT_EXT | CPUID5_MWAIT_INTRBREAK)) == 396b57a73f8SKonstantin Belousov (CPUID5_MON_MWAIT_EXT | CPUID5_MWAIT_INTRBREAK))); 397b57a73f8SKonstantin Belousov } 398b57a73f8SKonstantin Belousov 399dfe7b3bfSKonstantin Belousov void (*cpu_idle_hook)(sbintime_t) = NULL; /* ACPI idle hook. */ 400dfe7b3bfSKonstantin Belousov static int cpu_ident_amdc1e = 0; /* AMD C1E supported. */ 401dfe7b3bfSKonstantin Belousov static int idle_mwait = 1; /* Use MONITOR/MWAIT for short idle. */ 402dfe7b3bfSKonstantin Belousov SYSCTL_INT(_machdep, OID_AUTO, idle_mwait, CTLFLAG_RWTUN, &idle_mwait, 403dfe7b3bfSKonstantin Belousov 0, "Use MONITOR/MWAIT for short idle"); 404dfe7b3bfSKonstantin Belousov 405dfe7b3bfSKonstantin Belousov static void 406dfe7b3bfSKonstantin Belousov cpu_idle_acpi(sbintime_t sbt) 407dfe7b3bfSKonstantin Belousov { 408dfe7b3bfSKonstantin Belousov int *state; 409dfe7b3bfSKonstantin Belousov 410dfe7b3bfSKonstantin Belousov state = (int *)PCPU_PTR(monitorbuf); 411*a5bd21d0SKonstantin Belousov atomic_store_int(state, STATE_SLEEPING); 412dfe7b3bfSKonstantin Belousov 413dfe7b3bfSKonstantin Belousov /* See comments in cpu_idle_hlt(). */ 414dfe7b3bfSKonstantin Belousov disable_intr(); 415dfe7b3bfSKonstantin Belousov if (sched_runnable()) 416dfe7b3bfSKonstantin Belousov enable_intr(); 417dfe7b3bfSKonstantin Belousov else if (cpu_idle_hook) 418dfe7b3bfSKonstantin Belousov cpu_idle_hook(sbt); 419dfe7b3bfSKonstantin Belousov else 420b57a73f8SKonstantin Belousov acpi_cpu_c1(); 421*a5bd21d0SKonstantin Belousov atomic_store_int(state, STATE_RUNNING); 422dfe7b3bfSKonstantin Belousov } 423dfe7b3bfSKonstantin Belousov 424dfe7b3bfSKonstantin Belousov static void 425dfe7b3bfSKonstantin Belousov cpu_idle_hlt(sbintime_t sbt) 426dfe7b3bfSKonstantin Belousov { 427dfe7b3bfSKonstantin Belousov int *state; 428dfe7b3bfSKonstantin Belousov 429dfe7b3bfSKonstantin Belousov state = (int *)PCPU_PTR(monitorbuf); 430*a5bd21d0SKonstantin Belousov atomic_store_int(state, STATE_SLEEPING); 431dfe7b3bfSKonstantin Belousov 432dfe7b3bfSKonstantin Belousov /* 433dfe7b3bfSKonstantin Belousov * Since we may be in a critical section from cpu_idle(), if 434dfe7b3bfSKonstantin Belousov * an interrupt fires during that critical section we may have 435dfe7b3bfSKonstantin Belousov * a pending preemption. If the CPU halts, then that thread 436dfe7b3bfSKonstantin Belousov * may not execute until a later interrupt awakens the CPU. 437dfe7b3bfSKonstantin Belousov * To handle this race, check for a runnable thread after 438dfe7b3bfSKonstantin Belousov * disabling interrupts and immediately return if one is 439dfe7b3bfSKonstantin Belousov * found. Also, we must absolutely guarentee that hlt is 440dfe7b3bfSKonstantin Belousov * the next instruction after sti. This ensures that any 441dfe7b3bfSKonstantin Belousov * interrupt that fires after the call to disable_intr() will 442dfe7b3bfSKonstantin Belousov * immediately awaken the CPU from hlt. Finally, please note 443dfe7b3bfSKonstantin Belousov * that on x86 this works fine because of interrupts enabled only 444dfe7b3bfSKonstantin Belousov * after the instruction following sti takes place, while IF is set 445dfe7b3bfSKonstantin Belousov * to 1 immediately, allowing hlt instruction to acknowledge the 446dfe7b3bfSKonstantin Belousov * interrupt. 447dfe7b3bfSKonstantin Belousov */ 448dfe7b3bfSKonstantin Belousov disable_intr(); 449dfe7b3bfSKonstantin Belousov if (sched_runnable()) 450dfe7b3bfSKonstantin Belousov enable_intr(); 451dfe7b3bfSKonstantin Belousov else 452b57a73f8SKonstantin Belousov acpi_cpu_c1(); 453*a5bd21d0SKonstantin Belousov atomic_store_int(state, STATE_RUNNING); 454dfe7b3bfSKonstantin Belousov } 455dfe7b3bfSKonstantin Belousov 456dfe7b3bfSKonstantin Belousov static void 457dfe7b3bfSKonstantin Belousov cpu_idle_mwait(sbintime_t sbt) 458dfe7b3bfSKonstantin Belousov { 459dfe7b3bfSKonstantin Belousov int *state; 460dfe7b3bfSKonstantin Belousov 461dfe7b3bfSKonstantin Belousov state = (int *)PCPU_PTR(monitorbuf); 462*a5bd21d0SKonstantin Belousov atomic_store_int(state, STATE_MWAIT); 463dfe7b3bfSKonstantin Belousov 464dfe7b3bfSKonstantin Belousov /* See comments in cpu_idle_hlt(). */ 465dfe7b3bfSKonstantin Belousov disable_intr(); 466dfe7b3bfSKonstantin Belousov if (sched_runnable()) { 467*a5bd21d0SKonstantin Belousov atomic_store_int(state, STATE_RUNNING); 468dfe7b3bfSKonstantin Belousov enable_intr(); 469dfe7b3bfSKonstantin Belousov return; 470dfe7b3bfSKonstantin Belousov } 471*a5bd21d0SKonstantin Belousov 472dfe7b3bfSKonstantin Belousov cpu_monitor(state, 0, 0); 473*a5bd21d0SKonstantin Belousov if (atomic_load_int(state) == STATE_MWAIT) 474dfe7b3bfSKonstantin Belousov __asm __volatile("sti; mwait" : : "a" (MWAIT_C1), "c" (0)); 475dfe7b3bfSKonstantin Belousov else 476dfe7b3bfSKonstantin Belousov enable_intr(); 477*a5bd21d0SKonstantin Belousov atomic_store_int(state, STATE_RUNNING); 478dfe7b3bfSKonstantin Belousov } 479dfe7b3bfSKonstantin Belousov 480dfe7b3bfSKonstantin Belousov static void 481dfe7b3bfSKonstantin Belousov cpu_idle_spin(sbintime_t sbt) 482dfe7b3bfSKonstantin Belousov { 483dfe7b3bfSKonstantin Belousov int *state; 484dfe7b3bfSKonstantin Belousov int i; 485dfe7b3bfSKonstantin Belousov 486dfe7b3bfSKonstantin Belousov state = (int *)PCPU_PTR(monitorbuf); 487*a5bd21d0SKonstantin Belousov atomic_store_int(state, STATE_RUNNING); 488dfe7b3bfSKonstantin Belousov 489dfe7b3bfSKonstantin Belousov /* 490dfe7b3bfSKonstantin Belousov * The sched_runnable() call is racy but as long as there is 491dfe7b3bfSKonstantin Belousov * a loop missing it one time will have just a little impact if any 492dfe7b3bfSKonstantin Belousov * (and it is much better than missing the check at all). 493dfe7b3bfSKonstantin Belousov */ 494dfe7b3bfSKonstantin Belousov for (i = 0; i < 1000; i++) { 495dfe7b3bfSKonstantin Belousov if (sched_runnable()) 496dfe7b3bfSKonstantin Belousov return; 497dfe7b3bfSKonstantin Belousov cpu_spinwait(); 498dfe7b3bfSKonstantin Belousov } 499dfe7b3bfSKonstantin Belousov } 500dfe7b3bfSKonstantin Belousov 501dfe7b3bfSKonstantin Belousov /* 502dfe7b3bfSKonstantin Belousov * C1E renders the local APIC timer dead, so we disable it by 503dfe7b3bfSKonstantin Belousov * reading the Interrupt Pending Message register and clearing 504dfe7b3bfSKonstantin Belousov * both C1eOnCmpHalt (bit 28) and SmiOnCmpHalt (bit 27). 505dfe7b3bfSKonstantin Belousov * 506dfe7b3bfSKonstantin Belousov * Reference: 507dfe7b3bfSKonstantin Belousov * "BIOS and Kernel Developer's Guide for AMD NPT Family 0Fh Processors" 508dfe7b3bfSKonstantin Belousov * #32559 revision 3.00+ 509dfe7b3bfSKonstantin Belousov */ 510dfe7b3bfSKonstantin Belousov #define MSR_AMDK8_IPM 0xc0010055 511dfe7b3bfSKonstantin Belousov #define AMDK8_SMIONCMPHALT (1ULL << 27) 512dfe7b3bfSKonstantin Belousov #define AMDK8_C1EONCMPHALT (1ULL << 28) 513dfe7b3bfSKonstantin Belousov #define AMDK8_CMPHALT (AMDK8_SMIONCMPHALT | AMDK8_C1EONCMPHALT) 514dfe7b3bfSKonstantin Belousov 515dfe7b3bfSKonstantin Belousov void 516dfe7b3bfSKonstantin Belousov cpu_probe_amdc1e(void) 517dfe7b3bfSKonstantin Belousov { 518dfe7b3bfSKonstantin Belousov 519dfe7b3bfSKonstantin Belousov /* 520dfe7b3bfSKonstantin Belousov * Detect the presence of C1E capability mostly on latest 521dfe7b3bfSKonstantin Belousov * dual-cores (or future) k8 family. 522dfe7b3bfSKonstantin Belousov */ 523dfe7b3bfSKonstantin Belousov if (cpu_vendor_id == CPU_VENDOR_AMD && 524dfe7b3bfSKonstantin Belousov (cpu_id & 0x00000f00) == 0x00000f00 && 525dfe7b3bfSKonstantin Belousov (cpu_id & 0x0fff0000) >= 0x00040000) { 526dfe7b3bfSKonstantin Belousov cpu_ident_amdc1e = 1; 527dfe7b3bfSKonstantin Belousov } 528dfe7b3bfSKonstantin Belousov } 529dfe7b3bfSKonstantin Belousov 530dfe7b3bfSKonstantin Belousov void (*cpu_idle_fn)(sbintime_t) = cpu_idle_acpi; 531dfe7b3bfSKonstantin Belousov 532dfe7b3bfSKonstantin Belousov void 533dfe7b3bfSKonstantin Belousov cpu_idle(int busy) 534dfe7b3bfSKonstantin Belousov { 535dfe7b3bfSKonstantin Belousov uint64_t msr; 536dfe7b3bfSKonstantin Belousov sbintime_t sbt = -1; 537dfe7b3bfSKonstantin Belousov 538dfe7b3bfSKonstantin Belousov CTR2(KTR_SPARE2, "cpu_idle(%d) at %d", 539dfe7b3bfSKonstantin Belousov busy, curcpu); 540ed95805eSJohn Baldwin #ifdef MP_WATCHDOG 541dfe7b3bfSKonstantin Belousov ap_watchdog(PCPU_GET(cpuid)); 542dfe7b3bfSKonstantin Belousov #endif 543ed95805eSJohn Baldwin 544dfe7b3bfSKonstantin Belousov /* If we are busy - try to use fast methods. */ 545dfe7b3bfSKonstantin Belousov if (busy) { 546dfe7b3bfSKonstantin Belousov if ((cpu_feature2 & CPUID2_MON) && idle_mwait) { 547dfe7b3bfSKonstantin Belousov cpu_idle_mwait(busy); 548dfe7b3bfSKonstantin Belousov goto out; 549dfe7b3bfSKonstantin Belousov } 550dfe7b3bfSKonstantin Belousov } 551dfe7b3bfSKonstantin Belousov 552dfe7b3bfSKonstantin Belousov /* If we have time - switch timers into idle mode. */ 553dfe7b3bfSKonstantin Belousov if (!busy) { 554dfe7b3bfSKonstantin Belousov critical_enter(); 555dfe7b3bfSKonstantin Belousov sbt = cpu_idleclock(); 556dfe7b3bfSKonstantin Belousov } 557dfe7b3bfSKonstantin Belousov 558dfe7b3bfSKonstantin Belousov /* Apply AMD APIC timer C1E workaround. */ 559dfe7b3bfSKonstantin Belousov if (cpu_ident_amdc1e && cpu_disable_c3_sleep) { 560dfe7b3bfSKonstantin Belousov msr = rdmsr(MSR_AMDK8_IPM); 561dfe7b3bfSKonstantin Belousov if (msr & AMDK8_CMPHALT) 562dfe7b3bfSKonstantin Belousov wrmsr(MSR_AMDK8_IPM, msr & ~AMDK8_CMPHALT); 563dfe7b3bfSKonstantin Belousov } 564dfe7b3bfSKonstantin Belousov 565dfe7b3bfSKonstantin Belousov /* Call main idle method. */ 566dfe7b3bfSKonstantin Belousov cpu_idle_fn(sbt); 567dfe7b3bfSKonstantin Belousov 568dfe7b3bfSKonstantin Belousov /* Switch timers back into active mode. */ 569dfe7b3bfSKonstantin Belousov if (!busy) { 570dfe7b3bfSKonstantin Belousov cpu_activeclock(); 571dfe7b3bfSKonstantin Belousov critical_exit(); 572dfe7b3bfSKonstantin Belousov } 573dfe7b3bfSKonstantin Belousov out: 574dfe7b3bfSKonstantin Belousov CTR2(KTR_SPARE2, "cpu_idle(%d) at %d done", 575dfe7b3bfSKonstantin Belousov busy, curcpu); 576dfe7b3bfSKonstantin Belousov } 577dfe7b3bfSKonstantin Belousov 578dfe7b3bfSKonstantin Belousov int 579dfe7b3bfSKonstantin Belousov cpu_idle_wakeup(int cpu) 580dfe7b3bfSKonstantin Belousov { 581dfe7b3bfSKonstantin Belousov int *state; 582dfe7b3bfSKonstantin Belousov 583*a5bd21d0SKonstantin Belousov state = (int *)pcpu_find(cpu)->pc_monitorbuf; 584*a5bd21d0SKonstantin Belousov switch (atomic_load_int(state)) { 585*a5bd21d0SKonstantin Belousov case STATE_SLEEPING: 586dfe7b3bfSKonstantin Belousov return (0); 587*a5bd21d0SKonstantin Belousov case STATE_MWAIT: 588*a5bd21d0SKonstantin Belousov atomic_store_int(state, STATE_RUNNING); 589dfe7b3bfSKonstantin Belousov return (1); 590*a5bd21d0SKonstantin Belousov case STATE_RUNNING: 591*a5bd21d0SKonstantin Belousov return (1); 592*a5bd21d0SKonstantin Belousov default: 593*a5bd21d0SKonstantin Belousov panic("bad monitor state"); 594*a5bd21d0SKonstantin Belousov return (1); 595*a5bd21d0SKonstantin Belousov } 596dfe7b3bfSKonstantin Belousov } 597dfe7b3bfSKonstantin Belousov 598dfe7b3bfSKonstantin Belousov /* 599dfe7b3bfSKonstantin Belousov * Ordered by speed/power consumption. 600dfe7b3bfSKonstantin Belousov */ 601dfe7b3bfSKonstantin Belousov struct { 602dfe7b3bfSKonstantin Belousov void *id_fn; 603dfe7b3bfSKonstantin Belousov char *id_name; 604dfe7b3bfSKonstantin Belousov } idle_tbl[] = { 605dfe7b3bfSKonstantin Belousov { cpu_idle_spin, "spin" }, 606dfe7b3bfSKonstantin Belousov { cpu_idle_mwait, "mwait" }, 607dfe7b3bfSKonstantin Belousov { cpu_idle_hlt, "hlt" }, 608dfe7b3bfSKonstantin Belousov { cpu_idle_acpi, "acpi" }, 609dfe7b3bfSKonstantin Belousov { NULL, NULL } 610dfe7b3bfSKonstantin Belousov }; 611dfe7b3bfSKonstantin Belousov 612dfe7b3bfSKonstantin Belousov static int 613dfe7b3bfSKonstantin Belousov idle_sysctl_available(SYSCTL_HANDLER_ARGS) 614dfe7b3bfSKonstantin Belousov { 615dfe7b3bfSKonstantin Belousov char *avail, *p; 616dfe7b3bfSKonstantin Belousov int error; 617dfe7b3bfSKonstantin Belousov int i; 618dfe7b3bfSKonstantin Belousov 619dfe7b3bfSKonstantin Belousov avail = malloc(256, M_TEMP, M_WAITOK); 620dfe7b3bfSKonstantin Belousov p = avail; 621dfe7b3bfSKonstantin Belousov for (i = 0; idle_tbl[i].id_name != NULL; i++) { 622dfe7b3bfSKonstantin Belousov if (strstr(idle_tbl[i].id_name, "mwait") && 623dfe7b3bfSKonstantin Belousov (cpu_feature2 & CPUID2_MON) == 0) 624dfe7b3bfSKonstantin Belousov continue; 625dfe7b3bfSKonstantin Belousov if (strcmp(idle_tbl[i].id_name, "acpi") == 0 && 626dfe7b3bfSKonstantin Belousov cpu_idle_hook == NULL) 627dfe7b3bfSKonstantin Belousov continue; 628dfe7b3bfSKonstantin Belousov p += sprintf(p, "%s%s", p != avail ? ", " : "", 629dfe7b3bfSKonstantin Belousov idle_tbl[i].id_name); 630dfe7b3bfSKonstantin Belousov } 631dfe7b3bfSKonstantin Belousov error = sysctl_handle_string(oidp, avail, 0, req); 632dfe7b3bfSKonstantin Belousov free(avail, M_TEMP); 633dfe7b3bfSKonstantin Belousov return (error); 634dfe7b3bfSKonstantin Belousov } 635dfe7b3bfSKonstantin Belousov 636dfe7b3bfSKonstantin Belousov SYSCTL_PROC(_machdep, OID_AUTO, idle_available, CTLTYPE_STRING | CTLFLAG_RD, 637dfe7b3bfSKonstantin Belousov 0, 0, idle_sysctl_available, "A", "list of available idle functions"); 638dfe7b3bfSKonstantin Belousov 639dfe7b3bfSKonstantin Belousov static int 640dfe7b3bfSKonstantin Belousov idle_sysctl(SYSCTL_HANDLER_ARGS) 641dfe7b3bfSKonstantin Belousov { 642dfe7b3bfSKonstantin Belousov char buf[16]; 643dfe7b3bfSKonstantin Belousov int error; 644dfe7b3bfSKonstantin Belousov char *p; 645dfe7b3bfSKonstantin Belousov int i; 646dfe7b3bfSKonstantin Belousov 647dfe7b3bfSKonstantin Belousov p = "unknown"; 648dfe7b3bfSKonstantin Belousov for (i = 0; idle_tbl[i].id_name != NULL; i++) { 649dfe7b3bfSKonstantin Belousov if (idle_tbl[i].id_fn == cpu_idle_fn) { 650dfe7b3bfSKonstantin Belousov p = idle_tbl[i].id_name; 651dfe7b3bfSKonstantin Belousov break; 652dfe7b3bfSKonstantin Belousov } 653dfe7b3bfSKonstantin Belousov } 654dfe7b3bfSKonstantin Belousov strncpy(buf, p, sizeof(buf)); 655dfe7b3bfSKonstantin Belousov error = sysctl_handle_string(oidp, buf, sizeof(buf), req); 656dfe7b3bfSKonstantin Belousov if (error != 0 || req->newptr == NULL) 657dfe7b3bfSKonstantin Belousov return (error); 658dfe7b3bfSKonstantin Belousov for (i = 0; idle_tbl[i].id_name != NULL; i++) { 659dfe7b3bfSKonstantin Belousov if (strstr(idle_tbl[i].id_name, "mwait") && 660dfe7b3bfSKonstantin Belousov (cpu_feature2 & CPUID2_MON) == 0) 661dfe7b3bfSKonstantin Belousov continue; 662dfe7b3bfSKonstantin Belousov if (strcmp(idle_tbl[i].id_name, "acpi") == 0 && 663dfe7b3bfSKonstantin Belousov cpu_idle_hook == NULL) 664dfe7b3bfSKonstantin Belousov continue; 665dfe7b3bfSKonstantin Belousov if (strcmp(idle_tbl[i].id_name, buf)) 666dfe7b3bfSKonstantin Belousov continue; 667dfe7b3bfSKonstantin Belousov cpu_idle_fn = idle_tbl[i].id_fn; 668dfe7b3bfSKonstantin Belousov return (0); 669dfe7b3bfSKonstantin Belousov } 670dfe7b3bfSKonstantin Belousov return (EINVAL); 671dfe7b3bfSKonstantin Belousov } 672dfe7b3bfSKonstantin Belousov 673dfe7b3bfSKonstantin Belousov SYSCTL_PROC(_machdep, OID_AUTO, idle, CTLTYPE_STRING | CTLFLAG_RW, 0, 0, 674dfe7b3bfSKonstantin Belousov idle_sysctl, "A", "currently selected idle function"); 675835c2787SKonstantin Belousov 676295f4b6cSKonstantin Belousov static int panic_on_nmi = 1; 677295f4b6cSKonstantin Belousov SYSCTL_INT(_machdep, OID_AUTO, panic_on_nmi, CTLFLAG_RWTUN, 678295f4b6cSKonstantin Belousov &panic_on_nmi, 0, 679295f4b6cSKonstantin Belousov "Panic on NMI"); 680835c2787SKonstantin Belousov int nmi_is_broadcast = 1; 681835c2787SKonstantin Belousov SYSCTL_INT(_machdep, OID_AUTO, nmi_is_broadcast, CTLFLAG_RWTUN, 682835c2787SKonstantin Belousov &nmi_is_broadcast, 0, 683835c2787SKonstantin Belousov "Chipset NMI is broadcast"); 684835c2787SKonstantin Belousov #ifdef KDB 685835c2787SKonstantin Belousov int kdb_on_nmi = 1; 686835c2787SKonstantin Belousov SYSCTL_INT(_machdep, OID_AUTO, kdb_on_nmi, CTLFLAG_RWTUN, 687835c2787SKonstantin Belousov &kdb_on_nmi, 0, 688835c2787SKonstantin Belousov "Go to KDB on NMI"); 689835c2787SKonstantin Belousov #endif 690835c2787SKonstantin Belousov 691835c2787SKonstantin Belousov #ifdef DEV_ISA 692295f4b6cSKonstantin Belousov void 693295f4b6cSKonstantin Belousov nmi_call_kdb(u_int cpu, u_int type, struct trapframe *frame) 694835c2787SKonstantin Belousov { 695835c2787SKonstantin Belousov 696835c2787SKonstantin Belousov /* machine/parity/power fail/"kitchen sink" faults */ 697835c2787SKonstantin Belousov if (isa_nmi(frame->tf_err) == 0) { 698835c2787SKonstantin Belousov #ifdef KDB 699835c2787SKonstantin Belousov /* 700835c2787SKonstantin Belousov * NMI can be hooked up to a pushbutton for debugging. 701835c2787SKonstantin Belousov */ 702835c2787SKonstantin Belousov if (kdb_on_nmi) { 703835c2787SKonstantin Belousov printf("NMI/cpu%d ... going to debugger\n", cpu); 704835c2787SKonstantin Belousov kdb_trap(type, 0, frame); 705835c2787SKonstantin Belousov } 706835c2787SKonstantin Belousov #endif /* KDB */ 707295f4b6cSKonstantin Belousov } else if (panic_on_nmi) { 708835c2787SKonstantin Belousov panic("NMI indicates hardware failure"); 709295f4b6cSKonstantin Belousov } 710835c2787SKonstantin Belousov } 711835c2787SKonstantin Belousov #endif 712835c2787SKonstantin Belousov 713295f4b6cSKonstantin Belousov void 714295f4b6cSKonstantin Belousov nmi_handle_intr(u_int type, struct trapframe *frame) 715835c2787SKonstantin Belousov { 716835c2787SKonstantin Belousov 717835c2787SKonstantin Belousov #ifdef DEV_ISA 718835c2787SKonstantin Belousov #ifdef SMP 719295f4b6cSKonstantin Belousov if (nmi_is_broadcast) { 720295f4b6cSKonstantin Belousov nmi_call_kdb_smp(type, frame); 721295f4b6cSKonstantin Belousov return; 722295f4b6cSKonstantin Belousov } 723835c2787SKonstantin Belousov #endif 7241d6dfd12SKonstantin Belousov nmi_call_kdb(PCPU_GET(cpuid), type, frame); 725835c2787SKonstantin Belousov #endif 726835c2787SKonstantin Belousov } 727319117fdSKonstantin Belousov 728319117fdSKonstantin Belousov int hw_ibrs_active; 729319117fdSKonstantin Belousov int hw_ibrs_disable = 1; 730319117fdSKonstantin Belousov 731319117fdSKonstantin Belousov SYSCTL_INT(_hw, OID_AUTO, ibrs_active, CTLFLAG_RD, &hw_ibrs_active, 0, 732b31b965eSKonstantin Belousov "Indirect Branch Restricted Speculation active"); 733319117fdSKonstantin Belousov 734319117fdSKonstantin Belousov void 735319117fdSKonstantin Belousov hw_ibrs_recalculate(void) 736319117fdSKonstantin Belousov { 737319117fdSKonstantin Belousov uint64_t v; 738319117fdSKonstantin Belousov 739319117fdSKonstantin Belousov if ((cpu_ia32_arch_caps & IA32_ARCH_CAP_IBRS_ALL) != 0) { 740319117fdSKonstantin Belousov if (hw_ibrs_disable) { 741319117fdSKonstantin Belousov v= rdmsr(MSR_IA32_SPEC_CTRL); 742c688c905SKonstantin Belousov v &= ~(uint64_t)IA32_SPEC_CTRL_IBRS; 743319117fdSKonstantin Belousov wrmsr(MSR_IA32_SPEC_CTRL, v); 744319117fdSKonstantin Belousov } else { 745319117fdSKonstantin Belousov v= rdmsr(MSR_IA32_SPEC_CTRL); 746319117fdSKonstantin Belousov v |= IA32_SPEC_CTRL_IBRS; 747319117fdSKonstantin Belousov wrmsr(MSR_IA32_SPEC_CTRL, v); 748319117fdSKonstantin Belousov } 749319117fdSKonstantin Belousov return; 750319117fdSKonstantin Belousov } 751319117fdSKonstantin Belousov hw_ibrs_active = (cpu_stdext_feature3 & CPUID_STDEXT3_IBPB) != 0 && 752319117fdSKonstantin Belousov !hw_ibrs_disable; 753319117fdSKonstantin Belousov } 754319117fdSKonstantin Belousov 755319117fdSKonstantin Belousov static int 756319117fdSKonstantin Belousov hw_ibrs_disable_handler(SYSCTL_HANDLER_ARGS) 757319117fdSKonstantin Belousov { 758319117fdSKonstantin Belousov int error, val; 759319117fdSKonstantin Belousov 760319117fdSKonstantin Belousov val = hw_ibrs_disable; 761319117fdSKonstantin Belousov error = sysctl_handle_int(oidp, &val, 0, req); 762319117fdSKonstantin Belousov if (error != 0 || req->newptr == NULL) 763319117fdSKonstantin Belousov return (error); 764319117fdSKonstantin Belousov hw_ibrs_disable = val != 0; 765319117fdSKonstantin Belousov hw_ibrs_recalculate(); 766319117fdSKonstantin Belousov return (0); 767319117fdSKonstantin Belousov } 768319117fdSKonstantin Belousov SYSCTL_PROC(_hw, OID_AUTO, ibrs_disable, CTLTYPE_INT | CTLFLAG_RWTUN | 769319117fdSKonstantin Belousov CTLFLAG_NOFETCH | CTLFLAG_MPSAFE, NULL, 0, hw_ibrs_disable_handler, "I", 770b31b965eSKonstantin Belousov "Disable Indirect Branch Restricted Speculation"); 7718fbcc334SKonstantin Belousov 7728fbcc334SKonstantin Belousov /* 7738fbcc334SKonstantin Belousov * Enable and restore kernel text write permissions. 7748fbcc334SKonstantin Belousov * Callers must ensure that disable_wp()/restore_wp() are executed 7758fbcc334SKonstantin Belousov * without rescheduling on the same core. 7768fbcc334SKonstantin Belousov */ 7778fbcc334SKonstantin Belousov bool 7788fbcc334SKonstantin Belousov disable_wp(void) 7798fbcc334SKonstantin Belousov { 7808fbcc334SKonstantin Belousov u_int cr0; 7818fbcc334SKonstantin Belousov 7828fbcc334SKonstantin Belousov cr0 = rcr0(); 7838fbcc334SKonstantin Belousov if ((cr0 & CR0_WP) == 0) 7848fbcc334SKonstantin Belousov return (false); 7858fbcc334SKonstantin Belousov load_cr0(cr0 & ~CR0_WP); 7868fbcc334SKonstantin Belousov return (true); 7878fbcc334SKonstantin Belousov } 7888fbcc334SKonstantin Belousov 7898fbcc334SKonstantin Belousov void 7908fbcc334SKonstantin Belousov restore_wp(bool old_wp) 7918fbcc334SKonstantin Belousov { 7928fbcc334SKonstantin Belousov 7938fbcc334SKonstantin Belousov if (old_wp) 7948fbcc334SKonstantin Belousov load_cr0(rcr0() | CR0_WP); 7958fbcc334SKonstantin Belousov } 7968fbcc334SKonstantin Belousov 797