xref: /freebsd/sys/x86/x86/cpu_machdep.c (revision 45ed991d964fb6b2d3978ead8c43e656e0bd7f71)
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 
447705dd4dSKonstantin 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 
1027705dd4dSKonstantin Belousov #include <contrib/dev/acpica/include/acpi.h>
1037705dd4dSKonstantin 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);
712*45ed991dSKonstantin Belousov 	else if (cpu_vendor_id == CPU_VENDOR_AMD &&
713*45ed991dSKonstantin Belousov 	    CPUID_TO_FAMILY(cpu_id) == 0x17 && CPUID_TO_MODEL(cpu_id) == 0x1) {
714*45ed991dSKonstantin Belousov 		/* Ryzen erratas 1057, 1109. */
715*45ed991dSKonstantin Belousov 		cpu_idle_selector("hlt");
716*45ed991dSKonstantin Belousov 		idle_mwait = 0;
717*45ed991dSKonstantin Belousov 	}
718*45ed991dSKonstantin Belousov 
7193f3937b4SKonstantin Belousov 	if (cpu_vendor_id == CPU_VENDOR_INTEL && cpu_id == 0x506c9) {
7203f3937b4SKonstantin Belousov 		/*
721160be7ccSKonstantin Belousov 		 * Apollo Lake errata APL31 (public errata APL30).
722160be7ccSKonstantin Belousov 		 * Stores to the armed address range may not trigger
723160be7ccSKonstantin Belousov 		 * MWAIT to resume execution.  OS needs to use
724160be7ccSKonstantin Belousov 		 * interrupts to wake processors from MWAIT-induced
725160be7ccSKonstantin Belousov 		 * sleep states.
7263f3937b4SKonstantin Belousov 		 */
7273f3937b4SKonstantin Belousov 		cpu_idle_apl31_workaround = 1;
7283f3937b4SKonstantin Belousov 	}
7293f3937b4SKonstantin Belousov 	TUNABLE_INT_FETCH("machdep.idle_apl31", &cpu_idle_apl31_workaround);
73055ba21d4SKonstantin Belousov }
731a5f472c5SKonstantin Belousov SYSINIT(cpu_idle_tun, SI_SUB_CPU, SI_ORDER_MIDDLE, cpu_idle_tun, NULL);
73255ba21d4SKonstantin Belousov 
733295f4b6cSKonstantin Belousov static int panic_on_nmi = 1;
734295f4b6cSKonstantin Belousov SYSCTL_INT(_machdep, OID_AUTO, panic_on_nmi, CTLFLAG_RWTUN,
735295f4b6cSKonstantin Belousov     &panic_on_nmi, 0,
736413ed27cSAndriy Gapon     "Panic on NMI raised by hardware failure");
737835c2787SKonstantin Belousov int nmi_is_broadcast = 1;
738835c2787SKonstantin Belousov SYSCTL_INT(_machdep, OID_AUTO, nmi_is_broadcast, CTLFLAG_RWTUN,
739835c2787SKonstantin Belousov     &nmi_is_broadcast, 0,
740835c2787SKonstantin Belousov     "Chipset NMI is broadcast");
741835c2787SKonstantin Belousov #ifdef KDB
742835c2787SKonstantin Belousov int kdb_on_nmi = 1;
743835c2787SKonstantin Belousov SYSCTL_INT(_machdep, OID_AUTO, kdb_on_nmi, CTLFLAG_RWTUN,
744835c2787SKonstantin Belousov     &kdb_on_nmi, 0,
745413ed27cSAndriy Gapon     "Go to KDB on NMI with unknown source");
746835c2787SKonstantin Belousov #endif
747835c2787SKonstantin Belousov 
748295f4b6cSKonstantin Belousov void
749295f4b6cSKonstantin Belousov nmi_call_kdb(u_int cpu, u_int type, struct trapframe *frame)
750835c2787SKonstantin Belousov {
7510fb3a72aSAndriy Gapon 	bool claimed = false;
752835c2787SKonstantin Belousov 
7530fb3a72aSAndriy Gapon #ifdef DEV_ISA
754835c2787SKonstantin Belousov 	/* machine/parity/power fail/"kitchen sink" faults */
7550fb3a72aSAndriy Gapon 	if (isa_nmi(frame->tf_err)) {
7560fb3a72aSAndriy Gapon 		claimed = true;
7570fb3a72aSAndriy Gapon 		if (panic_on_nmi)
7580fb3a72aSAndriy Gapon 			panic("NMI indicates hardware failure");
7590fb3a72aSAndriy Gapon 	}
7600fb3a72aSAndriy Gapon #endif /* DEV_ISA */
761835c2787SKonstantin Belousov #ifdef KDB
7620fb3a72aSAndriy Gapon 	if (!claimed && kdb_on_nmi) {
763835c2787SKonstantin Belousov 		/*
764835c2787SKonstantin Belousov 		 * NMI can be hooked up to a pushbutton for debugging.
765835c2787SKonstantin Belousov 		 */
766835c2787SKonstantin Belousov 		printf("NMI/cpu%d ... going to debugger\n", cpu);
767835c2787SKonstantin Belousov 		kdb_trap(type, 0, frame);
768835c2787SKonstantin Belousov 	}
769835c2787SKonstantin Belousov #endif /* KDB */
770295f4b6cSKonstantin Belousov }
771835c2787SKonstantin Belousov 
772295f4b6cSKonstantin Belousov void
773295f4b6cSKonstantin Belousov nmi_handle_intr(u_int type, struct trapframe *frame)
774835c2787SKonstantin Belousov {
775835c2787SKonstantin Belousov 
776835c2787SKonstantin Belousov #ifdef SMP
777295f4b6cSKonstantin Belousov 	if (nmi_is_broadcast) {
778295f4b6cSKonstantin Belousov 		nmi_call_kdb_smp(type, frame);
779295f4b6cSKonstantin Belousov 		return;
780295f4b6cSKonstantin Belousov 	}
781835c2787SKonstantin Belousov #endif
7821d6dfd12SKonstantin Belousov 	nmi_call_kdb(PCPU_GET(cpuid), type, frame);
783835c2787SKonstantin Belousov }
784319117fdSKonstantin Belousov 
785319117fdSKonstantin Belousov int hw_ibrs_active;
786319117fdSKonstantin Belousov int hw_ibrs_disable = 1;
787319117fdSKonstantin Belousov 
788319117fdSKonstantin Belousov SYSCTL_INT(_hw, OID_AUTO, ibrs_active, CTLFLAG_RD, &hw_ibrs_active, 0,
789b31b965eSKonstantin Belousov     "Indirect Branch Restricted Speculation active");
790319117fdSKonstantin Belousov 
791319117fdSKonstantin Belousov void
792319117fdSKonstantin Belousov hw_ibrs_recalculate(void)
793319117fdSKonstantin Belousov {
794319117fdSKonstantin Belousov 	uint64_t v;
795319117fdSKonstantin Belousov 
796319117fdSKonstantin Belousov 	if ((cpu_ia32_arch_caps & IA32_ARCH_CAP_IBRS_ALL) != 0) {
797319117fdSKonstantin Belousov 		if (hw_ibrs_disable) {
798319117fdSKonstantin Belousov 			v = rdmsr(MSR_IA32_SPEC_CTRL);
799c688c905SKonstantin Belousov 			v &= ~(uint64_t)IA32_SPEC_CTRL_IBRS;
800319117fdSKonstantin Belousov 			wrmsr(MSR_IA32_SPEC_CTRL, v);
801319117fdSKonstantin Belousov 		} else {
802319117fdSKonstantin Belousov 			v = rdmsr(MSR_IA32_SPEC_CTRL);
803319117fdSKonstantin Belousov 			v |= IA32_SPEC_CTRL_IBRS;
804319117fdSKonstantin Belousov 			wrmsr(MSR_IA32_SPEC_CTRL, v);
805319117fdSKonstantin Belousov 		}
806319117fdSKonstantin Belousov 		return;
807319117fdSKonstantin Belousov 	}
808319117fdSKonstantin Belousov 	hw_ibrs_active = (cpu_stdext_feature3 & CPUID_STDEXT3_IBPB) != 0 &&
809319117fdSKonstantin Belousov 	    !hw_ibrs_disable;
810319117fdSKonstantin Belousov }
811319117fdSKonstantin Belousov 
812319117fdSKonstantin Belousov static int
813319117fdSKonstantin Belousov hw_ibrs_disable_handler(SYSCTL_HANDLER_ARGS)
814319117fdSKonstantin Belousov {
815319117fdSKonstantin Belousov 	int error, val;
816319117fdSKonstantin Belousov 
817319117fdSKonstantin Belousov 	val = hw_ibrs_disable;
818319117fdSKonstantin Belousov 	error = sysctl_handle_int(oidp, &val, 0, req);
819319117fdSKonstantin Belousov 	if (error != 0 || req->newptr == NULL)
820319117fdSKonstantin Belousov 		return (error);
821319117fdSKonstantin Belousov 	hw_ibrs_disable = val != 0;
822319117fdSKonstantin Belousov 	hw_ibrs_recalculate();
823319117fdSKonstantin Belousov 	return (0);
824319117fdSKonstantin Belousov }
825319117fdSKonstantin Belousov SYSCTL_PROC(_hw, OID_AUTO, ibrs_disable, CTLTYPE_INT | CTLFLAG_RWTUN |
826319117fdSKonstantin Belousov     CTLFLAG_NOFETCH | CTLFLAG_MPSAFE, NULL, 0, hw_ibrs_disable_handler, "I",
827b31b965eSKonstantin Belousov     "Disable Indirect Branch Restricted Speculation");
8288fbcc334SKonstantin Belousov 
8293621ba1eSKonstantin Belousov int hw_ssb_active;
8303621ba1eSKonstantin Belousov int hw_ssb_disable;
8313621ba1eSKonstantin Belousov 
8323621ba1eSKonstantin Belousov SYSCTL_INT(_hw, OID_AUTO, spec_store_bypass_disable_active, CTLFLAG_RD,
8333621ba1eSKonstantin Belousov     &hw_ssb_active, 0,
8343621ba1eSKonstantin Belousov     "Speculative Store Bypass Disable active");
8353621ba1eSKonstantin Belousov 
8363621ba1eSKonstantin Belousov static void
8373621ba1eSKonstantin Belousov hw_ssb_set_one(bool enable)
8383621ba1eSKonstantin Belousov {
8393621ba1eSKonstantin Belousov 	uint64_t v;
8403621ba1eSKonstantin Belousov 
8413621ba1eSKonstantin Belousov 	v = rdmsr(MSR_IA32_SPEC_CTRL);
8423621ba1eSKonstantin Belousov 	if (enable)
8433621ba1eSKonstantin Belousov 		v |= (uint64_t)IA32_SPEC_CTRL_SSBD;
8443621ba1eSKonstantin Belousov 	else
8453621ba1eSKonstantin Belousov 		v &= ~(uint64_t)IA32_SPEC_CTRL_SSBD;
8463621ba1eSKonstantin Belousov 	wrmsr(MSR_IA32_SPEC_CTRL, v);
8473621ba1eSKonstantin Belousov }
8483621ba1eSKonstantin Belousov 
8493621ba1eSKonstantin Belousov static void
8503621ba1eSKonstantin Belousov hw_ssb_set(bool enable, bool for_all_cpus)
8513621ba1eSKonstantin Belousov {
8523621ba1eSKonstantin Belousov 	struct thread *td;
8533621ba1eSKonstantin Belousov 	int bound_cpu, i, is_bound;
8543621ba1eSKonstantin Belousov 
8553621ba1eSKonstantin Belousov 	if ((cpu_stdext_feature3 & CPUID_STDEXT3_SSBD) == 0) {
8563621ba1eSKonstantin Belousov 		hw_ssb_active = 0;
8573621ba1eSKonstantin Belousov 		return;
8583621ba1eSKonstantin Belousov 	}
8593621ba1eSKonstantin Belousov 	hw_ssb_active = enable;
8603621ba1eSKonstantin Belousov 	if (for_all_cpus) {
8613621ba1eSKonstantin Belousov 		td = curthread;
8623621ba1eSKonstantin Belousov 		thread_lock(td);
8633621ba1eSKonstantin Belousov 		is_bound = sched_is_bound(td);
8643621ba1eSKonstantin Belousov 		bound_cpu = td->td_oncpu;
8653621ba1eSKonstantin Belousov 		CPU_FOREACH(i) {
8663621ba1eSKonstantin Belousov 			sched_bind(td, i);
8673621ba1eSKonstantin Belousov 			hw_ssb_set_one(enable);
8683621ba1eSKonstantin Belousov 		}
8693621ba1eSKonstantin Belousov 		if (is_bound)
8703621ba1eSKonstantin Belousov 			sched_bind(td, bound_cpu);
8713621ba1eSKonstantin Belousov 		else
8723621ba1eSKonstantin Belousov 			sched_unbind(td);
8733621ba1eSKonstantin Belousov 		thread_unlock(td);
8743621ba1eSKonstantin Belousov 	} else {
8753621ba1eSKonstantin Belousov 		hw_ssb_set_one(enable);
8763621ba1eSKonstantin Belousov 	}
8773621ba1eSKonstantin Belousov }
8783621ba1eSKonstantin Belousov 
8793621ba1eSKonstantin Belousov void
8803621ba1eSKonstantin Belousov hw_ssb_recalculate(bool all_cpus)
8813621ba1eSKonstantin Belousov {
8823621ba1eSKonstantin Belousov 
8833621ba1eSKonstantin Belousov 	switch (hw_ssb_disable) {
8843621ba1eSKonstantin Belousov 	default:
8853621ba1eSKonstantin Belousov 		hw_ssb_disable = 0;
8863621ba1eSKonstantin Belousov 		/* FALLTHROUGH */
8873621ba1eSKonstantin Belousov 	case 0: /* off */
8883621ba1eSKonstantin Belousov 		hw_ssb_set(false, all_cpus);
8893621ba1eSKonstantin Belousov 		break;
8903621ba1eSKonstantin Belousov 	case 1: /* on */
8913621ba1eSKonstantin Belousov 		hw_ssb_set(true, all_cpus);
8923621ba1eSKonstantin Belousov 		break;
8933621ba1eSKonstantin Belousov 	case 2: /* auto */
8943621ba1eSKonstantin Belousov 		hw_ssb_set((cpu_ia32_arch_caps & IA32_ARCH_CAP_SSBD_NO) != 0 ?
8953621ba1eSKonstantin Belousov 		    false : true, all_cpus);
8963621ba1eSKonstantin Belousov 		break;
8973621ba1eSKonstantin Belousov 	}
8983621ba1eSKonstantin Belousov }
8993621ba1eSKonstantin Belousov 
9003621ba1eSKonstantin Belousov static int
9013621ba1eSKonstantin Belousov hw_ssb_disable_handler(SYSCTL_HANDLER_ARGS)
9023621ba1eSKonstantin Belousov {
9033621ba1eSKonstantin Belousov 	int error, val;
9043621ba1eSKonstantin Belousov 
9053621ba1eSKonstantin Belousov 	val = hw_ssb_disable;
9063621ba1eSKonstantin Belousov 	error = sysctl_handle_int(oidp, &val, 0, req);
9073621ba1eSKonstantin Belousov 	if (error != 0 || req->newptr == NULL)
9083621ba1eSKonstantin Belousov 		return (error);
9093621ba1eSKonstantin Belousov 	hw_ssb_disable = val;
9103621ba1eSKonstantin Belousov 	hw_ssb_recalculate(true);
9113621ba1eSKonstantin Belousov 	return (0);
9123621ba1eSKonstantin Belousov }
9133621ba1eSKonstantin Belousov SYSCTL_PROC(_hw, OID_AUTO, spec_store_bypass_disable, CTLTYPE_INT |
9143621ba1eSKonstantin Belousov     CTLFLAG_RWTUN | CTLFLAG_NOFETCH | CTLFLAG_MPSAFE, NULL, 0,
9153621ba1eSKonstantin Belousov     hw_ssb_disable_handler, "I",
9163621ba1eSKonstantin Belousov     "Speculative Store Bypass Disable (0 - off, 1 - on, 2 - auto");
9173621ba1eSKonstantin Belousov 
9188fbcc334SKonstantin Belousov /*
9198fbcc334SKonstantin Belousov  * Enable and restore kernel text write permissions.
9208fbcc334SKonstantin Belousov  * Callers must ensure that disable_wp()/restore_wp() are executed
9218fbcc334SKonstantin Belousov  * without rescheduling on the same core.
9228fbcc334SKonstantin Belousov  */
9238fbcc334SKonstantin Belousov bool
9248fbcc334SKonstantin Belousov disable_wp(void)
9258fbcc334SKonstantin Belousov {
9268fbcc334SKonstantin Belousov 	u_int cr0;
9278fbcc334SKonstantin Belousov 
9288fbcc334SKonstantin Belousov 	cr0 = rcr0();
9298fbcc334SKonstantin Belousov 	if ((cr0 & CR0_WP) == 0)
9308fbcc334SKonstantin Belousov 		return (false);
9318fbcc334SKonstantin Belousov 	load_cr0(cr0 & ~CR0_WP);
9328fbcc334SKonstantin Belousov 	return (true);
9338fbcc334SKonstantin Belousov }
9348fbcc334SKonstantin Belousov 
9358fbcc334SKonstantin Belousov void
9368fbcc334SKonstantin Belousov restore_wp(bool old_wp)
9378fbcc334SKonstantin Belousov {
9388fbcc334SKonstantin Belousov 
9398fbcc334SKonstantin Belousov 	if (old_wp)
9408fbcc334SKonstantin Belousov 		load_cr0(rcr0() | CR0_WP);
9418fbcc334SKonstantin Belousov }
9428fbcc334SKonstantin Belousov 
9437705dd4dSKonstantin Belousov bool
9447705dd4dSKonstantin Belousov acpi_get_fadt_bootflags(uint16_t *flagsp)
9457705dd4dSKonstantin Belousov {
9467705dd4dSKonstantin Belousov #ifdef DEV_ACPI
9477705dd4dSKonstantin Belousov 	ACPI_TABLE_FADT *fadt;
9487705dd4dSKonstantin Belousov 	vm_paddr_t physaddr;
9497705dd4dSKonstantin Belousov 
9507705dd4dSKonstantin Belousov 	physaddr = acpi_find_table(ACPI_SIG_FADT);
9517705dd4dSKonstantin Belousov 	if (physaddr == 0)
9527705dd4dSKonstantin Belousov 		return (false);
9537705dd4dSKonstantin Belousov 	fadt = acpi_map_table(physaddr, ACPI_SIG_FADT);
9547705dd4dSKonstantin Belousov 	if (fadt == NULL)
9557705dd4dSKonstantin Belousov 		return (false);
9567705dd4dSKonstantin Belousov 	*flagsp = fadt->BootFlags;
9577705dd4dSKonstantin Belousov 	acpi_unmap_table(fadt);
9587705dd4dSKonstantin Belousov 	return (true);
9597705dd4dSKonstantin Belousov #else
9607705dd4dSKonstantin Belousov 	return (false);
9617705dd4dSKonstantin Belousov #endif
9627705dd4dSKonstantin Belousov }
963