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_compat.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 #ifdef SMP 74dfe7b3bfSKonstantin Belousov #include <sys/smp.h> 75dfe7b3bfSKonstantin Belousov #endif 76dfe7b3bfSKonstantin Belousov #include <sys/sysctl.h> 77dfe7b3bfSKonstantin Belousov 78dfe7b3bfSKonstantin Belousov #include <machine/clock.h> 79dfe7b3bfSKonstantin Belousov #include <machine/cpu.h> 80dfe7b3bfSKonstantin Belousov #include <machine/cputypes.h> 81dfe7b3bfSKonstantin Belousov #include <machine/specialreg.h> 82dfe7b3bfSKonstantin Belousov #include <machine/md_var.h> 83dfe7b3bfSKonstantin Belousov #include <machine/mp_watchdog.h> 84dfe7b3bfSKonstantin Belousov #include <machine/tss.h> 85dfe7b3bfSKonstantin Belousov #ifdef SMP 86dfe7b3bfSKonstantin Belousov #include <machine/smp.h> 87dfe7b3bfSKonstantin Belousov #endif 88b57a73f8SKonstantin Belousov #include <x86/acpica_machdep.h> 89dfe7b3bfSKonstantin Belousov 90dfe7b3bfSKonstantin Belousov #include <vm/vm.h> 91dfe7b3bfSKonstantin Belousov #include <vm/vm_extern.h> 92dfe7b3bfSKonstantin Belousov #include <vm/vm_kern.h> 93dfe7b3bfSKonstantin Belousov #include <vm/vm_page.h> 94dfe7b3bfSKonstantin Belousov #include <vm/vm_map.h> 95dfe7b3bfSKonstantin Belousov #include <vm/vm_object.h> 96dfe7b3bfSKonstantin Belousov #include <vm/vm_pager.h> 97dfe7b3bfSKonstantin Belousov #include <vm/vm_param.h> 98dfe7b3bfSKonstantin Belousov 99d9e8bbb6SKonstantin Belousov #define STATE_RUNNING 0x0 100d9e8bbb6SKonstantin Belousov #define STATE_MWAIT 0x1 101d9e8bbb6SKonstantin Belousov #define STATE_SLEEPING 0x2 102d9e8bbb6SKonstantin Belousov 103dfe7b3bfSKonstantin Belousov /* 104dfe7b3bfSKonstantin Belousov * Machine dependent boot() routine 105dfe7b3bfSKonstantin Belousov * 106dfe7b3bfSKonstantin Belousov * I haven't seen anything to put here yet 107dfe7b3bfSKonstantin Belousov * Possibly some stuff might be grafted back here from boot() 108dfe7b3bfSKonstantin Belousov */ 109dfe7b3bfSKonstantin Belousov void 110dfe7b3bfSKonstantin Belousov cpu_boot(int howto) 111dfe7b3bfSKonstantin Belousov { 112dfe7b3bfSKonstantin Belousov } 113dfe7b3bfSKonstantin Belousov 114dfe7b3bfSKonstantin Belousov /* 115dfe7b3bfSKonstantin Belousov * Flush the D-cache for non-DMA I/O so that the I-cache can 116dfe7b3bfSKonstantin Belousov * be made coherent later. 117dfe7b3bfSKonstantin Belousov */ 118dfe7b3bfSKonstantin Belousov void 119dfe7b3bfSKonstantin Belousov cpu_flush_dcache(void *ptr, size_t len) 120dfe7b3bfSKonstantin Belousov { 121dfe7b3bfSKonstantin Belousov /* Not applicable */ 122dfe7b3bfSKonstantin Belousov } 123dfe7b3bfSKonstantin Belousov 124b57a73f8SKonstantin Belousov void 125b57a73f8SKonstantin Belousov acpi_cpu_c1(void) 126b57a73f8SKonstantin Belousov { 127b57a73f8SKonstantin Belousov 128b57a73f8SKonstantin Belousov __asm __volatile("sti; hlt"); 129b57a73f8SKonstantin Belousov } 130b57a73f8SKonstantin Belousov 13119d4720bSJonathan T. Looney /* 13219d4720bSJonathan T. Looney * Use mwait to pause execution while waiting for an interrupt or 13319d4720bSJonathan T. Looney * another thread to signal that there is more work. 13419d4720bSJonathan T. Looney * 13519d4720bSJonathan T. Looney * NOTE: Interrupts will cause a wakeup; however, this function does 13619d4720bSJonathan T. Looney * not enable interrupt handling. The caller is responsible to enable 13719d4720bSJonathan T. Looney * interrupts. 13819d4720bSJonathan T. Looney */ 139b57a73f8SKonstantin Belousov void 140b57a73f8SKonstantin Belousov acpi_cpu_idle_mwait(uint32_t mwait_hint) 141b57a73f8SKonstantin Belousov { 142b57a73f8SKonstantin Belousov int *state; 143b57a73f8SKonstantin Belousov 144b57a73f8SKonstantin Belousov /* 145319117fdSKonstantin Belousov * A comment in Linux patch claims that 'CPUs run faster with 146319117fdSKonstantin Belousov * speculation protection disabled. All CPU threads in a core 147319117fdSKonstantin Belousov * must disable speculation protection for it to be 148319117fdSKonstantin Belousov * disabled. Disable it while we are idle so the other 149319117fdSKonstantin Belousov * hyperthread can run fast.' 150319117fdSKonstantin Belousov * 151b57a73f8SKonstantin Belousov * XXXKIB. Software coordination mode should be supported, 152b57a73f8SKonstantin Belousov * but all Intel CPUs provide hardware coordination. 153b57a73f8SKonstantin Belousov */ 154d9e8bbb6SKonstantin Belousov 155d9e8bbb6SKonstantin Belousov state = (int *)PCPU_PTR(monitorbuf); 156d9e8bbb6SKonstantin Belousov KASSERT(*state == STATE_SLEEPING, 157d9e8bbb6SKonstantin Belousov ("cpu_mwait_cx: wrong monitorbuf state")); 158d9e8bbb6SKonstantin Belousov *state = STATE_MWAIT; 159319117fdSKonstantin Belousov handle_ibrs_entry(); 160b57a73f8SKonstantin Belousov cpu_monitor(state, 0, 0); 161d9e8bbb6SKonstantin Belousov if (*state == STATE_MWAIT) 162b57a73f8SKonstantin Belousov cpu_mwait(MWAIT_INTRBREAK, mwait_hint); 163319117fdSKonstantin Belousov handle_ibrs_exit(); 164d9e8bbb6SKonstantin Belousov 165d9e8bbb6SKonstantin Belousov /* 166d9e8bbb6SKonstantin Belousov * We should exit on any event that interrupts mwait, because 167d9e8bbb6SKonstantin Belousov * that event might be a wanted interrupt. 168d9e8bbb6SKonstantin Belousov */ 169d9e8bbb6SKonstantin Belousov *state = STATE_RUNNING; 170b57a73f8SKonstantin Belousov } 171b57a73f8SKonstantin Belousov 172dfe7b3bfSKonstantin Belousov /* Get current clock frequency for the given cpu id. */ 173dfe7b3bfSKonstantin Belousov int 174dfe7b3bfSKonstantin Belousov cpu_est_clockrate(int cpu_id, uint64_t *rate) 175dfe7b3bfSKonstantin Belousov { 176dfe7b3bfSKonstantin Belousov uint64_t tsc1, tsc2; 177dfe7b3bfSKonstantin Belousov uint64_t acnt, mcnt, perf; 178dfe7b3bfSKonstantin Belousov register_t reg; 179dfe7b3bfSKonstantin Belousov 180dfe7b3bfSKonstantin Belousov if (pcpu_find(cpu_id) == NULL || rate == NULL) 181dfe7b3bfSKonstantin Belousov return (EINVAL); 182dfe7b3bfSKonstantin Belousov #ifdef __i386__ 183dfe7b3bfSKonstantin Belousov if ((cpu_feature & CPUID_TSC) == 0) 184dfe7b3bfSKonstantin Belousov return (EOPNOTSUPP); 185dfe7b3bfSKonstantin Belousov #endif 186dfe7b3bfSKonstantin Belousov 187dfe7b3bfSKonstantin Belousov /* 188dfe7b3bfSKonstantin Belousov * If TSC is P-state invariant and APERF/MPERF MSRs do not exist, 189dfe7b3bfSKonstantin Belousov * DELAY(9) based logic fails. 190dfe7b3bfSKonstantin Belousov */ 191dfe7b3bfSKonstantin Belousov if (tsc_is_invariant && !tsc_perf_stat) 192dfe7b3bfSKonstantin Belousov return (EOPNOTSUPP); 193dfe7b3bfSKonstantin Belousov 194dfe7b3bfSKonstantin Belousov #ifdef SMP 195dfe7b3bfSKonstantin Belousov if (smp_cpus > 1) { 196dfe7b3bfSKonstantin Belousov /* Schedule ourselves on the indicated cpu. */ 197dfe7b3bfSKonstantin Belousov thread_lock(curthread); 198dfe7b3bfSKonstantin Belousov sched_bind(curthread, cpu_id); 199dfe7b3bfSKonstantin Belousov thread_unlock(curthread); 200dfe7b3bfSKonstantin Belousov } 201dfe7b3bfSKonstantin Belousov #endif 202dfe7b3bfSKonstantin Belousov 203dfe7b3bfSKonstantin Belousov /* Calibrate by measuring a short delay. */ 204dfe7b3bfSKonstantin Belousov reg = intr_disable(); 205dfe7b3bfSKonstantin Belousov if (tsc_is_invariant) { 206dfe7b3bfSKonstantin Belousov wrmsr(MSR_MPERF, 0); 207dfe7b3bfSKonstantin Belousov wrmsr(MSR_APERF, 0); 208dfe7b3bfSKonstantin Belousov tsc1 = rdtsc(); 209dfe7b3bfSKonstantin Belousov DELAY(1000); 210dfe7b3bfSKonstantin Belousov mcnt = rdmsr(MSR_MPERF); 211dfe7b3bfSKonstantin Belousov acnt = rdmsr(MSR_APERF); 212dfe7b3bfSKonstantin Belousov tsc2 = rdtsc(); 213dfe7b3bfSKonstantin Belousov intr_restore(reg); 214dfe7b3bfSKonstantin Belousov perf = 1000 * acnt / mcnt; 215dfe7b3bfSKonstantin Belousov *rate = (tsc2 - tsc1) * perf; 216dfe7b3bfSKonstantin Belousov } else { 217dfe7b3bfSKonstantin Belousov tsc1 = rdtsc(); 218dfe7b3bfSKonstantin Belousov DELAY(1000); 219dfe7b3bfSKonstantin Belousov tsc2 = rdtsc(); 220dfe7b3bfSKonstantin Belousov intr_restore(reg); 221dfe7b3bfSKonstantin Belousov *rate = (tsc2 - tsc1) * 1000; 222dfe7b3bfSKonstantin Belousov } 223dfe7b3bfSKonstantin Belousov 224dfe7b3bfSKonstantin Belousov #ifdef SMP 225dfe7b3bfSKonstantin Belousov if (smp_cpus > 1) { 226dfe7b3bfSKonstantin Belousov thread_lock(curthread); 227dfe7b3bfSKonstantin Belousov sched_unbind(curthread); 228dfe7b3bfSKonstantin Belousov thread_unlock(curthread); 229dfe7b3bfSKonstantin Belousov } 230dfe7b3bfSKonstantin Belousov #endif 231dfe7b3bfSKonstantin Belousov 232dfe7b3bfSKonstantin Belousov return (0); 233dfe7b3bfSKonstantin Belousov } 234dfe7b3bfSKonstantin Belousov 235dfe7b3bfSKonstantin Belousov /* 236dfe7b3bfSKonstantin Belousov * Shutdown the CPU as much as possible 237dfe7b3bfSKonstantin Belousov */ 238dfe7b3bfSKonstantin Belousov void 239dfe7b3bfSKonstantin Belousov cpu_halt(void) 240dfe7b3bfSKonstantin Belousov { 241dfe7b3bfSKonstantin Belousov for (;;) 242dfe7b3bfSKonstantin Belousov halt(); 243dfe7b3bfSKonstantin Belousov } 244dfe7b3bfSKonstantin Belousov 245b57a73f8SKonstantin Belousov bool 246b57a73f8SKonstantin Belousov cpu_mwait_usable(void) 247b57a73f8SKonstantin Belousov { 248b57a73f8SKonstantin Belousov 249b57a73f8SKonstantin Belousov return ((cpu_feature2 & CPUID2_MON) != 0 && ((cpu_mon_mwait_flags & 250b57a73f8SKonstantin Belousov (CPUID5_MON_MWAIT_EXT | CPUID5_MWAIT_INTRBREAK)) == 251b57a73f8SKonstantin Belousov (CPUID5_MON_MWAIT_EXT | CPUID5_MWAIT_INTRBREAK))); 252b57a73f8SKonstantin Belousov } 253b57a73f8SKonstantin Belousov 254dfe7b3bfSKonstantin Belousov void (*cpu_idle_hook)(sbintime_t) = NULL; /* ACPI idle hook. */ 255dfe7b3bfSKonstantin Belousov static int cpu_ident_amdc1e = 0; /* AMD C1E supported. */ 256dfe7b3bfSKonstantin Belousov static int idle_mwait = 1; /* Use MONITOR/MWAIT for short idle. */ 257dfe7b3bfSKonstantin Belousov SYSCTL_INT(_machdep, OID_AUTO, idle_mwait, CTLFLAG_RWTUN, &idle_mwait, 258dfe7b3bfSKonstantin Belousov 0, "Use MONITOR/MWAIT for short idle"); 259dfe7b3bfSKonstantin Belousov 260dfe7b3bfSKonstantin Belousov static void 261dfe7b3bfSKonstantin Belousov cpu_idle_acpi(sbintime_t sbt) 262dfe7b3bfSKonstantin Belousov { 263dfe7b3bfSKonstantin Belousov int *state; 264dfe7b3bfSKonstantin Belousov 265dfe7b3bfSKonstantin Belousov state = (int *)PCPU_PTR(monitorbuf); 266dfe7b3bfSKonstantin Belousov *state = STATE_SLEEPING; 267dfe7b3bfSKonstantin Belousov 268dfe7b3bfSKonstantin Belousov /* See comments in cpu_idle_hlt(). */ 269dfe7b3bfSKonstantin Belousov disable_intr(); 270dfe7b3bfSKonstantin Belousov if (sched_runnable()) 271dfe7b3bfSKonstantin Belousov enable_intr(); 272dfe7b3bfSKonstantin Belousov else if (cpu_idle_hook) 273dfe7b3bfSKonstantin Belousov cpu_idle_hook(sbt); 274dfe7b3bfSKonstantin Belousov else 275b57a73f8SKonstantin Belousov acpi_cpu_c1(); 276dfe7b3bfSKonstantin Belousov *state = STATE_RUNNING; 277dfe7b3bfSKonstantin Belousov } 278dfe7b3bfSKonstantin Belousov 279dfe7b3bfSKonstantin Belousov static void 280dfe7b3bfSKonstantin Belousov cpu_idle_hlt(sbintime_t sbt) 281dfe7b3bfSKonstantin Belousov { 282dfe7b3bfSKonstantin Belousov int *state; 283dfe7b3bfSKonstantin Belousov 284dfe7b3bfSKonstantin Belousov state = (int *)PCPU_PTR(monitorbuf); 285dfe7b3bfSKonstantin Belousov *state = STATE_SLEEPING; 286dfe7b3bfSKonstantin Belousov 287dfe7b3bfSKonstantin Belousov /* 288dfe7b3bfSKonstantin Belousov * Since we may be in a critical section from cpu_idle(), if 289dfe7b3bfSKonstantin Belousov * an interrupt fires during that critical section we may have 290dfe7b3bfSKonstantin Belousov * a pending preemption. If the CPU halts, then that thread 291dfe7b3bfSKonstantin Belousov * may not execute until a later interrupt awakens the CPU. 292dfe7b3bfSKonstantin Belousov * To handle this race, check for a runnable thread after 293dfe7b3bfSKonstantin Belousov * disabling interrupts and immediately return if one is 294dfe7b3bfSKonstantin Belousov * found. Also, we must absolutely guarentee that hlt is 295dfe7b3bfSKonstantin Belousov * the next instruction after sti. This ensures that any 296dfe7b3bfSKonstantin Belousov * interrupt that fires after the call to disable_intr() will 297dfe7b3bfSKonstantin Belousov * immediately awaken the CPU from hlt. Finally, please note 298dfe7b3bfSKonstantin Belousov * that on x86 this works fine because of interrupts enabled only 299dfe7b3bfSKonstantin Belousov * after the instruction following sti takes place, while IF is set 300dfe7b3bfSKonstantin Belousov * to 1 immediately, allowing hlt instruction to acknowledge the 301dfe7b3bfSKonstantin Belousov * interrupt. 302dfe7b3bfSKonstantin Belousov */ 303dfe7b3bfSKonstantin Belousov disable_intr(); 304dfe7b3bfSKonstantin Belousov if (sched_runnable()) 305dfe7b3bfSKonstantin Belousov enable_intr(); 306dfe7b3bfSKonstantin Belousov else 307b57a73f8SKonstantin Belousov acpi_cpu_c1(); 308dfe7b3bfSKonstantin Belousov *state = STATE_RUNNING; 309dfe7b3bfSKonstantin Belousov } 310dfe7b3bfSKonstantin Belousov 311dfe7b3bfSKonstantin Belousov static void 312dfe7b3bfSKonstantin Belousov cpu_idle_mwait(sbintime_t sbt) 313dfe7b3bfSKonstantin Belousov { 314dfe7b3bfSKonstantin Belousov int *state; 315dfe7b3bfSKonstantin Belousov 316dfe7b3bfSKonstantin Belousov state = (int *)PCPU_PTR(monitorbuf); 317dfe7b3bfSKonstantin Belousov *state = STATE_MWAIT; 318dfe7b3bfSKonstantin Belousov 319dfe7b3bfSKonstantin Belousov /* See comments in cpu_idle_hlt(). */ 320dfe7b3bfSKonstantin Belousov disable_intr(); 321dfe7b3bfSKonstantin Belousov if (sched_runnable()) { 322dfe7b3bfSKonstantin Belousov enable_intr(); 323dfe7b3bfSKonstantin Belousov *state = STATE_RUNNING; 324dfe7b3bfSKonstantin Belousov return; 325dfe7b3bfSKonstantin Belousov } 326dfe7b3bfSKonstantin Belousov cpu_monitor(state, 0, 0); 327dfe7b3bfSKonstantin Belousov if (*state == STATE_MWAIT) 328dfe7b3bfSKonstantin Belousov __asm __volatile("sti; mwait" : : "a" (MWAIT_C1), "c" (0)); 329dfe7b3bfSKonstantin Belousov else 330dfe7b3bfSKonstantin Belousov enable_intr(); 331dfe7b3bfSKonstantin Belousov *state = STATE_RUNNING; 332dfe7b3bfSKonstantin Belousov } 333dfe7b3bfSKonstantin Belousov 334dfe7b3bfSKonstantin Belousov static void 335dfe7b3bfSKonstantin Belousov cpu_idle_spin(sbintime_t sbt) 336dfe7b3bfSKonstantin Belousov { 337dfe7b3bfSKonstantin Belousov int *state; 338dfe7b3bfSKonstantin Belousov int i; 339dfe7b3bfSKonstantin Belousov 340dfe7b3bfSKonstantin Belousov state = (int *)PCPU_PTR(monitorbuf); 341dfe7b3bfSKonstantin Belousov *state = STATE_RUNNING; 342dfe7b3bfSKonstantin Belousov 343dfe7b3bfSKonstantin Belousov /* 344dfe7b3bfSKonstantin Belousov * The sched_runnable() call is racy but as long as there is 345dfe7b3bfSKonstantin Belousov * a loop missing it one time will have just a little impact if any 346dfe7b3bfSKonstantin Belousov * (and it is much better than missing the check at all). 347dfe7b3bfSKonstantin Belousov */ 348dfe7b3bfSKonstantin Belousov for (i = 0; i < 1000; i++) { 349dfe7b3bfSKonstantin Belousov if (sched_runnable()) 350dfe7b3bfSKonstantin Belousov return; 351dfe7b3bfSKonstantin Belousov cpu_spinwait(); 352dfe7b3bfSKonstantin Belousov } 353dfe7b3bfSKonstantin Belousov } 354dfe7b3bfSKonstantin Belousov 355dfe7b3bfSKonstantin Belousov /* 356dfe7b3bfSKonstantin Belousov * C1E renders the local APIC timer dead, so we disable it by 357dfe7b3bfSKonstantin Belousov * reading the Interrupt Pending Message register and clearing 358dfe7b3bfSKonstantin Belousov * both C1eOnCmpHalt (bit 28) and SmiOnCmpHalt (bit 27). 359dfe7b3bfSKonstantin Belousov * 360dfe7b3bfSKonstantin Belousov * Reference: 361dfe7b3bfSKonstantin Belousov * "BIOS and Kernel Developer's Guide for AMD NPT Family 0Fh Processors" 362dfe7b3bfSKonstantin Belousov * #32559 revision 3.00+ 363dfe7b3bfSKonstantin Belousov */ 364dfe7b3bfSKonstantin Belousov #define MSR_AMDK8_IPM 0xc0010055 365dfe7b3bfSKonstantin Belousov #define AMDK8_SMIONCMPHALT (1ULL << 27) 366dfe7b3bfSKonstantin Belousov #define AMDK8_C1EONCMPHALT (1ULL << 28) 367dfe7b3bfSKonstantin Belousov #define AMDK8_CMPHALT (AMDK8_SMIONCMPHALT | AMDK8_C1EONCMPHALT) 368dfe7b3bfSKonstantin Belousov 369dfe7b3bfSKonstantin Belousov void 370dfe7b3bfSKonstantin Belousov cpu_probe_amdc1e(void) 371dfe7b3bfSKonstantin Belousov { 372dfe7b3bfSKonstantin Belousov 373dfe7b3bfSKonstantin Belousov /* 374dfe7b3bfSKonstantin Belousov * Detect the presence of C1E capability mostly on latest 375dfe7b3bfSKonstantin Belousov * dual-cores (or future) k8 family. 376dfe7b3bfSKonstantin Belousov */ 377dfe7b3bfSKonstantin Belousov if (cpu_vendor_id == CPU_VENDOR_AMD && 378dfe7b3bfSKonstantin Belousov (cpu_id & 0x00000f00) == 0x00000f00 && 379dfe7b3bfSKonstantin Belousov (cpu_id & 0x0fff0000) >= 0x00040000) { 380dfe7b3bfSKonstantin Belousov cpu_ident_amdc1e = 1; 381dfe7b3bfSKonstantin Belousov } 382dfe7b3bfSKonstantin Belousov } 383dfe7b3bfSKonstantin Belousov 384dfe7b3bfSKonstantin Belousov void (*cpu_idle_fn)(sbintime_t) = cpu_idle_acpi; 385dfe7b3bfSKonstantin Belousov 386dfe7b3bfSKonstantin Belousov void 387dfe7b3bfSKonstantin Belousov cpu_idle(int busy) 388dfe7b3bfSKonstantin Belousov { 389dfe7b3bfSKonstantin Belousov uint64_t msr; 390dfe7b3bfSKonstantin Belousov sbintime_t sbt = -1; 391dfe7b3bfSKonstantin Belousov 392dfe7b3bfSKonstantin Belousov CTR2(KTR_SPARE2, "cpu_idle(%d) at %d", 393dfe7b3bfSKonstantin Belousov busy, curcpu); 394ed95805eSJohn Baldwin #ifdef MP_WATCHDOG 395dfe7b3bfSKonstantin Belousov ap_watchdog(PCPU_GET(cpuid)); 396dfe7b3bfSKonstantin Belousov #endif 397ed95805eSJohn Baldwin 398dfe7b3bfSKonstantin Belousov /* If we are busy - try to use fast methods. */ 399dfe7b3bfSKonstantin Belousov if (busy) { 400dfe7b3bfSKonstantin Belousov if ((cpu_feature2 & CPUID2_MON) && idle_mwait) { 401dfe7b3bfSKonstantin Belousov cpu_idle_mwait(busy); 402dfe7b3bfSKonstantin Belousov goto out; 403dfe7b3bfSKonstantin Belousov } 404dfe7b3bfSKonstantin Belousov } 405dfe7b3bfSKonstantin Belousov 406dfe7b3bfSKonstantin Belousov /* If we have time - switch timers into idle mode. */ 407dfe7b3bfSKonstantin Belousov if (!busy) { 408dfe7b3bfSKonstantin Belousov critical_enter(); 409dfe7b3bfSKonstantin Belousov sbt = cpu_idleclock(); 410dfe7b3bfSKonstantin Belousov } 411dfe7b3bfSKonstantin Belousov 412dfe7b3bfSKonstantin Belousov /* Apply AMD APIC timer C1E workaround. */ 413dfe7b3bfSKonstantin Belousov if (cpu_ident_amdc1e && cpu_disable_c3_sleep) { 414dfe7b3bfSKonstantin Belousov msr = rdmsr(MSR_AMDK8_IPM); 415dfe7b3bfSKonstantin Belousov if (msr & AMDK8_CMPHALT) 416dfe7b3bfSKonstantin Belousov wrmsr(MSR_AMDK8_IPM, msr & ~AMDK8_CMPHALT); 417dfe7b3bfSKonstantin Belousov } 418dfe7b3bfSKonstantin Belousov 419dfe7b3bfSKonstantin Belousov /* Call main idle method. */ 420dfe7b3bfSKonstantin Belousov cpu_idle_fn(sbt); 421dfe7b3bfSKonstantin Belousov 422dfe7b3bfSKonstantin Belousov /* Switch timers back into active mode. */ 423dfe7b3bfSKonstantin Belousov if (!busy) { 424dfe7b3bfSKonstantin Belousov cpu_activeclock(); 425dfe7b3bfSKonstantin Belousov critical_exit(); 426dfe7b3bfSKonstantin Belousov } 427dfe7b3bfSKonstantin Belousov out: 428dfe7b3bfSKonstantin Belousov CTR2(KTR_SPARE2, "cpu_idle(%d) at %d done", 429dfe7b3bfSKonstantin Belousov busy, curcpu); 430dfe7b3bfSKonstantin Belousov } 431dfe7b3bfSKonstantin Belousov 432dfe7b3bfSKonstantin Belousov int 433dfe7b3bfSKonstantin Belousov cpu_idle_wakeup(int cpu) 434dfe7b3bfSKonstantin Belousov { 435dfe7b3bfSKonstantin Belousov struct pcpu *pcpu; 436dfe7b3bfSKonstantin Belousov int *state; 437dfe7b3bfSKonstantin Belousov 438dfe7b3bfSKonstantin Belousov pcpu = pcpu_find(cpu); 439dfe7b3bfSKonstantin Belousov state = (int *)pcpu->pc_monitorbuf; 440dfe7b3bfSKonstantin Belousov /* 441dfe7b3bfSKonstantin Belousov * This doesn't need to be atomic since missing the race will 442dfe7b3bfSKonstantin Belousov * simply result in unnecessary IPIs. 443dfe7b3bfSKonstantin Belousov */ 444dfe7b3bfSKonstantin Belousov if (*state == STATE_SLEEPING) 445dfe7b3bfSKonstantin Belousov return (0); 446dfe7b3bfSKonstantin Belousov if (*state == STATE_MWAIT) 447dfe7b3bfSKonstantin Belousov *state = STATE_RUNNING; 448dfe7b3bfSKonstantin Belousov return (1); 449dfe7b3bfSKonstantin Belousov } 450dfe7b3bfSKonstantin Belousov 451dfe7b3bfSKonstantin Belousov /* 452dfe7b3bfSKonstantin Belousov * Ordered by speed/power consumption. 453dfe7b3bfSKonstantin Belousov */ 454dfe7b3bfSKonstantin Belousov struct { 455dfe7b3bfSKonstantin Belousov void *id_fn; 456dfe7b3bfSKonstantin Belousov char *id_name; 457dfe7b3bfSKonstantin Belousov } idle_tbl[] = { 458dfe7b3bfSKonstantin Belousov { cpu_idle_spin, "spin" }, 459dfe7b3bfSKonstantin Belousov { cpu_idle_mwait, "mwait" }, 460dfe7b3bfSKonstantin Belousov { cpu_idle_hlt, "hlt" }, 461dfe7b3bfSKonstantin Belousov { cpu_idle_acpi, "acpi" }, 462dfe7b3bfSKonstantin Belousov { NULL, NULL } 463dfe7b3bfSKonstantin Belousov }; 464dfe7b3bfSKonstantin Belousov 465dfe7b3bfSKonstantin Belousov static int 466dfe7b3bfSKonstantin Belousov idle_sysctl_available(SYSCTL_HANDLER_ARGS) 467dfe7b3bfSKonstantin Belousov { 468dfe7b3bfSKonstantin Belousov char *avail, *p; 469dfe7b3bfSKonstantin Belousov int error; 470dfe7b3bfSKonstantin Belousov int i; 471dfe7b3bfSKonstantin Belousov 472dfe7b3bfSKonstantin Belousov avail = malloc(256, M_TEMP, M_WAITOK); 473dfe7b3bfSKonstantin Belousov p = avail; 474dfe7b3bfSKonstantin Belousov for (i = 0; idle_tbl[i].id_name != NULL; i++) { 475dfe7b3bfSKonstantin Belousov if (strstr(idle_tbl[i].id_name, "mwait") && 476dfe7b3bfSKonstantin Belousov (cpu_feature2 & CPUID2_MON) == 0) 477dfe7b3bfSKonstantin Belousov continue; 478dfe7b3bfSKonstantin Belousov if (strcmp(idle_tbl[i].id_name, "acpi") == 0 && 479dfe7b3bfSKonstantin Belousov cpu_idle_hook == NULL) 480dfe7b3bfSKonstantin Belousov continue; 481dfe7b3bfSKonstantin Belousov p += sprintf(p, "%s%s", p != avail ? ", " : "", 482dfe7b3bfSKonstantin Belousov idle_tbl[i].id_name); 483dfe7b3bfSKonstantin Belousov } 484dfe7b3bfSKonstantin Belousov error = sysctl_handle_string(oidp, avail, 0, req); 485dfe7b3bfSKonstantin Belousov free(avail, M_TEMP); 486dfe7b3bfSKonstantin Belousov return (error); 487dfe7b3bfSKonstantin Belousov } 488dfe7b3bfSKonstantin Belousov 489dfe7b3bfSKonstantin Belousov SYSCTL_PROC(_machdep, OID_AUTO, idle_available, CTLTYPE_STRING | CTLFLAG_RD, 490dfe7b3bfSKonstantin Belousov 0, 0, idle_sysctl_available, "A", "list of available idle functions"); 491dfe7b3bfSKonstantin Belousov 492dfe7b3bfSKonstantin Belousov static int 493dfe7b3bfSKonstantin Belousov idle_sysctl(SYSCTL_HANDLER_ARGS) 494dfe7b3bfSKonstantin Belousov { 495dfe7b3bfSKonstantin Belousov char buf[16]; 496dfe7b3bfSKonstantin Belousov int error; 497dfe7b3bfSKonstantin Belousov char *p; 498dfe7b3bfSKonstantin Belousov int i; 499dfe7b3bfSKonstantin Belousov 500dfe7b3bfSKonstantin Belousov p = "unknown"; 501dfe7b3bfSKonstantin Belousov for (i = 0; idle_tbl[i].id_name != NULL; i++) { 502dfe7b3bfSKonstantin Belousov if (idle_tbl[i].id_fn == cpu_idle_fn) { 503dfe7b3bfSKonstantin Belousov p = idle_tbl[i].id_name; 504dfe7b3bfSKonstantin Belousov break; 505dfe7b3bfSKonstantin Belousov } 506dfe7b3bfSKonstantin Belousov } 507dfe7b3bfSKonstantin Belousov strncpy(buf, p, sizeof(buf)); 508dfe7b3bfSKonstantin Belousov error = sysctl_handle_string(oidp, buf, sizeof(buf), req); 509dfe7b3bfSKonstantin Belousov if (error != 0 || req->newptr == NULL) 510dfe7b3bfSKonstantin Belousov return (error); 511dfe7b3bfSKonstantin Belousov for (i = 0; idle_tbl[i].id_name != NULL; i++) { 512dfe7b3bfSKonstantin Belousov if (strstr(idle_tbl[i].id_name, "mwait") && 513dfe7b3bfSKonstantin Belousov (cpu_feature2 & CPUID2_MON) == 0) 514dfe7b3bfSKonstantin Belousov continue; 515dfe7b3bfSKonstantin Belousov if (strcmp(idle_tbl[i].id_name, "acpi") == 0 && 516dfe7b3bfSKonstantin Belousov cpu_idle_hook == NULL) 517dfe7b3bfSKonstantin Belousov continue; 518dfe7b3bfSKonstantin Belousov if (strcmp(idle_tbl[i].id_name, buf)) 519dfe7b3bfSKonstantin Belousov continue; 520dfe7b3bfSKonstantin Belousov cpu_idle_fn = idle_tbl[i].id_fn; 521dfe7b3bfSKonstantin Belousov return (0); 522dfe7b3bfSKonstantin Belousov } 523dfe7b3bfSKonstantin Belousov return (EINVAL); 524dfe7b3bfSKonstantin Belousov } 525dfe7b3bfSKonstantin Belousov 526dfe7b3bfSKonstantin Belousov SYSCTL_PROC(_machdep, OID_AUTO, idle, CTLTYPE_STRING | CTLFLAG_RW, 0, 0, 527dfe7b3bfSKonstantin Belousov idle_sysctl, "A", "currently selected idle function"); 528835c2787SKonstantin Belousov 529295f4b6cSKonstantin Belousov static int panic_on_nmi = 1; 530295f4b6cSKonstantin Belousov SYSCTL_INT(_machdep, OID_AUTO, panic_on_nmi, CTLFLAG_RWTUN, 531295f4b6cSKonstantin Belousov &panic_on_nmi, 0, 532295f4b6cSKonstantin Belousov "Panic on NMI"); 533835c2787SKonstantin Belousov int nmi_is_broadcast = 1; 534835c2787SKonstantin Belousov SYSCTL_INT(_machdep, OID_AUTO, nmi_is_broadcast, CTLFLAG_RWTUN, 535835c2787SKonstantin Belousov &nmi_is_broadcast, 0, 536835c2787SKonstantin Belousov "Chipset NMI is broadcast"); 537835c2787SKonstantin Belousov #ifdef KDB 538835c2787SKonstantin Belousov int kdb_on_nmi = 1; 539835c2787SKonstantin Belousov SYSCTL_INT(_machdep, OID_AUTO, kdb_on_nmi, CTLFLAG_RWTUN, 540835c2787SKonstantin Belousov &kdb_on_nmi, 0, 541835c2787SKonstantin Belousov "Go to KDB on NMI"); 542835c2787SKonstantin Belousov #endif 543835c2787SKonstantin Belousov 544835c2787SKonstantin Belousov #ifdef DEV_ISA 545295f4b6cSKonstantin Belousov void 546295f4b6cSKonstantin Belousov nmi_call_kdb(u_int cpu, u_int type, struct trapframe *frame) 547835c2787SKonstantin Belousov { 548835c2787SKonstantin Belousov 549835c2787SKonstantin Belousov /* machine/parity/power fail/"kitchen sink" faults */ 550835c2787SKonstantin Belousov if (isa_nmi(frame->tf_err) == 0) { 551835c2787SKonstantin Belousov #ifdef KDB 552835c2787SKonstantin Belousov /* 553835c2787SKonstantin Belousov * NMI can be hooked up to a pushbutton for debugging. 554835c2787SKonstantin Belousov */ 555835c2787SKonstantin Belousov if (kdb_on_nmi) { 556835c2787SKonstantin Belousov printf("NMI/cpu%d ... going to debugger\n", cpu); 557835c2787SKonstantin Belousov kdb_trap(type, 0, frame); 558835c2787SKonstantin Belousov } 559835c2787SKonstantin Belousov #endif /* KDB */ 560295f4b6cSKonstantin Belousov } else if (panic_on_nmi) { 561835c2787SKonstantin Belousov panic("NMI indicates hardware failure"); 562295f4b6cSKonstantin Belousov } 563835c2787SKonstantin Belousov } 564835c2787SKonstantin Belousov #endif 565835c2787SKonstantin Belousov 566295f4b6cSKonstantin Belousov void 567295f4b6cSKonstantin Belousov nmi_handle_intr(u_int type, struct trapframe *frame) 568835c2787SKonstantin Belousov { 569835c2787SKonstantin Belousov 570835c2787SKonstantin Belousov #ifdef DEV_ISA 571835c2787SKonstantin Belousov #ifdef SMP 572295f4b6cSKonstantin Belousov if (nmi_is_broadcast) { 573295f4b6cSKonstantin Belousov nmi_call_kdb_smp(type, frame); 574295f4b6cSKonstantin Belousov return; 575295f4b6cSKonstantin Belousov } 576835c2787SKonstantin Belousov #endif 5771d6dfd12SKonstantin Belousov nmi_call_kdb(PCPU_GET(cpuid), type, frame); 578835c2787SKonstantin Belousov #endif 579835c2787SKonstantin Belousov } 580319117fdSKonstantin Belousov 581319117fdSKonstantin Belousov int hw_ibrs_active; 582319117fdSKonstantin Belousov int hw_ibrs_disable = 1; 583319117fdSKonstantin Belousov 584319117fdSKonstantin Belousov SYSCTL_INT(_hw, OID_AUTO, ibrs_active, CTLFLAG_RD, &hw_ibrs_active, 0, 585*b31b965eSKonstantin Belousov "Indirect Branch Restricted Speculation active"); 586319117fdSKonstantin Belousov 587319117fdSKonstantin Belousov void 588319117fdSKonstantin Belousov hw_ibrs_recalculate(void) 589319117fdSKonstantin Belousov { 590319117fdSKonstantin Belousov uint64_t v; 591319117fdSKonstantin Belousov 592319117fdSKonstantin Belousov if ((cpu_ia32_arch_caps & IA32_ARCH_CAP_IBRS_ALL) != 0) { 593319117fdSKonstantin Belousov if (hw_ibrs_disable) { 594319117fdSKonstantin Belousov v= rdmsr(MSR_IA32_SPEC_CTRL); 595319117fdSKonstantin Belousov v &= ~IA32_SPEC_CTRL_IBRS; 596319117fdSKonstantin Belousov wrmsr(MSR_IA32_SPEC_CTRL, v); 597319117fdSKonstantin Belousov } else { 598319117fdSKonstantin Belousov v= rdmsr(MSR_IA32_SPEC_CTRL); 599319117fdSKonstantin Belousov v |= IA32_SPEC_CTRL_IBRS; 600319117fdSKonstantin Belousov wrmsr(MSR_IA32_SPEC_CTRL, v); 601319117fdSKonstantin Belousov } 602319117fdSKonstantin Belousov return; 603319117fdSKonstantin Belousov } 604319117fdSKonstantin Belousov hw_ibrs_active = (cpu_stdext_feature3 & CPUID_STDEXT3_IBPB) != 0 && 605319117fdSKonstantin Belousov !hw_ibrs_disable; 606319117fdSKonstantin Belousov } 607319117fdSKonstantin Belousov 608319117fdSKonstantin Belousov static int 609319117fdSKonstantin Belousov hw_ibrs_disable_handler(SYSCTL_HANDLER_ARGS) 610319117fdSKonstantin Belousov { 611319117fdSKonstantin Belousov int error, val; 612319117fdSKonstantin Belousov 613319117fdSKonstantin Belousov val = hw_ibrs_disable; 614319117fdSKonstantin Belousov error = sysctl_handle_int(oidp, &val, 0, req); 615319117fdSKonstantin Belousov if (error != 0 || req->newptr == NULL) 616319117fdSKonstantin Belousov return (error); 617319117fdSKonstantin Belousov hw_ibrs_disable = val != 0; 618319117fdSKonstantin Belousov hw_ibrs_recalculate(); 619319117fdSKonstantin Belousov return (0); 620319117fdSKonstantin Belousov } 621319117fdSKonstantin Belousov SYSCTL_PROC(_hw, OID_AUTO, ibrs_disable, CTLTYPE_INT | CTLFLAG_RWTUN | 622319117fdSKonstantin Belousov CTLFLAG_NOFETCH | CTLFLAG_MPSAFE, NULL, 0, hw_ibrs_disable_handler, "I", 623*b31b965eSKonstantin Belousov "Disable Indirect Branch Restricted Speculation"); 624