xref: /freebsd/sys/x86/x86/cpu_machdep.c (revision ece453d5faded062b4a7202a5399fe10417148ef)
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>
647355a02bSKonstantin Belousov #include <sys/domainset.h>
65dfe7b3bfSKonstantin Belousov #include <sys/kdb.h>
66dfe7b3bfSKonstantin Belousov #include <sys/kernel.h>
67dfe7b3bfSKonstantin Belousov #include <sys/ktr.h>
68dfe7b3bfSKonstantin Belousov #include <sys/lock.h>
69dfe7b3bfSKonstantin Belousov #include <sys/malloc.h>
70dfe7b3bfSKonstantin Belousov #include <sys/mutex.h>
71dfe7b3bfSKonstantin Belousov #include <sys/pcpu.h>
72dfe7b3bfSKonstantin Belousov #include <sys/rwlock.h>
73dfe7b3bfSKonstantin Belousov #include <sys/sched.h>
74dfe7b3bfSKonstantin Belousov #include <sys/smp.h>
75dfe7b3bfSKonstantin Belousov #include <sys/sysctl.h>
76dfe7b3bfSKonstantin Belousov 
77dfe7b3bfSKonstantin Belousov #include <machine/clock.h>
78dfe7b3bfSKonstantin Belousov #include <machine/cpu.h>
79652ae7b1SAdam Fenn #include <machine/cpufunc.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
883da25bdbSAndriy Gapon #ifdef CPU_ELAN
893da25bdbSAndriy Gapon #include <machine/elan_mmcr.h>
903da25bdbSAndriy Gapon #endif
91b57a73f8SKonstantin Belousov #include <x86/acpica_machdep.h>
92652ae7b1SAdam Fenn #include <x86/ifunc.h>
93dfe7b3bfSKonstantin Belousov 
94dfe7b3bfSKonstantin Belousov #include <vm/vm.h>
95dfe7b3bfSKonstantin Belousov #include <vm/vm_extern.h>
96dfe7b3bfSKonstantin Belousov #include <vm/vm_kern.h>
97dfe7b3bfSKonstantin Belousov #include <vm/vm_page.h>
98dfe7b3bfSKonstantin Belousov #include <vm/vm_map.h>
99dfe7b3bfSKonstantin Belousov #include <vm/vm_object.h>
100dfe7b3bfSKonstantin Belousov #include <vm/vm_pager.h>
101dfe7b3bfSKonstantin Belousov #include <vm/vm_param.h>
102dfe7b3bfSKonstantin Belousov 
1038428d0f1SAndriy Gapon #include <isa/isareg.h>
1048428d0f1SAndriy Gapon 
1057705dd4dSKonstantin Belousov #include <contrib/dev/acpica/include/acpi.h>
1067705dd4dSKonstantin Belousov 
107d9e8bbb6SKonstantin Belousov #define	STATE_RUNNING	0x0
108d9e8bbb6SKonstantin Belousov #define	STATE_MWAIT	0x1
109d9e8bbb6SKonstantin Belousov #define	STATE_SLEEPING	0x2
110d9e8bbb6SKonstantin Belousov 
1118428d0f1SAndriy Gapon #ifdef SMP
1128428d0f1SAndriy Gapon static u_int	cpu_reset_proxyid;
1138428d0f1SAndriy Gapon static volatile u_int	cpu_reset_proxy_active;
1148428d0f1SAndriy Gapon #endif
1158428d0f1SAndriy Gapon 
116a2495c36SRoger Pau Monné char bootmethod[16];
117a2495c36SRoger Pau Monné SYSCTL_STRING(_machdep, OID_AUTO, bootmethod, CTLFLAG_RD, bootmethod, 0,
118a2495c36SRoger Pau Monné     "System firmware boot method");
119a2495c36SRoger Pau Monné 
120fa83f689SKonstantin Belousov struct msr_op_arg {
121fa83f689SKonstantin Belousov 	u_int msr;
122fa83f689SKonstantin Belousov 	int op;
123fa83f689SKonstantin Belousov 	uint64_t arg1;
124d0bc4b46SKonstantin Belousov 	uint64_t *res;
125fa83f689SKonstantin Belousov };
126fa83f689SKonstantin Belousov 
127fa83f689SKonstantin Belousov static void
128fa83f689SKonstantin Belousov x86_msr_op_one(void *argp)
129fa83f689SKonstantin Belousov {
130fa83f689SKonstantin Belousov 	struct msr_op_arg *a;
131fa83f689SKonstantin Belousov 	uint64_t v;
132fa83f689SKonstantin Belousov 
133fa83f689SKonstantin Belousov 	a = argp;
134fa83f689SKonstantin Belousov 	switch (a->op) {
135fa83f689SKonstantin Belousov 	case MSR_OP_ANDNOT:
136fa83f689SKonstantin Belousov 		v = rdmsr(a->msr);
137fa83f689SKonstantin Belousov 		v &= ~a->arg1;
138fa83f689SKonstantin Belousov 		wrmsr(a->msr, v);
139fa83f689SKonstantin Belousov 		break;
140fa83f689SKonstantin Belousov 	case MSR_OP_OR:
141fa83f689SKonstantin Belousov 		v = rdmsr(a->msr);
142fa83f689SKonstantin Belousov 		v |= a->arg1;
143fa83f689SKonstantin Belousov 		wrmsr(a->msr, v);
144fa83f689SKonstantin Belousov 		break;
145fa83f689SKonstantin Belousov 	case MSR_OP_WRITE:
146fa83f689SKonstantin Belousov 		wrmsr(a->msr, a->arg1);
147fa83f689SKonstantin Belousov 		break;
148d0bc4b46SKonstantin Belousov 	case MSR_OP_READ:
149d0bc4b46SKonstantin Belousov 		v = rdmsr(a->msr);
150d0bc4b46SKonstantin Belousov 		*a->res = v;
151d0bc4b46SKonstantin Belousov 		break;
152fa83f689SKonstantin Belousov 	}
153fa83f689SKonstantin Belousov }
154fa83f689SKonstantin Belousov 
155fa83f689SKonstantin Belousov #define	MSR_OP_EXMODE_MASK	0xf0000000
156fa83f689SKonstantin Belousov #define	MSR_OP_OP_MASK		0x000000ff
157d0bc4b46SKonstantin Belousov #define	MSR_OP_GET_CPUID(x)	(((x) & ~MSR_OP_EXMODE_MASK) >> 8)
158fa83f689SKonstantin Belousov 
159fa83f689SKonstantin Belousov void
160d0bc4b46SKonstantin Belousov x86_msr_op(u_int msr, u_int op, uint64_t arg1, uint64_t *res)
161fa83f689SKonstantin Belousov {
162fa83f689SKonstantin Belousov 	struct thread *td;
163fa83f689SKonstantin Belousov 	struct msr_op_arg a;
164d0bc4b46SKonstantin Belousov 	cpuset_t set;
165fa83f689SKonstantin Belousov 	u_int exmode;
166d0bc4b46SKonstantin Belousov 	int bound_cpu, cpu, i, is_bound;
167fa83f689SKonstantin Belousov 
168fa83f689SKonstantin Belousov 	a.op = op & MSR_OP_OP_MASK;
169fa83f689SKonstantin Belousov 	MPASS(a.op == MSR_OP_ANDNOT || a.op == MSR_OP_OR ||
170d0bc4b46SKonstantin Belousov 	    a.op == MSR_OP_WRITE || a.op == MSR_OP_READ);
171fa83f689SKonstantin Belousov 	exmode = op & MSR_OP_EXMODE_MASK;
172d0bc4b46SKonstantin Belousov 	MPASS(exmode == MSR_OP_LOCAL || exmode == MSR_OP_SCHED_ALL ||
173d0bc4b46SKonstantin Belousov 	    exmode == MSR_OP_SCHED_ONE || exmode == MSR_OP_RENDEZVOUS_ALL ||
174d0bc4b46SKonstantin Belousov 	    exmode == MSR_OP_RENDEZVOUS_ONE);
175fa83f689SKonstantin Belousov 	a.msr = msr;
176fa83f689SKonstantin Belousov 	a.arg1 = arg1;
177d0bc4b46SKonstantin Belousov 	a.res = res;
178fa83f689SKonstantin Belousov 	switch (exmode) {
179fa83f689SKonstantin Belousov 	case MSR_OP_LOCAL:
180fa83f689SKonstantin Belousov 		x86_msr_op_one(&a);
181fa83f689SKonstantin Belousov 		break;
182d0bc4b46SKonstantin Belousov 	case MSR_OP_SCHED_ALL:
183fa83f689SKonstantin Belousov 		td = curthread;
184fa83f689SKonstantin Belousov 		thread_lock(td);
185fa83f689SKonstantin Belousov 		is_bound = sched_is_bound(td);
186fa83f689SKonstantin Belousov 		bound_cpu = td->td_oncpu;
187fa83f689SKonstantin Belousov 		CPU_FOREACH(i) {
188fa83f689SKonstantin Belousov 			sched_bind(td, i);
189fa83f689SKonstantin Belousov 			x86_msr_op_one(&a);
190fa83f689SKonstantin Belousov 		}
191fa83f689SKonstantin Belousov 		if (is_bound)
192fa83f689SKonstantin Belousov 			sched_bind(td, bound_cpu);
193fa83f689SKonstantin Belousov 		else
194fa83f689SKonstantin Belousov 			sched_unbind(td);
195fa83f689SKonstantin Belousov 		thread_unlock(td);
196fa83f689SKonstantin Belousov 		break;
197d0bc4b46SKonstantin Belousov 	case MSR_OP_SCHED_ONE:
198d0bc4b46SKonstantin Belousov 		td = curthread;
199d0bc4b46SKonstantin Belousov 		cpu = MSR_OP_GET_CPUID(op);
200d0bc4b46SKonstantin Belousov 		thread_lock(td);
201d0bc4b46SKonstantin Belousov 		is_bound = sched_is_bound(td);
202d0bc4b46SKonstantin Belousov 		bound_cpu = td->td_oncpu;
203d0bc4b46SKonstantin Belousov 		if (!is_bound || bound_cpu != cpu)
204d0bc4b46SKonstantin Belousov 			sched_bind(td, cpu);
205d0bc4b46SKonstantin Belousov 		x86_msr_op_one(&a);
206d0bc4b46SKonstantin Belousov 		if (is_bound) {
207d0bc4b46SKonstantin Belousov 			if (bound_cpu != cpu)
208d0bc4b46SKonstantin Belousov 				sched_bind(td, bound_cpu);
209d0bc4b46SKonstantin Belousov 		} else {
210d0bc4b46SKonstantin Belousov 			sched_unbind(td);
211d0bc4b46SKonstantin Belousov 		}
212d0bc4b46SKonstantin Belousov 		thread_unlock(td);
213d0bc4b46SKonstantin Belousov 		break;
214d0bc4b46SKonstantin Belousov 	case MSR_OP_RENDEZVOUS_ALL:
215d0bc4b46SKonstantin Belousov 		smp_rendezvous(smp_no_rendezvous_barrier, x86_msr_op_one,
216d0bc4b46SKonstantin Belousov 		    smp_no_rendezvous_barrier, &a);
217d0bc4b46SKonstantin Belousov 		break;
218d0bc4b46SKonstantin Belousov 	case MSR_OP_RENDEZVOUS_ONE:
219d0bc4b46SKonstantin Belousov 		cpu = MSR_OP_GET_CPUID(op);
220d0bc4b46SKonstantin Belousov 		CPU_SETOF(cpu, &set);
221d0bc4b46SKonstantin Belousov 		smp_rendezvous_cpus(set, smp_no_rendezvous_barrier,
222d0bc4b46SKonstantin Belousov 		    x86_msr_op_one, smp_no_rendezvous_barrier, &a);
223fa83f689SKonstantin Belousov 		break;
224fa83f689SKonstantin Belousov 	}
225fa83f689SKonstantin Belousov }
226fa83f689SKonstantin Belousov 
227665919aaSConrad Meyer /*
228665919aaSConrad Meyer  * Automatically initialized per CPU errata in cpu_idle_tun below.
229665919aaSConrad Meyer  */
230665919aaSConrad Meyer bool mwait_cpustop_broken = false;
231665919aaSConrad Meyer SYSCTL_BOOL(_machdep, OID_AUTO, mwait_cpustop_broken, CTLFLAG_RDTUN,
232665919aaSConrad Meyer     &mwait_cpustop_broken, 0,
233665919aaSConrad Meyer     "Can not reliably wake MONITOR/MWAIT cpus without interrupts");
2348428d0f1SAndriy Gapon 
235dfe7b3bfSKonstantin Belousov /*
236dfe7b3bfSKonstantin Belousov  * Flush the D-cache for non-DMA I/O so that the I-cache can
237dfe7b3bfSKonstantin Belousov  * be made coherent later.
238dfe7b3bfSKonstantin Belousov  */
239dfe7b3bfSKonstantin Belousov void
240dfe7b3bfSKonstantin Belousov cpu_flush_dcache(void *ptr, size_t len)
241dfe7b3bfSKonstantin Belousov {
242dfe7b3bfSKonstantin Belousov 	/* Not applicable */
243dfe7b3bfSKonstantin Belousov }
244dfe7b3bfSKonstantin Belousov 
245b57a73f8SKonstantin Belousov void
246b57a73f8SKonstantin Belousov acpi_cpu_c1(void)
247b57a73f8SKonstantin Belousov {
248b57a73f8SKonstantin Belousov 
249b57a73f8SKonstantin Belousov 	__asm __volatile("sti; hlt");
250b57a73f8SKonstantin Belousov }
251b57a73f8SKonstantin Belousov 
25219d4720bSJonathan T. Looney /*
25319d4720bSJonathan T. Looney  * Use mwait to pause execution while waiting for an interrupt or
25419d4720bSJonathan T. Looney  * another thread to signal that there is more work.
25519d4720bSJonathan T. Looney  *
25619d4720bSJonathan T. Looney  * NOTE: Interrupts will cause a wakeup; however, this function does
25719d4720bSJonathan T. Looney  * not enable interrupt handling. The caller is responsible to enable
25819d4720bSJonathan T. Looney  * interrupts.
25919d4720bSJonathan T. Looney  */
260b57a73f8SKonstantin Belousov void
261b57a73f8SKonstantin Belousov acpi_cpu_idle_mwait(uint32_t mwait_hint)
262b57a73f8SKonstantin Belousov {
263b57a73f8SKonstantin Belousov 	int *state;
2643621ba1eSKonstantin Belousov 	uint64_t v;
265b57a73f8SKonstantin Belousov 
266b57a73f8SKonstantin Belousov 	/*
267319117fdSKonstantin Belousov 	 * A comment in Linux patch claims that 'CPUs run faster with
268319117fdSKonstantin Belousov 	 * speculation protection disabled. All CPU threads in a core
269319117fdSKonstantin Belousov 	 * must disable speculation protection for it to be
270319117fdSKonstantin Belousov 	 * disabled. Disable it while we are idle so the other
271319117fdSKonstantin Belousov 	 * hyperthread can run fast.'
272319117fdSKonstantin Belousov 	 *
273b57a73f8SKonstantin Belousov 	 * XXXKIB.  Software coordination mode should be supported,
274b57a73f8SKonstantin Belousov 	 * but all Intel CPUs provide hardware coordination.
275b57a73f8SKonstantin Belousov 	 */
276d9e8bbb6SKonstantin Belousov 
27783dc49beSConrad Meyer 	state = &PCPU_PTR(monitorbuf)->idle_state;
278a5bd21d0SKonstantin Belousov 	KASSERT(atomic_load_int(state) == STATE_SLEEPING,
279d9e8bbb6SKonstantin Belousov 	    ("cpu_mwait_cx: wrong monitorbuf state"));
280a5bd21d0SKonstantin Belousov 	atomic_store_int(state, STATE_MWAIT);
2813621ba1eSKonstantin Belousov 	if (PCPU_GET(ibpb_set) || hw_ssb_active) {
2823621ba1eSKonstantin Belousov 		v = rdmsr(MSR_IA32_SPEC_CTRL);
2833621ba1eSKonstantin Belousov 		wrmsr(MSR_IA32_SPEC_CTRL, v & ~(IA32_SPEC_CTRL_IBRS |
2843621ba1eSKonstantin Belousov 		    IA32_SPEC_CTRL_STIBP | IA32_SPEC_CTRL_SSBD));
2853621ba1eSKonstantin Belousov 	} else {
2863621ba1eSKonstantin Belousov 		v = 0;
2873621ba1eSKonstantin Belousov 	}
288b57a73f8SKonstantin Belousov 	cpu_monitor(state, 0, 0);
289a5bd21d0SKonstantin Belousov 	if (atomic_load_int(state) == STATE_MWAIT)
290b57a73f8SKonstantin Belousov 		cpu_mwait(MWAIT_INTRBREAK, mwait_hint);
2913621ba1eSKonstantin Belousov 
2923621ba1eSKonstantin Belousov 	/*
2933621ba1eSKonstantin Belousov 	 * SSB cannot be disabled while we sleep, or rather, if it was
2943621ba1eSKonstantin Belousov 	 * disabled, the sysctl thread will bind to our cpu to tweak
2953621ba1eSKonstantin Belousov 	 * MSR.
2963621ba1eSKonstantin Belousov 	 */
2973621ba1eSKonstantin Belousov 	if (v != 0)
2983621ba1eSKonstantin Belousov 		wrmsr(MSR_IA32_SPEC_CTRL, v);
299d9e8bbb6SKonstantin Belousov 
300d9e8bbb6SKonstantin Belousov 	/*
301d9e8bbb6SKonstantin Belousov 	 * We should exit on any event that interrupts mwait, because
302d9e8bbb6SKonstantin Belousov 	 * that event might be a wanted interrupt.
303d9e8bbb6SKonstantin Belousov 	 */
304a5bd21d0SKonstantin Belousov 	atomic_store_int(state, STATE_RUNNING);
305b57a73f8SKonstantin Belousov }
306b57a73f8SKonstantin Belousov 
307dfe7b3bfSKonstantin Belousov /* Get current clock frequency for the given cpu id. */
308dfe7b3bfSKonstantin Belousov int
309dfe7b3bfSKonstantin Belousov cpu_est_clockrate(int cpu_id, uint64_t *rate)
310dfe7b3bfSKonstantin Belousov {
311dfe7b3bfSKonstantin Belousov 	uint64_t tsc1, tsc2;
312dfe7b3bfSKonstantin Belousov 	uint64_t acnt, mcnt, perf;
313dfe7b3bfSKonstantin Belousov 	register_t reg;
314dfe7b3bfSKonstantin Belousov 
315dfe7b3bfSKonstantin Belousov 	if (pcpu_find(cpu_id) == NULL || rate == NULL)
316dfe7b3bfSKonstantin Belousov 		return (EINVAL);
317dfe7b3bfSKonstantin Belousov #ifdef __i386__
318dfe7b3bfSKonstantin Belousov 	if ((cpu_feature & CPUID_TSC) == 0)
319dfe7b3bfSKonstantin Belousov 		return (EOPNOTSUPP);
320dfe7b3bfSKonstantin Belousov #endif
321dfe7b3bfSKonstantin Belousov 
322dfe7b3bfSKonstantin Belousov 	/*
323dfe7b3bfSKonstantin Belousov 	 * If TSC is P-state invariant and APERF/MPERF MSRs do not exist,
324dfe7b3bfSKonstantin Belousov 	 * DELAY(9) based logic fails.
325dfe7b3bfSKonstantin Belousov 	 */
326dfe7b3bfSKonstantin Belousov 	if (tsc_is_invariant && !tsc_perf_stat)
327dfe7b3bfSKonstantin Belousov 		return (EOPNOTSUPP);
328dfe7b3bfSKonstantin Belousov 
329dfe7b3bfSKonstantin Belousov #ifdef SMP
330dfe7b3bfSKonstantin Belousov 	if (smp_cpus > 1) {
331dfe7b3bfSKonstantin Belousov 		/* Schedule ourselves on the indicated cpu. */
332dfe7b3bfSKonstantin Belousov 		thread_lock(curthread);
333dfe7b3bfSKonstantin Belousov 		sched_bind(curthread, cpu_id);
334dfe7b3bfSKonstantin Belousov 		thread_unlock(curthread);
335dfe7b3bfSKonstantin Belousov 	}
336dfe7b3bfSKonstantin Belousov #endif
337dfe7b3bfSKonstantin Belousov 
338dfe7b3bfSKonstantin Belousov 	/* Calibrate by measuring a short delay. */
339dfe7b3bfSKonstantin Belousov 	reg = intr_disable();
340dfe7b3bfSKonstantin Belousov 	if (tsc_is_invariant) {
341dfe7b3bfSKonstantin Belousov 		wrmsr(MSR_MPERF, 0);
342dfe7b3bfSKonstantin Belousov 		wrmsr(MSR_APERF, 0);
343dfe7b3bfSKonstantin Belousov 		tsc1 = rdtsc();
344dfe7b3bfSKonstantin Belousov 		DELAY(1000);
345dfe7b3bfSKonstantin Belousov 		mcnt = rdmsr(MSR_MPERF);
346dfe7b3bfSKonstantin Belousov 		acnt = rdmsr(MSR_APERF);
347dfe7b3bfSKonstantin Belousov 		tsc2 = rdtsc();
348dfe7b3bfSKonstantin Belousov 		intr_restore(reg);
349dfe7b3bfSKonstantin Belousov 		perf = 1000 * acnt / mcnt;
350dfe7b3bfSKonstantin Belousov 		*rate = (tsc2 - tsc1) * perf;
351dfe7b3bfSKonstantin Belousov 	} else {
352dfe7b3bfSKonstantin Belousov 		tsc1 = rdtsc();
353dfe7b3bfSKonstantin Belousov 		DELAY(1000);
354dfe7b3bfSKonstantin Belousov 		tsc2 = rdtsc();
355dfe7b3bfSKonstantin Belousov 		intr_restore(reg);
356dfe7b3bfSKonstantin Belousov 		*rate = (tsc2 - tsc1) * 1000;
357dfe7b3bfSKonstantin Belousov 	}
358dfe7b3bfSKonstantin Belousov 
359dfe7b3bfSKonstantin Belousov #ifdef SMP
360dfe7b3bfSKonstantin Belousov 	if (smp_cpus > 1) {
361dfe7b3bfSKonstantin Belousov 		thread_lock(curthread);
362dfe7b3bfSKonstantin Belousov 		sched_unbind(curthread);
363dfe7b3bfSKonstantin Belousov 		thread_unlock(curthread);
364dfe7b3bfSKonstantin Belousov 	}
365dfe7b3bfSKonstantin Belousov #endif
366dfe7b3bfSKonstantin Belousov 
367dfe7b3bfSKonstantin Belousov 	return (0);
368dfe7b3bfSKonstantin Belousov }
369dfe7b3bfSKonstantin Belousov 
370dfe7b3bfSKonstantin Belousov /*
371dfe7b3bfSKonstantin Belousov  * Shutdown the CPU as much as possible
372dfe7b3bfSKonstantin Belousov  */
373dfe7b3bfSKonstantin Belousov void
374dfe7b3bfSKonstantin Belousov cpu_halt(void)
375dfe7b3bfSKonstantin Belousov {
376dfe7b3bfSKonstantin Belousov 	for (;;)
377dfe7b3bfSKonstantin Belousov 		halt();
378dfe7b3bfSKonstantin Belousov }
379dfe7b3bfSKonstantin Belousov 
3808428d0f1SAndriy Gapon static void
381b7b25af0SAndriy Gapon cpu_reset_real(void)
3828428d0f1SAndriy Gapon {
3838428d0f1SAndriy Gapon 	struct region_descriptor null_idt;
3848428d0f1SAndriy Gapon 	int b;
3858428d0f1SAndriy Gapon 
3868428d0f1SAndriy Gapon 	disable_intr();
3878428d0f1SAndriy Gapon #ifdef CPU_ELAN
3888428d0f1SAndriy Gapon 	if (elan_mmcr != NULL)
3898428d0f1SAndriy Gapon 		elan_mmcr->RESCFG = 1;
3908428d0f1SAndriy Gapon #endif
3918428d0f1SAndriy Gapon #ifdef __i386__
3928428d0f1SAndriy Gapon 	if (cpu == CPU_GEODE1100) {
3938428d0f1SAndriy Gapon 		/* Attempt Geode's own reset */
3948428d0f1SAndriy Gapon 		outl(0xcf8, 0x80009044ul);
3958428d0f1SAndriy Gapon 		outl(0xcfc, 0xf);
3968428d0f1SAndriy Gapon 	}
3978428d0f1SAndriy Gapon #endif
3988428d0f1SAndriy Gapon #if !defined(BROKEN_KEYBOARD_RESET)
3998428d0f1SAndriy Gapon 	/*
4008428d0f1SAndriy Gapon 	 * Attempt to do a CPU reset via the keyboard controller,
4018428d0f1SAndriy Gapon 	 * do not turn off GateA20, as any machine that fails
4028428d0f1SAndriy Gapon 	 * to do the reset here would then end up in no man's land.
4038428d0f1SAndriy Gapon 	 */
4048428d0f1SAndriy Gapon 	outb(IO_KBD + 4, 0xFE);
4058428d0f1SAndriy Gapon 	DELAY(500000);	/* wait 0.5 sec to see if that did it */
4068428d0f1SAndriy Gapon #endif
4078428d0f1SAndriy Gapon 
4088428d0f1SAndriy Gapon 	/*
4098428d0f1SAndriy Gapon 	 * Attempt to force a reset via the Reset Control register at
4108428d0f1SAndriy Gapon 	 * I/O port 0xcf9.  Bit 2 forces a system reset when it
4118428d0f1SAndriy Gapon 	 * transitions from 0 to 1.  Bit 1 selects the type of reset
4128428d0f1SAndriy Gapon 	 * to attempt: 0 selects a "soft" reset, and 1 selects a
4138428d0f1SAndriy Gapon 	 * "hard" reset.  We try a "hard" reset.  The first write sets
4148428d0f1SAndriy Gapon 	 * bit 1 to select a "hard" reset and clears bit 2.  The
4158428d0f1SAndriy Gapon 	 * second write forces a 0 -> 1 transition in bit 2 to trigger
4168428d0f1SAndriy Gapon 	 * a reset.
4178428d0f1SAndriy Gapon 	 */
4188428d0f1SAndriy Gapon 	outb(0xcf9, 0x2);
4198428d0f1SAndriy Gapon 	outb(0xcf9, 0x6);
4208428d0f1SAndriy Gapon 	DELAY(500000);  /* wait 0.5 sec to see if that did it */
4218428d0f1SAndriy Gapon 
4228428d0f1SAndriy Gapon 	/*
4238428d0f1SAndriy Gapon 	 * Attempt to force a reset via the Fast A20 and Init register
4248428d0f1SAndriy Gapon 	 * at I/O port 0x92.  Bit 1 serves as an alternate A20 gate.
4258428d0f1SAndriy Gapon 	 * Bit 0 asserts INIT# when set to 1.  We are careful to only
4268428d0f1SAndriy Gapon 	 * preserve bit 1 while setting bit 0.  We also must clear bit
4278428d0f1SAndriy Gapon 	 * 0 before setting it if it isn't already clear.
4288428d0f1SAndriy Gapon 	 */
4298428d0f1SAndriy Gapon 	b = inb(0x92);
4308428d0f1SAndriy Gapon 	if (b != 0xff) {
4318428d0f1SAndriy Gapon 		if ((b & 0x1) != 0)
4328428d0f1SAndriy Gapon 			outb(0x92, b & 0xfe);
4338428d0f1SAndriy Gapon 		outb(0x92, b | 0x1);
4348428d0f1SAndriy Gapon 		DELAY(500000);  /* wait 0.5 sec to see if that did it */
4358428d0f1SAndriy Gapon 	}
4368428d0f1SAndriy Gapon 
4378428d0f1SAndriy Gapon 	printf("No known reset method worked, attempting CPU shutdown\n");
4388428d0f1SAndriy Gapon 	DELAY(1000000); /* wait 1 sec for printf to complete */
4398428d0f1SAndriy Gapon 
4408428d0f1SAndriy Gapon 	/* Wipe the IDT. */
4418428d0f1SAndriy Gapon 	null_idt.rd_limit = 0;
4428428d0f1SAndriy Gapon 	null_idt.rd_base = 0;
4438428d0f1SAndriy Gapon 	lidt(&null_idt);
4448428d0f1SAndriy Gapon 
4458428d0f1SAndriy Gapon 	/* "good night, sweet prince .... <THUNK!>" */
4468428d0f1SAndriy Gapon 	breakpoint();
4478428d0f1SAndriy Gapon 
4488428d0f1SAndriy Gapon 	/* NOTREACHED */
4498428d0f1SAndriy Gapon 	while(1);
4508428d0f1SAndriy Gapon }
4518428d0f1SAndriy Gapon 
4528428d0f1SAndriy Gapon #ifdef SMP
4538428d0f1SAndriy Gapon static void
454b7b25af0SAndriy Gapon cpu_reset_proxy(void)
4558428d0f1SAndriy Gapon {
4568428d0f1SAndriy Gapon 
4578428d0f1SAndriy Gapon 	cpu_reset_proxy_active = 1;
4588428d0f1SAndriy Gapon 	while (cpu_reset_proxy_active == 1)
4598428d0f1SAndriy Gapon 		ia32_pause(); /* Wait for other cpu to see that we've started */
4608428d0f1SAndriy Gapon 
4618428d0f1SAndriy Gapon 	printf("cpu_reset_proxy: Stopped CPU %d\n", cpu_reset_proxyid);
4628428d0f1SAndriy Gapon 	DELAY(1000000);
4638428d0f1SAndriy Gapon 	cpu_reset_real();
4648428d0f1SAndriy Gapon }
4658428d0f1SAndriy Gapon #endif
4668428d0f1SAndriy Gapon 
4678428d0f1SAndriy Gapon void
468b7b25af0SAndriy Gapon cpu_reset(void)
4698428d0f1SAndriy Gapon {
4708428d0f1SAndriy Gapon #ifdef SMP
471665919aaSConrad Meyer 	struct monitorbuf *mb;
4728428d0f1SAndriy Gapon 	cpuset_t map;
4738428d0f1SAndriy Gapon 	u_int cnt;
4748428d0f1SAndriy Gapon 
4758428d0f1SAndriy Gapon 	if (smp_started) {
4768428d0f1SAndriy Gapon 		map = all_cpus;
4778428d0f1SAndriy Gapon 		CPU_CLR(PCPU_GET(cpuid), &map);
478e2650af1SStefan Eßer 		CPU_ANDNOT(&map, &map, &stopped_cpus);
4798428d0f1SAndriy Gapon 		if (!CPU_EMPTY(&map)) {
4808428d0f1SAndriy Gapon 			printf("cpu_reset: Stopping other CPUs\n");
4818428d0f1SAndriy Gapon 			stop_cpus(map);
4828428d0f1SAndriy Gapon 		}
4838428d0f1SAndriy Gapon 
4848428d0f1SAndriy Gapon 		if (PCPU_GET(cpuid) != 0) {
4858428d0f1SAndriy Gapon 			cpu_reset_proxyid = PCPU_GET(cpuid);
4868428d0f1SAndriy Gapon 			cpustop_restartfunc = cpu_reset_proxy;
4878428d0f1SAndriy Gapon 			cpu_reset_proxy_active = 0;
4888428d0f1SAndriy Gapon 			printf("cpu_reset: Restarting BSP\n");
4898428d0f1SAndriy Gapon 
4908428d0f1SAndriy Gapon 			/* Restart CPU #0. */
4918428d0f1SAndriy Gapon 			CPU_SETOF(0, &started_cpus);
492665919aaSConrad Meyer 			mb = &pcpu_find(0)->pc_monitorbuf;
493665919aaSConrad Meyer 			atomic_store_int(&mb->stop_state,
494665919aaSConrad Meyer 			    MONITOR_STOPSTATE_RUNNING);
4958428d0f1SAndriy Gapon 
4968428d0f1SAndriy Gapon 			cnt = 0;
4978428d0f1SAndriy Gapon 			while (cpu_reset_proxy_active == 0 && cnt < 10000000) {
4988428d0f1SAndriy Gapon 				ia32_pause();
4998428d0f1SAndriy Gapon 				cnt++;	/* Wait for BSP to announce restart */
5008428d0f1SAndriy Gapon 			}
5018428d0f1SAndriy Gapon 			if (cpu_reset_proxy_active == 0) {
5028428d0f1SAndriy Gapon 				printf("cpu_reset: Failed to restart BSP\n");
5038428d0f1SAndriy Gapon 			} else {
5048428d0f1SAndriy Gapon 				cpu_reset_proxy_active = 2;
5058428d0f1SAndriy Gapon 				while (1)
5068428d0f1SAndriy Gapon 					ia32_pause();
5078428d0f1SAndriy Gapon 				/* NOTREACHED */
5088428d0f1SAndriy Gapon 			}
5098428d0f1SAndriy Gapon 		}
5108428d0f1SAndriy Gapon 
5118428d0f1SAndriy Gapon 		DELAY(1000000);
5128428d0f1SAndriy Gapon 	}
5138428d0f1SAndriy Gapon #endif
5148428d0f1SAndriy Gapon 	cpu_reset_real();
5158428d0f1SAndriy Gapon 	/* NOTREACHED */
5168428d0f1SAndriy Gapon }
5178428d0f1SAndriy Gapon 
518b57a73f8SKonstantin Belousov bool
519b57a73f8SKonstantin Belousov cpu_mwait_usable(void)
520b57a73f8SKonstantin Belousov {
521b57a73f8SKonstantin Belousov 
522b57a73f8SKonstantin Belousov 	return ((cpu_feature2 & CPUID2_MON) != 0 && ((cpu_mon_mwait_flags &
523b57a73f8SKonstantin Belousov 	    (CPUID5_MON_MWAIT_EXT | CPUID5_MWAIT_INTRBREAK)) ==
524b57a73f8SKonstantin Belousov 	    (CPUID5_MON_MWAIT_EXT | CPUID5_MWAIT_INTRBREAK)));
525b57a73f8SKonstantin Belousov }
526b57a73f8SKonstantin Belousov 
527dfe7b3bfSKonstantin Belousov void (*cpu_idle_hook)(sbintime_t) = NULL;	/* ACPI idle hook. */
528d3ba71b2SKonstantin Belousov 
529d3ba71b2SKonstantin Belousov int cpu_amdc1e_bug = 0;			/* AMD C1E APIC workaround required. */
530d3ba71b2SKonstantin Belousov 
531dfe7b3bfSKonstantin Belousov static int	idle_mwait = 1;		/* Use MONITOR/MWAIT for short idle. */
532dfe7b3bfSKonstantin Belousov SYSCTL_INT(_machdep, OID_AUTO, idle_mwait, CTLFLAG_RWTUN, &idle_mwait,
533dfe7b3bfSKonstantin Belousov     0, "Use MONITOR/MWAIT for short idle");
534dfe7b3bfSKonstantin Belousov 
535dfe7b3bfSKonstantin Belousov static void
536dfe7b3bfSKonstantin Belousov cpu_idle_acpi(sbintime_t sbt)
537dfe7b3bfSKonstantin Belousov {
538dfe7b3bfSKonstantin Belousov 	int *state;
539dfe7b3bfSKonstantin Belousov 
54083dc49beSConrad Meyer 	state = &PCPU_PTR(monitorbuf)->idle_state;
541a5bd21d0SKonstantin Belousov 	atomic_store_int(state, STATE_SLEEPING);
542dfe7b3bfSKonstantin Belousov 
543dfe7b3bfSKonstantin Belousov 	/* See comments in cpu_idle_hlt(). */
544dfe7b3bfSKonstantin Belousov 	disable_intr();
545dfe7b3bfSKonstantin Belousov 	if (sched_runnable())
546dfe7b3bfSKonstantin Belousov 		enable_intr();
547dfe7b3bfSKonstantin Belousov 	else if (cpu_idle_hook)
548dfe7b3bfSKonstantin Belousov 		cpu_idle_hook(sbt);
549dfe7b3bfSKonstantin Belousov 	else
550b57a73f8SKonstantin Belousov 		acpi_cpu_c1();
551a5bd21d0SKonstantin Belousov 	atomic_store_int(state, STATE_RUNNING);
552dfe7b3bfSKonstantin Belousov }
553dfe7b3bfSKonstantin Belousov 
554dfe7b3bfSKonstantin Belousov static void
555dfe7b3bfSKonstantin Belousov cpu_idle_hlt(sbintime_t sbt)
556dfe7b3bfSKonstantin Belousov {
557dfe7b3bfSKonstantin Belousov 	int *state;
558dfe7b3bfSKonstantin Belousov 
55983dc49beSConrad Meyer 	state = &PCPU_PTR(monitorbuf)->idle_state;
560a5bd21d0SKonstantin Belousov 	atomic_store_int(state, STATE_SLEEPING);
561dfe7b3bfSKonstantin Belousov 
562dfe7b3bfSKonstantin Belousov 	/*
563dfe7b3bfSKonstantin Belousov 	 * Since we may be in a critical section from cpu_idle(), if
564dfe7b3bfSKonstantin Belousov 	 * an interrupt fires during that critical section we may have
565dfe7b3bfSKonstantin Belousov 	 * a pending preemption.  If the CPU halts, then that thread
566dfe7b3bfSKonstantin Belousov 	 * may not execute until a later interrupt awakens the CPU.
567dfe7b3bfSKonstantin Belousov 	 * To handle this race, check for a runnable thread after
568dfe7b3bfSKonstantin Belousov 	 * disabling interrupts and immediately return if one is
569dfe7b3bfSKonstantin Belousov 	 * found.  Also, we must absolutely guarentee that hlt is
570dfe7b3bfSKonstantin Belousov 	 * the next instruction after sti.  This ensures that any
571dfe7b3bfSKonstantin Belousov 	 * interrupt that fires after the call to disable_intr() will
572dfe7b3bfSKonstantin Belousov 	 * immediately awaken the CPU from hlt.  Finally, please note
573dfe7b3bfSKonstantin Belousov 	 * that on x86 this works fine because of interrupts enabled only
574dfe7b3bfSKonstantin Belousov 	 * after the instruction following sti takes place, while IF is set
575dfe7b3bfSKonstantin Belousov 	 * to 1 immediately, allowing hlt instruction to acknowledge the
576dfe7b3bfSKonstantin Belousov 	 * interrupt.
577dfe7b3bfSKonstantin Belousov 	 */
578dfe7b3bfSKonstantin Belousov 	disable_intr();
579dfe7b3bfSKonstantin Belousov 	if (sched_runnable())
580dfe7b3bfSKonstantin Belousov 		enable_intr();
581dfe7b3bfSKonstantin Belousov 	else
582b57a73f8SKonstantin Belousov 		acpi_cpu_c1();
583a5bd21d0SKonstantin Belousov 	atomic_store_int(state, STATE_RUNNING);
584dfe7b3bfSKonstantin Belousov }
585dfe7b3bfSKonstantin Belousov 
586dfe7b3bfSKonstantin Belousov static void
587dfe7b3bfSKonstantin Belousov cpu_idle_mwait(sbintime_t sbt)
588dfe7b3bfSKonstantin Belousov {
589dfe7b3bfSKonstantin Belousov 	int *state;
590dfe7b3bfSKonstantin Belousov 
59183dc49beSConrad Meyer 	state = &PCPU_PTR(monitorbuf)->idle_state;
592a5bd21d0SKonstantin Belousov 	atomic_store_int(state, STATE_MWAIT);
593dfe7b3bfSKonstantin Belousov 
594dfe7b3bfSKonstantin Belousov 	/* See comments in cpu_idle_hlt(). */
595dfe7b3bfSKonstantin Belousov 	disable_intr();
596dfe7b3bfSKonstantin Belousov 	if (sched_runnable()) {
597a5bd21d0SKonstantin Belousov 		atomic_store_int(state, STATE_RUNNING);
598dfe7b3bfSKonstantin Belousov 		enable_intr();
599dfe7b3bfSKonstantin Belousov 		return;
600dfe7b3bfSKonstantin Belousov 	}
601a5bd21d0SKonstantin Belousov 
602dfe7b3bfSKonstantin Belousov 	cpu_monitor(state, 0, 0);
603a5bd21d0SKonstantin Belousov 	if (atomic_load_int(state) == STATE_MWAIT)
604dfe7b3bfSKonstantin Belousov 		__asm __volatile("sti; mwait" : : "a" (MWAIT_C1), "c" (0));
605dfe7b3bfSKonstantin Belousov 	else
606dfe7b3bfSKonstantin Belousov 		enable_intr();
607a5bd21d0SKonstantin Belousov 	atomic_store_int(state, STATE_RUNNING);
608dfe7b3bfSKonstantin Belousov }
609dfe7b3bfSKonstantin Belousov 
610dfe7b3bfSKonstantin Belousov static void
611dfe7b3bfSKonstantin Belousov cpu_idle_spin(sbintime_t sbt)
612dfe7b3bfSKonstantin Belousov {
613dfe7b3bfSKonstantin Belousov 	int *state;
614dfe7b3bfSKonstantin Belousov 	int i;
615dfe7b3bfSKonstantin Belousov 
61683dc49beSConrad Meyer 	state = &PCPU_PTR(monitorbuf)->idle_state;
617a5bd21d0SKonstantin Belousov 	atomic_store_int(state, STATE_RUNNING);
618dfe7b3bfSKonstantin Belousov 
619dfe7b3bfSKonstantin Belousov 	/*
620dfe7b3bfSKonstantin Belousov 	 * The sched_runnable() call is racy but as long as there is
621dfe7b3bfSKonstantin Belousov 	 * a loop missing it one time will have just a little impact if any
622dfe7b3bfSKonstantin Belousov 	 * (and it is much better than missing the check at all).
623dfe7b3bfSKonstantin Belousov 	 */
624dfe7b3bfSKonstantin Belousov 	for (i = 0; i < 1000; i++) {
625dfe7b3bfSKonstantin Belousov 		if (sched_runnable())
626dfe7b3bfSKonstantin Belousov 			return;
627dfe7b3bfSKonstantin Belousov 		cpu_spinwait();
628dfe7b3bfSKonstantin Belousov 	}
629dfe7b3bfSKonstantin Belousov }
630dfe7b3bfSKonstantin Belousov 
631dfe7b3bfSKonstantin Belousov void (*cpu_idle_fn)(sbintime_t) = cpu_idle_acpi;
632dfe7b3bfSKonstantin Belousov 
633dfe7b3bfSKonstantin Belousov void
634dfe7b3bfSKonstantin Belousov cpu_idle(int busy)
635dfe7b3bfSKonstantin Belousov {
636dfe7b3bfSKonstantin Belousov 	uint64_t msr;
637dfe7b3bfSKonstantin Belousov 	sbintime_t sbt = -1;
638dfe7b3bfSKonstantin Belousov 
639*ece453d5SMark Johnston 	CTR1(KTR_SPARE2, "cpu_idle(%d)", busy);
640ed95805eSJohn Baldwin #ifdef MP_WATCHDOG
641dfe7b3bfSKonstantin Belousov 	ap_watchdog(PCPU_GET(cpuid));
642dfe7b3bfSKonstantin Belousov #endif
643ed95805eSJohn Baldwin 
644dfe7b3bfSKonstantin Belousov 	/* If we are busy - try to use fast methods. */
645dfe7b3bfSKonstantin Belousov 	if (busy) {
646dfe7b3bfSKonstantin Belousov 		if ((cpu_feature2 & CPUID2_MON) && idle_mwait) {
647dfe7b3bfSKonstantin Belousov 			cpu_idle_mwait(busy);
648dfe7b3bfSKonstantin Belousov 			goto out;
649dfe7b3bfSKonstantin Belousov 		}
650dfe7b3bfSKonstantin Belousov 	}
651dfe7b3bfSKonstantin Belousov 
652dfe7b3bfSKonstantin Belousov 	/* If we have time - switch timers into idle mode. */
653dfe7b3bfSKonstantin Belousov 	if (!busy) {
654dfe7b3bfSKonstantin Belousov 		critical_enter();
655dfe7b3bfSKonstantin Belousov 		sbt = cpu_idleclock();
656dfe7b3bfSKonstantin Belousov 	}
657dfe7b3bfSKonstantin Belousov 
658dfe7b3bfSKonstantin Belousov 	/* Apply AMD APIC timer C1E workaround. */
659d3ba71b2SKonstantin Belousov 	if (cpu_amdc1e_bug && cpu_disable_c3_sleep) {
660dfe7b3bfSKonstantin Belousov 		msr = rdmsr(MSR_AMDK8_IPM);
661d3ba71b2SKonstantin Belousov 		if ((msr & (AMDK8_SMIONCMPHALT | AMDK8_C1EONCMPHALT)) != 0)
662d3ba71b2SKonstantin Belousov 			wrmsr(MSR_AMDK8_IPM, msr & ~(AMDK8_SMIONCMPHALT |
663d3ba71b2SKonstantin Belousov 			    AMDK8_C1EONCMPHALT));
664dfe7b3bfSKonstantin Belousov 	}
665dfe7b3bfSKonstantin Belousov 
666dfe7b3bfSKonstantin Belousov 	/* Call main idle method. */
667dfe7b3bfSKonstantin Belousov 	cpu_idle_fn(sbt);
668dfe7b3bfSKonstantin Belousov 
669dfe7b3bfSKonstantin Belousov 	/* Switch timers back into active mode. */
670dfe7b3bfSKonstantin Belousov 	if (!busy) {
671dfe7b3bfSKonstantin Belousov 		cpu_activeclock();
672dfe7b3bfSKonstantin Belousov 		critical_exit();
673dfe7b3bfSKonstantin Belousov 	}
674dfe7b3bfSKonstantin Belousov out:
675*ece453d5SMark Johnston 	CTR1(KTR_SPARE2, "cpu_idle(%d) done", busy);
676dfe7b3bfSKonstantin Belousov }
677dfe7b3bfSKonstantin Belousov 
6783f3937b4SKonstantin Belousov static int cpu_idle_apl31_workaround;
6793f3937b4SKonstantin Belousov SYSCTL_INT(_machdep, OID_AUTO, idle_apl31, CTLFLAG_RW,
6803f3937b4SKonstantin Belousov     &cpu_idle_apl31_workaround, 0,
681160be7ccSKonstantin Belousov     "Apollo Lake APL31 MWAIT bug workaround");
6823f3937b4SKonstantin Belousov 
683dfe7b3bfSKonstantin Belousov int
684dfe7b3bfSKonstantin Belousov cpu_idle_wakeup(int cpu)
685dfe7b3bfSKonstantin Belousov {
68683dc49beSConrad Meyer 	struct monitorbuf *mb;
687dfe7b3bfSKonstantin Belousov 	int *state;
688dfe7b3bfSKonstantin Belousov 
68983dc49beSConrad Meyer 	mb = &pcpu_find(cpu)->pc_monitorbuf;
69083dc49beSConrad Meyer 	state = &mb->idle_state;
691a5bd21d0SKonstantin Belousov 	switch (atomic_load_int(state)) {
692a5bd21d0SKonstantin Belousov 	case STATE_SLEEPING:
693dfe7b3bfSKonstantin Belousov 		return (0);
694a5bd21d0SKonstantin Belousov 	case STATE_MWAIT:
695a5bd21d0SKonstantin Belousov 		atomic_store_int(state, STATE_RUNNING);
6963f3937b4SKonstantin Belousov 		return (cpu_idle_apl31_workaround ? 0 : 1);
697a5bd21d0SKonstantin Belousov 	case STATE_RUNNING:
698a5bd21d0SKonstantin Belousov 		return (1);
699a5bd21d0SKonstantin Belousov 	default:
700a5bd21d0SKonstantin Belousov 		panic("bad monitor state");
701a5bd21d0SKonstantin Belousov 		return (1);
702a5bd21d0SKonstantin Belousov 	}
703dfe7b3bfSKonstantin Belousov }
704dfe7b3bfSKonstantin Belousov 
705dfe7b3bfSKonstantin Belousov /*
706dfe7b3bfSKonstantin Belousov  * Ordered by speed/power consumption.
707dfe7b3bfSKonstantin Belousov  */
708a5f472c5SKonstantin Belousov static struct {
709dfe7b3bfSKonstantin Belousov 	void	*id_fn;
710dfe7b3bfSKonstantin Belousov 	char	*id_name;
711a5f472c5SKonstantin Belousov 	int	id_cpuid2_flag;
712dfe7b3bfSKonstantin Belousov } idle_tbl[] = {
713a5f472c5SKonstantin Belousov 	{ .id_fn = cpu_idle_spin, .id_name = "spin" },
714a5f472c5SKonstantin Belousov 	{ .id_fn = cpu_idle_mwait, .id_name = "mwait",
715a5f472c5SKonstantin Belousov 	    .id_cpuid2_flag = CPUID2_MON },
716a5f472c5SKonstantin Belousov 	{ .id_fn = cpu_idle_hlt, .id_name = "hlt" },
717a5f472c5SKonstantin Belousov 	{ .id_fn = cpu_idle_acpi, .id_name = "acpi" },
718dfe7b3bfSKonstantin Belousov };
719dfe7b3bfSKonstantin Belousov 
720dfe7b3bfSKonstantin Belousov static int
721dfe7b3bfSKonstantin Belousov idle_sysctl_available(SYSCTL_HANDLER_ARGS)
722dfe7b3bfSKonstantin Belousov {
723dfe7b3bfSKonstantin Belousov 	char *avail, *p;
724dfe7b3bfSKonstantin Belousov 	int error;
725dfe7b3bfSKonstantin Belousov 	int i;
726dfe7b3bfSKonstantin Belousov 
727dfe7b3bfSKonstantin Belousov 	avail = malloc(256, M_TEMP, M_WAITOK);
728dfe7b3bfSKonstantin Belousov 	p = avail;
729a5f472c5SKonstantin Belousov 	for (i = 0; i < nitems(idle_tbl); i++) {
730a5f472c5SKonstantin Belousov 		if (idle_tbl[i].id_cpuid2_flag != 0 &&
731a5f472c5SKonstantin Belousov 		    (cpu_feature2 & idle_tbl[i].id_cpuid2_flag) == 0)
732dfe7b3bfSKonstantin Belousov 			continue;
733dfe7b3bfSKonstantin Belousov 		if (strcmp(idle_tbl[i].id_name, "acpi") == 0 &&
734dfe7b3bfSKonstantin Belousov 		    cpu_idle_hook == NULL)
735dfe7b3bfSKonstantin Belousov 			continue;
736dfe7b3bfSKonstantin Belousov 		p += sprintf(p, "%s%s", p != avail ? ", " : "",
737dfe7b3bfSKonstantin Belousov 		    idle_tbl[i].id_name);
738dfe7b3bfSKonstantin Belousov 	}
739dfe7b3bfSKonstantin Belousov 	error = sysctl_handle_string(oidp, avail, 0, req);
740dfe7b3bfSKonstantin Belousov 	free(avail, M_TEMP);
741dfe7b3bfSKonstantin Belousov 	return (error);
742dfe7b3bfSKonstantin Belousov }
743dfe7b3bfSKonstantin Belousov 
7447029da5cSPawel Biernacki SYSCTL_PROC(_machdep, OID_AUTO, idle_available,
7451d6fb900SAlexander Motin     CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE,
7467029da5cSPawel Biernacki     0, 0, idle_sysctl_available, "A",
7477029da5cSPawel Biernacki     "list of available idle functions");
748dfe7b3bfSKonstantin Belousov 
74955ba21d4SKonstantin Belousov static bool
750a5f472c5SKonstantin Belousov cpu_idle_selector(const char *new_idle_name)
75155ba21d4SKonstantin Belousov {
75255ba21d4SKonstantin Belousov 	int i;
75355ba21d4SKonstantin Belousov 
754a5f472c5SKonstantin Belousov 	for (i = 0; i < nitems(idle_tbl); i++) {
755a5f472c5SKonstantin Belousov 		if (idle_tbl[i].id_cpuid2_flag != 0 &&
756a5f472c5SKonstantin Belousov 		    (cpu_feature2 & idle_tbl[i].id_cpuid2_flag) == 0)
75755ba21d4SKonstantin Belousov 			continue;
75855ba21d4SKonstantin Belousov 		if (strcmp(idle_tbl[i].id_name, "acpi") == 0 &&
75955ba21d4SKonstantin Belousov 		    cpu_idle_hook == NULL)
76055ba21d4SKonstantin Belousov 			continue;
76155ba21d4SKonstantin Belousov 		if (strcmp(idle_tbl[i].id_name, new_idle_name))
76255ba21d4SKonstantin Belousov 			continue;
76355ba21d4SKonstantin Belousov 		cpu_idle_fn = idle_tbl[i].id_fn;
76455ba21d4SKonstantin Belousov 		if (bootverbose)
76555ba21d4SKonstantin Belousov 			printf("CPU idle set to %s\n", idle_tbl[i].id_name);
76655ba21d4SKonstantin Belousov 		return (true);
76755ba21d4SKonstantin Belousov 	}
76855ba21d4SKonstantin Belousov 	return (false);
76955ba21d4SKonstantin Belousov }
77055ba21d4SKonstantin Belousov 
771dfe7b3bfSKonstantin Belousov static int
772a5f472c5SKonstantin Belousov cpu_idle_sysctl(SYSCTL_HANDLER_ARGS)
773dfe7b3bfSKonstantin Belousov {
77455ba21d4SKonstantin Belousov 	char buf[16], *p;
77555ba21d4SKonstantin Belousov 	int error, i;
776dfe7b3bfSKonstantin Belousov 
777dfe7b3bfSKonstantin Belousov 	p = "unknown";
778a5f472c5SKonstantin Belousov 	for (i = 0; i < nitems(idle_tbl); i++) {
779dfe7b3bfSKonstantin Belousov 		if (idle_tbl[i].id_fn == cpu_idle_fn) {
780dfe7b3bfSKonstantin Belousov 			p = idle_tbl[i].id_name;
781dfe7b3bfSKonstantin Belousov 			break;
782dfe7b3bfSKonstantin Belousov 		}
783dfe7b3bfSKonstantin Belousov 	}
784dfe7b3bfSKonstantin Belousov 	strncpy(buf, p, sizeof(buf));
785dfe7b3bfSKonstantin Belousov 	error = sysctl_handle_string(oidp, buf, sizeof(buf), req);
786dfe7b3bfSKonstantin Belousov 	if (error != 0 || req->newptr == NULL)
787dfe7b3bfSKonstantin Belousov 		return (error);
788a5f472c5SKonstantin Belousov 	return (cpu_idle_selector(buf) ? 0 : EINVAL);
789dfe7b3bfSKonstantin Belousov }
790dfe7b3bfSKonstantin Belousov 
7917029da5cSPawel Biernacki SYSCTL_PROC(_machdep, OID_AUTO, idle,
7921d6fb900SAlexander Motin     CTLTYPE_STRING | CTLFLAG_RW | CTLFLAG_MPSAFE,
7937029da5cSPawel Biernacki     0, 0, cpu_idle_sysctl, "A",
7947029da5cSPawel Biernacki     "currently selected idle function");
795835c2787SKonstantin Belousov 
79655ba21d4SKonstantin Belousov static void
797a5f472c5SKonstantin Belousov cpu_idle_tun(void *unused __unused)
79855ba21d4SKonstantin Belousov {
79955ba21d4SKonstantin Belousov 	char tunvar[16];
80055ba21d4SKonstantin Belousov 
80155ba21d4SKonstantin Belousov 	if (TUNABLE_STR_FETCH("machdep.idle", tunvar, sizeof(tunvar)))
802a5f472c5SKonstantin Belousov 		cpu_idle_selector(tunvar);
80345ed991dSKonstantin Belousov 	else if (cpu_vendor_id == CPU_VENDOR_AMD &&
80445ed991dSKonstantin Belousov 	    CPUID_TO_FAMILY(cpu_id) == 0x17 && CPUID_TO_MODEL(cpu_id) == 0x1) {
80545ed991dSKonstantin Belousov 		/* Ryzen erratas 1057, 1109. */
80645ed991dSKonstantin Belousov 		cpu_idle_selector("hlt");
80745ed991dSKonstantin Belousov 		idle_mwait = 0;
808665919aaSConrad Meyer 		mwait_cpustop_broken = true;
80945ed991dSKonstantin Belousov 	}
81045ed991dSKonstantin Belousov 
8113f3937b4SKonstantin Belousov 	if (cpu_vendor_id == CPU_VENDOR_INTEL && cpu_id == 0x506c9) {
8123f3937b4SKonstantin Belousov 		/*
813160be7ccSKonstantin Belousov 		 * Apollo Lake errata APL31 (public errata APL30).
814160be7ccSKonstantin Belousov 		 * Stores to the armed address range may not trigger
815160be7ccSKonstantin Belousov 		 * MWAIT to resume execution.  OS needs to use
816160be7ccSKonstantin Belousov 		 * interrupts to wake processors from MWAIT-induced
817160be7ccSKonstantin Belousov 		 * sleep states.
8183f3937b4SKonstantin Belousov 		 */
8193f3937b4SKonstantin Belousov 		cpu_idle_apl31_workaround = 1;
820665919aaSConrad Meyer 		mwait_cpustop_broken = true;
8213f3937b4SKonstantin Belousov 	}
8223f3937b4SKonstantin Belousov 	TUNABLE_INT_FETCH("machdep.idle_apl31", &cpu_idle_apl31_workaround);
82355ba21d4SKonstantin Belousov }
824a5f472c5SKonstantin Belousov SYSINIT(cpu_idle_tun, SI_SUB_CPU, SI_ORDER_MIDDLE, cpu_idle_tun, NULL);
82555ba21d4SKonstantin Belousov 
826ba0ced82SEric van Gyzen static int panic_on_nmi = 0xff;
827295f4b6cSKonstantin Belousov SYSCTL_INT(_machdep, OID_AUTO, panic_on_nmi, CTLFLAG_RWTUN,
828295f4b6cSKonstantin Belousov     &panic_on_nmi, 0,
829ba0ced82SEric van Gyzen     "Panic on NMI: 1 = H/W failure; 2 = unknown; 0xff = all");
830835c2787SKonstantin Belousov int nmi_is_broadcast = 1;
831835c2787SKonstantin Belousov SYSCTL_INT(_machdep, OID_AUTO, nmi_is_broadcast, CTLFLAG_RWTUN,
832835c2787SKonstantin Belousov     &nmi_is_broadcast, 0,
833835c2787SKonstantin Belousov     "Chipset NMI is broadcast");
834855e49f3SAlexander Motin int (*apei_nmi)(void);
835835c2787SKonstantin Belousov 
836295f4b6cSKonstantin Belousov void
837295f4b6cSKonstantin Belousov nmi_call_kdb(u_int cpu, u_int type, struct trapframe *frame)
838835c2787SKonstantin Belousov {
8390fb3a72aSAndriy Gapon 	bool claimed = false;
840835c2787SKonstantin Belousov 
8410fb3a72aSAndriy Gapon #ifdef DEV_ISA
842835c2787SKonstantin Belousov 	/* machine/parity/power fail/"kitchen sink" faults */
8430fb3a72aSAndriy Gapon 	if (isa_nmi(frame->tf_err)) {
8440fb3a72aSAndriy Gapon 		claimed = true;
845ba0ced82SEric van Gyzen 		if ((panic_on_nmi & 1) != 0)
8460fb3a72aSAndriy Gapon 			panic("NMI indicates hardware failure");
8470fb3a72aSAndriy Gapon 	}
8480fb3a72aSAndriy Gapon #endif /* DEV_ISA */
849ba0ced82SEric van Gyzen 
850855e49f3SAlexander Motin 	/* ACPI Platform Error Interfaces callback. */
851855e49f3SAlexander Motin 	if (apei_nmi != NULL && (*apei_nmi)())
852855e49f3SAlexander Motin 		claimed = true;
853855e49f3SAlexander Motin 
854835c2787SKonstantin Belousov 	/*
855ba0ced82SEric van Gyzen 	 * NMIs can be useful for debugging.  They can be hooked up to a
856ba0ced82SEric van Gyzen 	 * pushbutton, usually on an ISA, PCI, or PCIe card.  They can also be
857ba0ced82SEric van Gyzen 	 * generated by an IPMI BMC, either manually or in response to a
858ba0ced82SEric van Gyzen 	 * watchdog timeout.  For example, see the "power diag" command in
859ba0ced82SEric van Gyzen 	 * ports/sysutils/ipmitool.  They can also be generated by a
860ba0ced82SEric van Gyzen 	 * hypervisor; see "bhyvectl --inject-nmi".
861835c2787SKonstantin Belousov 	 */
862ba0ced82SEric van Gyzen 
863ba0ced82SEric van Gyzen #ifdef KDB
864ba0ced82SEric van Gyzen 	if (!claimed && (panic_on_nmi & 2) != 0) {
865ba0ced82SEric van Gyzen 		if (debugger_on_panic) {
866835c2787SKonstantin Belousov 			printf("NMI/cpu%d ... going to debugger\n", cpu);
867ba0ced82SEric van Gyzen 			claimed = kdb_trap(type, 0, frame);
868ba0ced82SEric van Gyzen 		}
869835c2787SKonstantin Belousov 	}
870835c2787SKonstantin Belousov #endif /* KDB */
871ba0ced82SEric van Gyzen 
872ba0ced82SEric van Gyzen 	if (!claimed && panic_on_nmi != 0)
873ba0ced82SEric van Gyzen 		panic("NMI");
874295f4b6cSKonstantin Belousov }
875835c2787SKonstantin Belousov 
876295f4b6cSKonstantin Belousov void
877295f4b6cSKonstantin Belousov nmi_handle_intr(u_int type, struct trapframe *frame)
878835c2787SKonstantin Belousov {
879835c2787SKonstantin Belousov 
880835c2787SKonstantin Belousov #ifdef SMP
881295f4b6cSKonstantin Belousov 	if (nmi_is_broadcast) {
882295f4b6cSKonstantin Belousov 		nmi_call_kdb_smp(type, frame);
883295f4b6cSKonstantin Belousov 		return;
884295f4b6cSKonstantin Belousov 	}
885835c2787SKonstantin Belousov #endif
8861d6dfd12SKonstantin Belousov 	nmi_call_kdb(PCPU_GET(cpuid), type, frame);
887835c2787SKonstantin Belousov }
888319117fdSKonstantin Belousov 
889a324b7f7SKonstantin Belousov static int hw_ibrs_active;
890a324b7f7SKonstantin Belousov int hw_ibrs_ibpb_active;
891319117fdSKonstantin Belousov int hw_ibrs_disable = 1;
892319117fdSKonstantin Belousov 
893319117fdSKonstantin Belousov SYSCTL_INT(_hw, OID_AUTO, ibrs_active, CTLFLAG_RD, &hw_ibrs_active, 0,
894b31b965eSKonstantin Belousov     "Indirect Branch Restricted Speculation active");
895319117fdSKonstantin Belousov 
8967029da5cSPawel Biernacki SYSCTL_NODE(_machdep_mitigations, OID_AUTO, ibrs,
8977029da5cSPawel Biernacki     CTLFLAG_RW | CTLFLAG_MPSAFE, 0,
898961aacb1SScott Long     "Indirect Branch Restricted Speculation active");
899961aacb1SScott Long 
900961aacb1SScott Long SYSCTL_INT(_machdep_mitigations_ibrs, OID_AUTO, active, CTLFLAG_RD,
901961aacb1SScott Long     &hw_ibrs_active, 0, "Indirect Branch Restricted Speculation active");
902961aacb1SScott Long 
903319117fdSKonstantin Belousov void
904a324b7f7SKonstantin Belousov hw_ibrs_recalculate(bool for_all_cpus)
905319117fdSKonstantin Belousov {
906319117fdSKonstantin Belousov 	if ((cpu_ia32_arch_caps & IA32_ARCH_CAP_IBRS_ALL) != 0) {
907a324b7f7SKonstantin Belousov 		x86_msr_op(MSR_IA32_SPEC_CTRL, (for_all_cpus ?
908d0bc4b46SKonstantin Belousov 		    MSR_OP_RENDEZVOUS_ALL : MSR_OP_LOCAL) |
909a324b7f7SKonstantin Belousov 		    (hw_ibrs_disable != 0 ? MSR_OP_ANDNOT : MSR_OP_OR),
910d0bc4b46SKonstantin Belousov 		    IA32_SPEC_CTRL_IBRS, NULL);
911a324b7f7SKonstantin Belousov 		hw_ibrs_active = hw_ibrs_disable == 0;
912a324b7f7SKonstantin Belousov 		hw_ibrs_ibpb_active = 0;
913a324b7f7SKonstantin Belousov 	} else {
914a324b7f7SKonstantin Belousov 		hw_ibrs_active = hw_ibrs_ibpb_active = (cpu_stdext_feature3 &
915a324b7f7SKonstantin Belousov 		    CPUID_STDEXT3_IBPB) != 0 && !hw_ibrs_disable;
916319117fdSKonstantin Belousov 	}
917319117fdSKonstantin Belousov }
918319117fdSKonstantin Belousov 
919319117fdSKonstantin Belousov static int
920319117fdSKonstantin Belousov hw_ibrs_disable_handler(SYSCTL_HANDLER_ARGS)
921319117fdSKonstantin Belousov {
922319117fdSKonstantin Belousov 	int error, val;
923319117fdSKonstantin Belousov 
924319117fdSKonstantin Belousov 	val = hw_ibrs_disable;
925319117fdSKonstantin Belousov 	error = sysctl_handle_int(oidp, &val, 0, req);
926319117fdSKonstantin Belousov 	if (error != 0 || req->newptr == NULL)
927319117fdSKonstantin Belousov 		return (error);
928319117fdSKonstantin Belousov 	hw_ibrs_disable = val != 0;
929a324b7f7SKonstantin Belousov 	hw_ibrs_recalculate(true);
930319117fdSKonstantin Belousov 	return (0);
931319117fdSKonstantin Belousov }
932319117fdSKonstantin Belousov SYSCTL_PROC(_hw, OID_AUTO, ibrs_disable, CTLTYPE_INT | CTLFLAG_RWTUN |
933319117fdSKonstantin Belousov     CTLFLAG_NOFETCH | CTLFLAG_MPSAFE, NULL, 0, hw_ibrs_disable_handler, "I",
934b31b965eSKonstantin Belousov     "Disable Indirect Branch Restricted Speculation");
9358fbcc334SKonstantin Belousov 
936961aacb1SScott Long SYSCTL_PROC(_machdep_mitigations_ibrs, OID_AUTO, disable, CTLTYPE_INT |
937961aacb1SScott Long     CTLFLAG_RWTUN | CTLFLAG_NOFETCH | CTLFLAG_MPSAFE, NULL, 0,
938961aacb1SScott Long     hw_ibrs_disable_handler, "I",
939961aacb1SScott Long     "Disable Indirect Branch Restricted Speculation");
940961aacb1SScott Long 
9413621ba1eSKonstantin Belousov int hw_ssb_active;
9423621ba1eSKonstantin Belousov int hw_ssb_disable;
9433621ba1eSKonstantin Belousov 
9443621ba1eSKonstantin Belousov SYSCTL_INT(_hw, OID_AUTO, spec_store_bypass_disable_active, CTLFLAG_RD,
9453621ba1eSKonstantin Belousov     &hw_ssb_active, 0,
9463621ba1eSKonstantin Belousov     "Speculative Store Bypass Disable active");
9473621ba1eSKonstantin Belousov 
9487029da5cSPawel Biernacki SYSCTL_NODE(_machdep_mitigations, OID_AUTO, ssb,
9497029da5cSPawel Biernacki     CTLFLAG_RW | CTLFLAG_MPSAFE, 0,
950961aacb1SScott Long     "Speculative Store Bypass Disable active");
951961aacb1SScott Long 
952961aacb1SScott Long SYSCTL_INT(_machdep_mitigations_ssb, OID_AUTO, active, CTLFLAG_RD,
953961aacb1SScott Long     &hw_ssb_active, 0, "Speculative Store Bypass Disable active");
954961aacb1SScott Long 
9553621ba1eSKonstantin Belousov static void
9563621ba1eSKonstantin Belousov hw_ssb_set(bool enable, bool for_all_cpus)
9573621ba1eSKonstantin Belousov {
9583621ba1eSKonstantin Belousov 
9593621ba1eSKonstantin Belousov 	if ((cpu_stdext_feature3 & CPUID_STDEXT3_SSBD) == 0) {
9603621ba1eSKonstantin Belousov 		hw_ssb_active = 0;
9613621ba1eSKonstantin Belousov 		return;
9623621ba1eSKonstantin Belousov 	}
9633621ba1eSKonstantin Belousov 	hw_ssb_active = enable;
964fa83f689SKonstantin Belousov 	x86_msr_op(MSR_IA32_SPEC_CTRL,
965fa83f689SKonstantin Belousov 	    (enable ? MSR_OP_OR : MSR_OP_ANDNOT) |
966d0bc4b46SKonstantin Belousov 	    (for_all_cpus ? MSR_OP_SCHED_ALL : MSR_OP_LOCAL),
967d0bc4b46SKonstantin Belousov 	    IA32_SPEC_CTRL_SSBD, NULL);
9683621ba1eSKonstantin Belousov }
9693621ba1eSKonstantin Belousov 
9703621ba1eSKonstantin Belousov void
9713621ba1eSKonstantin Belousov hw_ssb_recalculate(bool all_cpus)
9723621ba1eSKonstantin Belousov {
9733621ba1eSKonstantin Belousov 
9743621ba1eSKonstantin Belousov 	switch (hw_ssb_disable) {
9753621ba1eSKonstantin Belousov 	default:
9763621ba1eSKonstantin Belousov 		hw_ssb_disable = 0;
9773621ba1eSKonstantin Belousov 		/* FALLTHROUGH */
9783621ba1eSKonstantin Belousov 	case 0: /* off */
9793621ba1eSKonstantin Belousov 		hw_ssb_set(false, all_cpus);
9803621ba1eSKonstantin Belousov 		break;
9813621ba1eSKonstantin Belousov 	case 1: /* on */
9823621ba1eSKonstantin Belousov 		hw_ssb_set(true, all_cpus);
9833621ba1eSKonstantin Belousov 		break;
9843621ba1eSKonstantin Belousov 	case 2: /* auto */
98523437573SKonstantin Belousov 		hw_ssb_set((cpu_ia32_arch_caps & IA32_ARCH_CAP_SSB_NO) != 0 ?
9863621ba1eSKonstantin Belousov 		    false : true, all_cpus);
9873621ba1eSKonstantin Belousov 		break;
9883621ba1eSKonstantin Belousov 	}
9893621ba1eSKonstantin Belousov }
9903621ba1eSKonstantin Belousov 
9913621ba1eSKonstantin Belousov static int
9923621ba1eSKonstantin Belousov hw_ssb_disable_handler(SYSCTL_HANDLER_ARGS)
9933621ba1eSKonstantin Belousov {
9943621ba1eSKonstantin Belousov 	int error, val;
9953621ba1eSKonstantin Belousov 
9963621ba1eSKonstantin Belousov 	val = hw_ssb_disable;
9973621ba1eSKonstantin Belousov 	error = sysctl_handle_int(oidp, &val, 0, req);
9983621ba1eSKonstantin Belousov 	if (error != 0 || req->newptr == NULL)
9993621ba1eSKonstantin Belousov 		return (error);
10003621ba1eSKonstantin Belousov 	hw_ssb_disable = val;
10013621ba1eSKonstantin Belousov 	hw_ssb_recalculate(true);
10023621ba1eSKonstantin Belousov 	return (0);
10033621ba1eSKonstantin Belousov }
10043621ba1eSKonstantin Belousov SYSCTL_PROC(_hw, OID_AUTO, spec_store_bypass_disable, CTLTYPE_INT |
10053621ba1eSKonstantin Belousov     CTLFLAG_RWTUN | CTLFLAG_NOFETCH | CTLFLAG_MPSAFE, NULL, 0,
10063621ba1eSKonstantin Belousov     hw_ssb_disable_handler, "I",
1007a212f56dSPiotr Pawel Stefaniak     "Speculative Store Bypass Disable (0 - off, 1 - on, 2 - auto)");
10083621ba1eSKonstantin Belousov 
1009961aacb1SScott Long SYSCTL_PROC(_machdep_mitigations_ssb, OID_AUTO, disable, CTLTYPE_INT |
1010961aacb1SScott Long     CTLFLAG_RWTUN | CTLFLAG_NOFETCH | CTLFLAG_MPSAFE, NULL, 0,
1011961aacb1SScott Long     hw_ssb_disable_handler, "I",
1012a212f56dSPiotr Pawel Stefaniak     "Speculative Store Bypass Disable (0 - off, 1 - on, 2 - auto)");
1013961aacb1SScott Long 
10147355a02bSKonstantin Belousov int hw_mds_disable;
10157355a02bSKonstantin Belousov 
10167355a02bSKonstantin Belousov /*
10177355a02bSKonstantin Belousov  * Handler for Microarchitectural Data Sampling issues.  Really not a
10187355a02bSKonstantin Belousov  * pointer to C function: on amd64 the code must not change any CPU
10197355a02bSKonstantin Belousov  * architectural state except possibly %rflags. Also, it is always
10207355a02bSKonstantin Belousov  * called with interrupts disabled.
10217355a02bSKonstantin Belousov  */
10227355a02bSKonstantin Belousov void mds_handler_void(void);
10237355a02bSKonstantin Belousov void mds_handler_verw(void);
10247355a02bSKonstantin Belousov void mds_handler_ivb(void);
10257355a02bSKonstantin Belousov void mds_handler_bdw(void);
10267355a02bSKonstantin Belousov void mds_handler_skl_sse(void);
10277355a02bSKonstantin Belousov void mds_handler_skl_avx(void);
10287355a02bSKonstantin Belousov void mds_handler_skl_avx512(void);
10297355a02bSKonstantin Belousov void mds_handler_silvermont(void);
1030e2e0470dSKonstantin Belousov void (*mds_handler)(void) = mds_handler_void;
10317355a02bSKonstantin Belousov 
10327355a02bSKonstantin Belousov static int
10337355a02bSKonstantin Belousov sysctl_hw_mds_disable_state_handler(SYSCTL_HANDLER_ARGS)
10347355a02bSKonstantin Belousov {
10357355a02bSKonstantin Belousov 	const char *state;
10367355a02bSKonstantin Belousov 
10377355a02bSKonstantin Belousov 	if (mds_handler == mds_handler_void)
10387355a02bSKonstantin Belousov 		state = "inactive";
10397355a02bSKonstantin Belousov 	else if (mds_handler == mds_handler_verw)
10407355a02bSKonstantin Belousov 		state = "VERW";
10417355a02bSKonstantin Belousov 	else if (mds_handler == mds_handler_ivb)
10427355a02bSKonstantin Belousov 		state = "software IvyBridge";
10437355a02bSKonstantin Belousov 	else if (mds_handler == mds_handler_bdw)
10447355a02bSKonstantin Belousov 		state = "software Broadwell";
10457355a02bSKonstantin Belousov 	else if (mds_handler == mds_handler_skl_sse)
10467355a02bSKonstantin Belousov 		state = "software Skylake SSE";
10477355a02bSKonstantin Belousov 	else if (mds_handler == mds_handler_skl_avx)
10487355a02bSKonstantin Belousov 		state = "software Skylake AVX";
10497355a02bSKonstantin Belousov 	else if (mds_handler == mds_handler_skl_avx512)
10507355a02bSKonstantin Belousov 		state = "software Skylake AVX512";
10517355a02bSKonstantin Belousov 	else if (mds_handler == mds_handler_silvermont)
10527355a02bSKonstantin Belousov 		state = "software Silvermont";
10537355a02bSKonstantin Belousov 	else
10547355a02bSKonstantin Belousov 		state = "unknown";
10557355a02bSKonstantin Belousov 	return (SYSCTL_OUT(req, state, strlen(state)));
10567355a02bSKonstantin Belousov }
10577355a02bSKonstantin Belousov 
10587355a02bSKonstantin Belousov SYSCTL_PROC(_hw, OID_AUTO, mds_disable_state,
10597355a02bSKonstantin Belousov     CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE, NULL, 0,
10607355a02bSKonstantin Belousov     sysctl_hw_mds_disable_state_handler, "A",
10617355a02bSKonstantin Belousov     "Microarchitectural Data Sampling Mitigation state");
10627355a02bSKonstantin Belousov 
10637029da5cSPawel Biernacki SYSCTL_NODE(_machdep_mitigations, OID_AUTO, mds,
10647029da5cSPawel Biernacki     CTLFLAG_RW | CTLFLAG_MPSAFE, 0,
1065961aacb1SScott Long     "Microarchitectural Data Sampling Mitigation state");
1066961aacb1SScott Long 
1067961aacb1SScott Long SYSCTL_PROC(_machdep_mitigations_mds, OID_AUTO, state,
1068961aacb1SScott Long     CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE, NULL, 0,
1069961aacb1SScott Long     sysctl_hw_mds_disable_state_handler, "A",
1070961aacb1SScott Long     "Microarchitectural Data Sampling Mitigation state");
1071961aacb1SScott Long 
10727355a02bSKonstantin Belousov _Static_assert(__offsetof(struct pcpu, pc_mds_tmp) % 64 == 0, "MDS AVX512");
10737355a02bSKonstantin Belousov 
10747355a02bSKonstantin Belousov void
10757355a02bSKonstantin Belousov hw_mds_recalculate(void)
10767355a02bSKonstantin Belousov {
10777355a02bSKonstantin Belousov 	struct pcpu *pc;
10787355a02bSKonstantin Belousov 	vm_offset_t b64;
10797355a02bSKonstantin Belousov 	u_long xcr0;
10807355a02bSKonstantin Belousov 	int i;
10817355a02bSKonstantin Belousov 
10827355a02bSKonstantin Belousov 	/*
10837355a02bSKonstantin Belousov 	 * Allow user to force VERW variant even if MD_CLEAR is not
10847355a02bSKonstantin Belousov 	 * reported.  For instance, hypervisor might unknowingly
10857355a02bSKonstantin Belousov 	 * filter the cap out.
10867355a02bSKonstantin Belousov 	 * For the similar reasons, and for testing, allow to enable
108736e1ad61SKonstantin Belousov 	 * mitigation even when MDS_NO cap is set.
10887355a02bSKonstantin Belousov 	 */
10897355a02bSKonstantin Belousov 	if (cpu_vendor_id != CPU_VENDOR_INTEL || hw_mds_disable == 0 ||
109036e1ad61SKonstantin Belousov 	    ((cpu_ia32_arch_caps & IA32_ARCH_CAP_MDS_NO) != 0 &&
109136e1ad61SKonstantin Belousov 	    hw_mds_disable == 3)) {
10927355a02bSKonstantin Belousov 		mds_handler = mds_handler_void;
10937355a02bSKonstantin Belousov 	} else if (((cpu_stdext_feature3 & CPUID_STDEXT3_MD_CLEAR) != 0 &&
10947355a02bSKonstantin Belousov 	    hw_mds_disable == 3) || hw_mds_disable == 1) {
10957355a02bSKonstantin Belousov 		mds_handler = mds_handler_verw;
10967355a02bSKonstantin Belousov 	} else if (CPUID_TO_FAMILY(cpu_id) == 0x6 &&
10977355a02bSKonstantin Belousov 	    (CPUID_TO_MODEL(cpu_id) == 0x2e || CPUID_TO_MODEL(cpu_id) == 0x1e ||
10987355a02bSKonstantin Belousov 	    CPUID_TO_MODEL(cpu_id) == 0x1f || CPUID_TO_MODEL(cpu_id) == 0x1a ||
10997355a02bSKonstantin Belousov 	    CPUID_TO_MODEL(cpu_id) == 0x2f || CPUID_TO_MODEL(cpu_id) == 0x25 ||
11007355a02bSKonstantin Belousov 	    CPUID_TO_MODEL(cpu_id) == 0x2c || CPUID_TO_MODEL(cpu_id) == 0x2d ||
11017355a02bSKonstantin Belousov 	    CPUID_TO_MODEL(cpu_id) == 0x2a || CPUID_TO_MODEL(cpu_id) == 0x3e ||
11027355a02bSKonstantin Belousov 	    CPUID_TO_MODEL(cpu_id) == 0x3a) &&
11037355a02bSKonstantin Belousov 	    (hw_mds_disable == 2 || hw_mds_disable == 3)) {
11047355a02bSKonstantin Belousov 		/*
11057355a02bSKonstantin Belousov 		 * Nehalem, SandyBridge, IvyBridge
11067355a02bSKonstantin Belousov 		 */
11077355a02bSKonstantin Belousov 		CPU_FOREACH(i) {
11087355a02bSKonstantin Belousov 			pc = pcpu_find(i);
11097355a02bSKonstantin Belousov 			if (pc->pc_mds_buf == NULL) {
11107355a02bSKonstantin Belousov 				pc->pc_mds_buf = malloc_domainset(672, M_TEMP,
11117355a02bSKonstantin Belousov 				    DOMAINSET_PREF(pc->pc_domain), M_WAITOK);
11127355a02bSKonstantin Belousov 				bzero(pc->pc_mds_buf, 16);
11137355a02bSKonstantin Belousov 			}
11147355a02bSKonstantin Belousov 		}
11157355a02bSKonstantin Belousov 		mds_handler = mds_handler_ivb;
11167355a02bSKonstantin Belousov 	} else if (CPUID_TO_FAMILY(cpu_id) == 0x6 &&
11177355a02bSKonstantin Belousov 	    (CPUID_TO_MODEL(cpu_id) == 0x3f || CPUID_TO_MODEL(cpu_id) == 0x3c ||
11187355a02bSKonstantin Belousov 	    CPUID_TO_MODEL(cpu_id) == 0x45 || CPUID_TO_MODEL(cpu_id) == 0x46 ||
11197355a02bSKonstantin Belousov 	    CPUID_TO_MODEL(cpu_id) == 0x56 || CPUID_TO_MODEL(cpu_id) == 0x4f ||
11207355a02bSKonstantin Belousov 	    CPUID_TO_MODEL(cpu_id) == 0x47 || CPUID_TO_MODEL(cpu_id) == 0x3d) &&
11217355a02bSKonstantin Belousov 	    (hw_mds_disable == 2 || hw_mds_disable == 3)) {
11227355a02bSKonstantin Belousov 		/*
11237355a02bSKonstantin Belousov 		 * Haswell, Broadwell
11247355a02bSKonstantin Belousov 		 */
11257355a02bSKonstantin Belousov 		CPU_FOREACH(i) {
11267355a02bSKonstantin Belousov 			pc = pcpu_find(i);
11277355a02bSKonstantin Belousov 			if (pc->pc_mds_buf == NULL) {
11287355a02bSKonstantin Belousov 				pc->pc_mds_buf = malloc_domainset(1536, M_TEMP,
11297355a02bSKonstantin Belousov 				    DOMAINSET_PREF(pc->pc_domain), M_WAITOK);
11307355a02bSKonstantin Belousov 				bzero(pc->pc_mds_buf, 16);
11317355a02bSKonstantin Belousov 			}
11327355a02bSKonstantin Belousov 		}
11337355a02bSKonstantin Belousov 		mds_handler = mds_handler_bdw;
11347355a02bSKonstantin Belousov 	} else if (CPUID_TO_FAMILY(cpu_id) == 0x6 &&
11357355a02bSKonstantin Belousov 	    ((CPUID_TO_MODEL(cpu_id) == 0x55 && (cpu_id &
11367355a02bSKonstantin Belousov 	    CPUID_STEPPING) <= 5) ||
11377355a02bSKonstantin Belousov 	    CPUID_TO_MODEL(cpu_id) == 0x4e || CPUID_TO_MODEL(cpu_id) == 0x5e ||
11387355a02bSKonstantin Belousov 	    (CPUID_TO_MODEL(cpu_id) == 0x8e && (cpu_id &
11397355a02bSKonstantin Belousov 	    CPUID_STEPPING) <= 0xb) ||
11407355a02bSKonstantin Belousov 	    (CPUID_TO_MODEL(cpu_id) == 0x9e && (cpu_id &
11417355a02bSKonstantin Belousov 	    CPUID_STEPPING) <= 0xc)) &&
11427355a02bSKonstantin Belousov 	    (hw_mds_disable == 2 || hw_mds_disable == 3)) {
11437355a02bSKonstantin Belousov 		/*
11447355a02bSKonstantin Belousov 		 * Skylake, KabyLake, CoffeeLake, WhiskeyLake,
11457355a02bSKonstantin Belousov 		 * CascadeLake
11467355a02bSKonstantin Belousov 		 */
11477355a02bSKonstantin Belousov 		CPU_FOREACH(i) {
11487355a02bSKonstantin Belousov 			pc = pcpu_find(i);
11497355a02bSKonstantin Belousov 			if (pc->pc_mds_buf == NULL) {
11507355a02bSKonstantin Belousov 				pc->pc_mds_buf = malloc_domainset(6 * 1024,
11517355a02bSKonstantin Belousov 				    M_TEMP, DOMAINSET_PREF(pc->pc_domain),
11527355a02bSKonstantin Belousov 				    M_WAITOK);
11537355a02bSKonstantin Belousov 				b64 = (vm_offset_t)malloc_domainset(64 + 63,
11547355a02bSKonstantin Belousov 				    M_TEMP, DOMAINSET_PREF(pc->pc_domain),
11557355a02bSKonstantin Belousov 				    M_WAITOK);
11567355a02bSKonstantin Belousov 				pc->pc_mds_buf64 = (void *)roundup2(b64, 64);
11577355a02bSKonstantin Belousov 				bzero(pc->pc_mds_buf64, 64);
11587355a02bSKonstantin Belousov 			}
11597355a02bSKonstantin Belousov 		}
11607355a02bSKonstantin Belousov 		xcr0 = rxcr(0);
11617355a02bSKonstantin Belousov 		if ((xcr0 & XFEATURE_ENABLED_ZMM_HI256) != 0 &&
116299a6085fSScott Long 		    (cpu_stdext_feature & CPUID_STDEXT_AVX512DQ) != 0)
11637355a02bSKonstantin Belousov 			mds_handler = mds_handler_skl_avx512;
11647355a02bSKonstantin Belousov 		else if ((xcr0 & XFEATURE_ENABLED_AVX) != 0 &&
11657355a02bSKonstantin Belousov 		    (cpu_feature2 & CPUID2_AVX) != 0)
11667355a02bSKonstantin Belousov 			mds_handler = mds_handler_skl_avx;
11677355a02bSKonstantin Belousov 		else
11687355a02bSKonstantin Belousov 			mds_handler = mds_handler_skl_sse;
11697355a02bSKonstantin Belousov 	} else if (CPUID_TO_FAMILY(cpu_id) == 0x6 &&
11707355a02bSKonstantin Belousov 	    ((CPUID_TO_MODEL(cpu_id) == 0x37 ||
11717355a02bSKonstantin Belousov 	    CPUID_TO_MODEL(cpu_id) == 0x4a ||
11727355a02bSKonstantin Belousov 	    CPUID_TO_MODEL(cpu_id) == 0x4c ||
11737355a02bSKonstantin Belousov 	    CPUID_TO_MODEL(cpu_id) == 0x4d ||
11747355a02bSKonstantin Belousov 	    CPUID_TO_MODEL(cpu_id) == 0x5a ||
11757355a02bSKonstantin Belousov 	    CPUID_TO_MODEL(cpu_id) == 0x5d ||
11767355a02bSKonstantin Belousov 	    CPUID_TO_MODEL(cpu_id) == 0x6e ||
11777355a02bSKonstantin Belousov 	    CPUID_TO_MODEL(cpu_id) == 0x65 ||
11787355a02bSKonstantin Belousov 	    CPUID_TO_MODEL(cpu_id) == 0x75 ||
11797355a02bSKonstantin Belousov 	    CPUID_TO_MODEL(cpu_id) == 0x1c ||
11807355a02bSKonstantin Belousov 	    CPUID_TO_MODEL(cpu_id) == 0x26 ||
11817355a02bSKonstantin Belousov 	    CPUID_TO_MODEL(cpu_id) == 0x27 ||
11827355a02bSKonstantin Belousov 	    CPUID_TO_MODEL(cpu_id) == 0x35 ||
11837355a02bSKonstantin Belousov 	    CPUID_TO_MODEL(cpu_id) == 0x36 ||
11847355a02bSKonstantin Belousov 	    CPUID_TO_MODEL(cpu_id) == 0x7a))) {
11857355a02bSKonstantin Belousov 		/* Silvermont, Airmont */
11867355a02bSKonstantin Belousov 		CPU_FOREACH(i) {
11877355a02bSKonstantin Belousov 			pc = pcpu_find(i);
11887355a02bSKonstantin Belousov 			if (pc->pc_mds_buf == NULL)
11897355a02bSKonstantin Belousov 				pc->pc_mds_buf = malloc(256, M_TEMP, M_WAITOK);
11907355a02bSKonstantin Belousov 		}
11917355a02bSKonstantin Belousov 		mds_handler = mds_handler_silvermont;
11927355a02bSKonstantin Belousov 	} else {
11937355a02bSKonstantin Belousov 		hw_mds_disable = 0;
11947355a02bSKonstantin Belousov 		mds_handler = mds_handler_void;
11957355a02bSKonstantin Belousov 	}
11967355a02bSKonstantin Belousov }
11977355a02bSKonstantin Belousov 
119848ec6d3bSKonstantin Belousov static void
119948ec6d3bSKonstantin Belousov hw_mds_recalculate_boot(void *arg __unused)
120048ec6d3bSKonstantin Belousov {
120148ec6d3bSKonstantin Belousov 
120248ec6d3bSKonstantin Belousov 	hw_mds_recalculate();
120348ec6d3bSKonstantin Belousov }
120448ec6d3bSKonstantin Belousov SYSINIT(mds_recalc, SI_SUB_SMP, SI_ORDER_ANY, hw_mds_recalculate_boot, NULL);
120548ec6d3bSKonstantin Belousov 
12067355a02bSKonstantin Belousov static int
12077355a02bSKonstantin Belousov sysctl_mds_disable_handler(SYSCTL_HANDLER_ARGS)
12087355a02bSKonstantin Belousov {
12097355a02bSKonstantin Belousov 	int error, val;
12107355a02bSKonstantin Belousov 
12117355a02bSKonstantin Belousov 	val = hw_mds_disable;
12127355a02bSKonstantin Belousov 	error = sysctl_handle_int(oidp, &val, 0, req);
12137355a02bSKonstantin Belousov 	if (error != 0 || req->newptr == NULL)
12147355a02bSKonstantin Belousov 		return (error);
12157355a02bSKonstantin Belousov 	if (val < 0 || val > 3)
12167355a02bSKonstantin Belousov 		return (EINVAL);
12177355a02bSKonstantin Belousov 	hw_mds_disable = val;
12187355a02bSKonstantin Belousov 	hw_mds_recalculate();
12197355a02bSKonstantin Belousov 	return (0);
12207355a02bSKonstantin Belousov }
12217355a02bSKonstantin Belousov 
12227355a02bSKonstantin Belousov SYSCTL_PROC(_hw, OID_AUTO, mds_disable, CTLTYPE_INT |
12237355a02bSKonstantin Belousov     CTLFLAG_RWTUN | CTLFLAG_NOFETCH | CTLFLAG_MPSAFE, NULL, 0,
12247355a02bSKonstantin Belousov     sysctl_mds_disable_handler, "I",
12257355a02bSKonstantin Belousov     "Microarchitectural Data Sampling Mitigation "
1226a212f56dSPiotr Pawel Stefaniak     "(0 - off, 1 - on VERW, 2 - on SW, 3 - on AUTO)");
12277355a02bSKonstantin Belousov 
1228961aacb1SScott Long SYSCTL_PROC(_machdep_mitigations_mds, OID_AUTO, disable, CTLTYPE_INT |
1229961aacb1SScott Long     CTLFLAG_RWTUN | CTLFLAG_NOFETCH | CTLFLAG_MPSAFE, NULL, 0,
1230961aacb1SScott Long     sysctl_mds_disable_handler, "I",
1231961aacb1SScott Long     "Microarchitectural Data Sampling Mitigation "
1232a212f56dSPiotr Pawel Stefaniak     "(0 - off, 1 - on VERW, 2 - on SW, 3 - on AUTO)");
1233e3721601SScott Long 
1234e3721601SScott Long /*
1235e3721601SScott Long  * Intel Transactional Memory Asynchronous Abort Mitigation
1236e3721601SScott Long  * CVE-2019-11135
1237e3721601SScott Long  */
1238e3721601SScott Long int x86_taa_enable;
1239e3721601SScott Long int x86_taa_state;
1240e3721601SScott Long enum {
1241184b15ffSScott Long 	TAA_NONE	= 0,	/* No mitigation enabled */
1242184b15ffSScott Long 	TAA_TSX_DISABLE	= 1,	/* Disable TSX via MSR */
1243184b15ffSScott Long 	TAA_VERW	= 2,	/* Use VERW mitigation */
1244184b15ffSScott Long 	TAA_AUTO	= 3,	/* Automatically select the mitigation */
1245184b15ffSScott Long 
1246184b15ffSScott Long 	/* The states below are not selectable by the operator */
1247184b15ffSScott Long 
1248184b15ffSScott Long 	TAA_TAA_UC	= 4,	/* Mitigation present in microcode */
1249184b15ffSScott Long 	TAA_NOT_PRESENT	= 5	/* TSX is not present */
1250e3721601SScott Long };
1251e3721601SScott Long 
1252e3721601SScott Long static void
1253e3721601SScott Long taa_set(bool enable, bool all)
1254e3721601SScott Long {
1255e3721601SScott Long 
1256fa83f689SKonstantin Belousov 	x86_msr_op(MSR_IA32_TSX_CTRL,
1257fa83f689SKonstantin Belousov 	    (enable ? MSR_OP_OR : MSR_OP_ANDNOT) |
1258d0bc4b46SKonstantin Belousov 	    (all ? MSR_OP_RENDEZVOUS_ALL : MSR_OP_LOCAL),
1259d0bc4b46SKonstantin Belousov 	    IA32_TSX_CTRL_RTM_DISABLE | IA32_TSX_CTRL_TSX_CPUID_CLEAR,
1260d0bc4b46SKonstantin Belousov 	    NULL);
1261e3721601SScott Long }
1262e3721601SScott Long 
1263e3721601SScott Long void
1264e3721601SScott Long x86_taa_recalculate(void)
1265e3721601SScott Long {
1266e3721601SScott Long 	static int taa_saved_mds_disable = 0;
1267e3721601SScott Long 	int taa_need = 0, taa_state = 0;
1268e3721601SScott Long 	int mds_disable = 0, need_mds_recalc = 0;
1269e3721601SScott Long 
1270e3721601SScott Long 	/* Check CPUID.07h.EBX.HLE and RTM for the presence of TSX */
1271e3721601SScott Long 	if ((cpu_stdext_feature & CPUID_STDEXT_HLE) == 0 ||
1272e3721601SScott Long 	    (cpu_stdext_feature & CPUID_STDEXT_RTM) == 0) {
1273e3721601SScott Long 		/* TSX is not present */
1274184b15ffSScott Long 		x86_taa_state = TAA_NOT_PRESENT;
1275e3721601SScott Long 		return;
1276e3721601SScott Long 	}
1277e3721601SScott Long 
1278e3721601SScott Long 	/* Check to see what mitigation options the CPU gives us */
1279e3721601SScott Long 	if (cpu_ia32_arch_caps & IA32_ARCH_CAP_TAA_NO) {
1280e3721601SScott Long 		/* CPU is not suseptible to TAA */
12810d423176SScott Long 		taa_need = TAA_TAA_UC;
1282e3721601SScott Long 	} else if (cpu_ia32_arch_caps & IA32_ARCH_CAP_TSX_CTRL) {
1283e3721601SScott Long 		/*
1284e3721601SScott Long 		 * CPU can turn off TSX.  This is the next best option
1285e3721601SScott Long 		 * if TAA_NO hardware mitigation isn't present
1286e3721601SScott Long 		 */
1287e3721601SScott Long 		taa_need = TAA_TSX_DISABLE;
1288e3721601SScott Long 	} else {
1289e3721601SScott Long 		/* No TSX/TAA specific remedies are available. */
1290e3721601SScott Long 		if (x86_taa_enable == TAA_TSX_DISABLE) {
1291e3721601SScott Long 			if (bootverbose)
1292e3721601SScott Long 				printf("TSX control not available\n");
1293e3721601SScott Long 			return;
1294e3721601SScott Long 		} else
1295e3721601SScott Long 			taa_need = TAA_VERW;
1296e3721601SScott Long 	}
1297e3721601SScott Long 
1298e3721601SScott Long 	/* Can we automatically take action, or are we being forced? */
1299e3721601SScott Long 	if (x86_taa_enable == TAA_AUTO)
1300e3721601SScott Long 		taa_state = taa_need;
1301e3721601SScott Long 	else
1302e3721601SScott Long 		taa_state = x86_taa_enable;
1303e3721601SScott Long 
1304e3721601SScott Long 	/* No state change, nothing to do */
1305e3721601SScott Long 	if (taa_state == x86_taa_state) {
1306e3721601SScott Long 		if (bootverbose)
1307e3721601SScott Long 			printf("No TSX change made\n");
1308e3721601SScott Long 		return;
1309e3721601SScott Long 	}
1310e3721601SScott Long 
1311e3721601SScott Long 	/* Does the MSR need to be turned on or off? */
1312e3721601SScott Long 	if (taa_state == TAA_TSX_DISABLE)
1313e3721601SScott Long 		taa_set(true, true);
1314e3721601SScott Long 	else if (x86_taa_state == TAA_TSX_DISABLE)
1315e3721601SScott Long 		taa_set(false, true);
1316e3721601SScott Long 
1317e3721601SScott Long 	/* Does MDS need to be set to turn on VERW? */
1318e3721601SScott Long 	if (taa_state == TAA_VERW) {
1319e3721601SScott Long 		taa_saved_mds_disable = hw_mds_disable;
1320e3721601SScott Long 		mds_disable = hw_mds_disable = 1;
1321e3721601SScott Long 		need_mds_recalc = 1;
1322e3721601SScott Long 	} else if (x86_taa_state == TAA_VERW) {
1323e3721601SScott Long 		mds_disable = hw_mds_disable = taa_saved_mds_disable;
1324e3721601SScott Long 		need_mds_recalc = 1;
1325e3721601SScott Long 	}
1326e3721601SScott Long 	if (need_mds_recalc) {
1327e3721601SScott Long 		hw_mds_recalculate();
1328e3721601SScott Long 		if (mds_disable != hw_mds_disable) {
1329e3721601SScott Long 			if (bootverbose)
1330e3721601SScott Long 				printf("Cannot change MDS state for TAA\n");
1331e3721601SScott Long 			/* Don't update our state */
1332e3721601SScott Long 			return;
1333e3721601SScott Long 		}
1334e3721601SScott Long 	}
1335e3721601SScott Long 
1336e3721601SScott Long 	x86_taa_state = taa_state;
1337e3721601SScott Long 	return;
1338e3721601SScott Long }
1339e3721601SScott Long 
1340e3721601SScott Long static void
1341e3721601SScott Long taa_recalculate_boot(void * arg __unused)
1342e3721601SScott Long {
1343e3721601SScott Long 
1344e3721601SScott Long 	x86_taa_recalculate();
1345e3721601SScott Long }
1346e3721601SScott Long SYSINIT(taa_recalc, SI_SUB_SMP, SI_ORDER_ANY, taa_recalculate_boot, NULL);
1347e3721601SScott Long 
13487029da5cSPawel Biernacki SYSCTL_NODE(_machdep_mitigations, OID_AUTO, taa,
13497029da5cSPawel Biernacki     CTLFLAG_RW | CTLFLAG_MPSAFE, 0,
1350e3721601SScott Long     "TSX Asynchronous Abort Mitigation");
1351e3721601SScott Long 
1352e3721601SScott Long static int
1353e3721601SScott Long sysctl_taa_handler(SYSCTL_HANDLER_ARGS)
1354e3721601SScott Long {
1355e3721601SScott Long 	int error, val;
1356e3721601SScott Long 
1357e3721601SScott Long 	val = x86_taa_enable;
1358e3721601SScott Long 	error = sysctl_handle_int(oidp, &val, 0, req);
1359e3721601SScott Long 	if (error != 0 || req->newptr == NULL)
1360e3721601SScott Long 		return (error);
1361e3721601SScott Long 	if (val < TAA_NONE || val > TAA_AUTO)
1362e3721601SScott Long 		return (EINVAL);
1363e3721601SScott Long 	x86_taa_enable = val;
1364e3721601SScott Long 	x86_taa_recalculate();
1365e3721601SScott Long 	return (0);
1366e3721601SScott Long }
1367e3721601SScott Long 
1368e3721601SScott Long SYSCTL_PROC(_machdep_mitigations_taa, OID_AUTO, enable, CTLTYPE_INT |
1369e3721601SScott Long     CTLFLAG_RWTUN | CTLFLAG_NOFETCH | CTLFLAG_MPSAFE, NULL, 0,
1370e3721601SScott Long     sysctl_taa_handler, "I",
1371e3721601SScott Long     "TAA Mitigation enablement control "
1372a212f56dSPiotr Pawel Stefaniak     "(0 - off, 1 - disable TSX, 2 - VERW, 3 - on AUTO)");
1373e3721601SScott Long 
1374e3721601SScott Long static int
1375e3721601SScott Long sysctl_taa_state_handler(SYSCTL_HANDLER_ARGS)
1376e3721601SScott Long {
1377e3721601SScott Long 	const char *state;
1378e3721601SScott Long 
1379e3721601SScott Long 	switch (x86_taa_state) {
1380e3721601SScott Long 	case TAA_NONE:
1381e3721601SScott Long 		state = "inactive";
1382e3721601SScott Long 		break;
1383e3721601SScott Long 	case TAA_TSX_DISABLE:
1384e3721601SScott Long 		state = "TSX disabled";
1385e3721601SScott Long 		break;
1386e3721601SScott Long 	case TAA_VERW:
1387e3721601SScott Long 		state = "VERW";
1388e3721601SScott Long 		break;
1389184b15ffSScott Long 	case TAA_TAA_UC:
1390184b15ffSScott Long 		state = "Mitigated in microcode";
1391e3721601SScott Long 		break;
1392184b15ffSScott Long 	case TAA_NOT_PRESENT:
1393184b15ffSScott Long 		state = "TSX not present";
1394ee02bd9cSConrad Meyer 		break;
1395e3721601SScott Long 	default:
1396e3721601SScott Long 		state = "unknown";
1397e3721601SScott Long 	}
1398e3721601SScott Long 
1399e3721601SScott Long 	return (SYSCTL_OUT(req, state, strlen(state)));
1400e3721601SScott Long }
1401e3721601SScott Long 
1402e3721601SScott Long SYSCTL_PROC(_machdep_mitigations_taa, OID_AUTO, state,
1403e3721601SScott Long     CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE, NULL, 0,
1404e3721601SScott Long     sysctl_taa_state_handler, "A",
1405e3721601SScott Long     "TAA Mitigation state");
1406e3721601SScott Long 
1407ea602083SKonstantin Belousov int __read_frequently cpu_flush_rsb_ctxsw;
1408ea602083SKonstantin Belousov SYSCTL_INT(_machdep_mitigations, OID_AUTO, flush_rsb_ctxsw,
1409ea602083SKonstantin Belousov     CTLFLAG_RW | CTLFLAG_NOFETCH, &cpu_flush_rsb_ctxsw, 0,
1410ea602083SKonstantin Belousov     "Flush Return Stack Buffer on context switch");
1411ea602083SKonstantin Belousov 
141217edf152SKonstantin Belousov SYSCTL_NODE(_machdep_mitigations, OID_AUTO, rngds,
141317edf152SKonstantin Belousov     CTLFLAG_RW | CTLFLAG_MPSAFE, 0,
141417edf152SKonstantin Belousov     "MCU Optimization, disable RDSEED mitigation");
141517edf152SKonstantin Belousov 
141617edf152SKonstantin Belousov int x86_rngds_mitg_enable = 1;
141717edf152SKonstantin Belousov void
141817edf152SKonstantin Belousov x86_rngds_mitg_recalculate(bool all_cpus)
141917edf152SKonstantin Belousov {
142017edf152SKonstantin Belousov 	if ((cpu_stdext_feature3 & CPUID_STDEXT3_MCUOPT) == 0)
142117edf152SKonstantin Belousov 		return;
142217edf152SKonstantin Belousov 	x86_msr_op(MSR_IA32_MCU_OPT_CTRL,
142317edf152SKonstantin Belousov 	    (x86_rngds_mitg_enable ? MSR_OP_OR : MSR_OP_ANDNOT) |
1424d0bc4b46SKonstantin Belousov 	    (all_cpus ? MSR_OP_RENDEZVOUS_ALL : MSR_OP_LOCAL),
1425d0bc4b46SKonstantin Belousov 	    IA32_RNGDS_MITG_DIS, NULL);
142617edf152SKonstantin Belousov }
142717edf152SKonstantin Belousov 
142817edf152SKonstantin Belousov static int
142917edf152SKonstantin Belousov sysctl_rngds_mitg_enable_handler(SYSCTL_HANDLER_ARGS)
143017edf152SKonstantin Belousov {
143117edf152SKonstantin Belousov 	int error, val;
143217edf152SKonstantin Belousov 
143317edf152SKonstantin Belousov 	val = x86_rngds_mitg_enable;
143417edf152SKonstantin Belousov 	error = sysctl_handle_int(oidp, &val, 0, req);
143517edf152SKonstantin Belousov 	if (error != 0 || req->newptr == NULL)
143617edf152SKonstantin Belousov 		return (error);
143717edf152SKonstantin Belousov 	x86_rngds_mitg_enable = val;
143817edf152SKonstantin Belousov 	x86_rngds_mitg_recalculate(true);
143917edf152SKonstantin Belousov 	return (0);
144017edf152SKonstantin Belousov }
144117edf152SKonstantin Belousov SYSCTL_PROC(_machdep_mitigations_rngds, OID_AUTO, enable, CTLTYPE_INT |
144217edf152SKonstantin Belousov     CTLFLAG_RWTUN | CTLFLAG_NOFETCH | CTLFLAG_MPSAFE, NULL, 0,
144317edf152SKonstantin Belousov     sysctl_rngds_mitg_enable_handler, "I",
144417edf152SKonstantin Belousov     "MCU Optimization, disabling RDSEED mitigation control "
1445a212f56dSPiotr Pawel Stefaniak     "(0 - mitigation disabled (RDSEED optimized), 1 - mitigation enabled)");
144617edf152SKonstantin Belousov 
144717edf152SKonstantin Belousov static int
144817edf152SKonstantin Belousov sysctl_rngds_state_handler(SYSCTL_HANDLER_ARGS)
144917edf152SKonstantin Belousov {
145017edf152SKonstantin Belousov 	const char *state;
145117edf152SKonstantin Belousov 
145217edf152SKonstantin Belousov 	if ((cpu_stdext_feature3 & CPUID_STDEXT3_MCUOPT) == 0) {
145317edf152SKonstantin Belousov 		state = "Not applicable";
145417edf152SKonstantin Belousov 	} else if (x86_rngds_mitg_enable == 0) {
145517edf152SKonstantin Belousov 		state = "RDSEED not serialized";
145617edf152SKonstantin Belousov 	} else {
145717edf152SKonstantin Belousov 		state = "Mitigated";
145817edf152SKonstantin Belousov 	}
145917edf152SKonstantin Belousov 	return (SYSCTL_OUT(req, state, strlen(state)));
146017edf152SKonstantin Belousov }
146117edf152SKonstantin Belousov SYSCTL_PROC(_machdep_mitigations_rngds, OID_AUTO, state,
146217edf152SKonstantin Belousov     CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE, NULL, 0,
146317edf152SKonstantin Belousov     sysctl_rngds_state_handler, "A",
146417edf152SKonstantin Belousov     "MCU Optimization state");
146517edf152SKonstantin Belousov 
14668fbcc334SKonstantin Belousov /*
14678fbcc334SKonstantin Belousov  * Enable and restore kernel text write permissions.
14688fbcc334SKonstantin Belousov  * Callers must ensure that disable_wp()/restore_wp() are executed
14698fbcc334SKonstantin Belousov  * without rescheduling on the same core.
14708fbcc334SKonstantin Belousov  */
14718fbcc334SKonstantin Belousov bool
14728fbcc334SKonstantin Belousov disable_wp(void)
14738fbcc334SKonstantin Belousov {
14748fbcc334SKonstantin Belousov 	u_int cr0;
14758fbcc334SKonstantin Belousov 
14768fbcc334SKonstantin Belousov 	cr0 = rcr0();
14778fbcc334SKonstantin Belousov 	if ((cr0 & CR0_WP) == 0)
14788fbcc334SKonstantin Belousov 		return (false);
14798fbcc334SKonstantin Belousov 	load_cr0(cr0 & ~CR0_WP);
14808fbcc334SKonstantin Belousov 	return (true);
14818fbcc334SKonstantin Belousov }
14828fbcc334SKonstantin Belousov 
14838fbcc334SKonstantin Belousov void
14848fbcc334SKonstantin Belousov restore_wp(bool old_wp)
14858fbcc334SKonstantin Belousov {
14868fbcc334SKonstantin Belousov 
14878fbcc334SKonstantin Belousov 	if (old_wp)
14888fbcc334SKonstantin Belousov 		load_cr0(rcr0() | CR0_WP);
14898fbcc334SKonstantin Belousov }
14908fbcc334SKonstantin Belousov 
14917705dd4dSKonstantin Belousov bool
14927705dd4dSKonstantin Belousov acpi_get_fadt_bootflags(uint16_t *flagsp)
14937705dd4dSKonstantin Belousov {
14947705dd4dSKonstantin Belousov #ifdef DEV_ACPI
14957705dd4dSKonstantin Belousov 	ACPI_TABLE_FADT *fadt;
14967705dd4dSKonstantin Belousov 	vm_paddr_t physaddr;
14977705dd4dSKonstantin Belousov 
14987705dd4dSKonstantin Belousov 	physaddr = acpi_find_table(ACPI_SIG_FADT);
14997705dd4dSKonstantin Belousov 	if (physaddr == 0)
15007705dd4dSKonstantin Belousov 		return (false);
15017705dd4dSKonstantin Belousov 	fadt = acpi_map_table(physaddr, ACPI_SIG_FADT);
15027705dd4dSKonstantin Belousov 	if (fadt == NULL)
15037705dd4dSKonstantin Belousov 		return (false);
15047705dd4dSKonstantin Belousov 	*flagsp = fadt->BootFlags;
15057705dd4dSKonstantin Belousov 	acpi_unmap_table(fadt);
15067705dd4dSKonstantin Belousov 	return (true);
15077705dd4dSKonstantin Belousov #else
15087705dd4dSKonstantin Belousov 	return (false);
15097705dd4dSKonstantin Belousov #endif
15107705dd4dSKonstantin Belousov }
1511652ae7b1SAdam Fenn 
1512652ae7b1SAdam Fenn DEFINE_IFUNC(, uint64_t, rdtsc_ordered, (void))
1513652ae7b1SAdam Fenn {
1514652ae7b1SAdam Fenn 	bool cpu_is_amd = cpu_vendor_id == CPU_VENDOR_AMD ||
1515652ae7b1SAdam Fenn 	    cpu_vendor_id == CPU_VENDOR_HYGON;
1516652ae7b1SAdam Fenn 
1517652ae7b1SAdam Fenn 	if ((amd_feature & AMDID_RDTSCP) != 0)
1518652ae7b1SAdam Fenn 		return (rdtscp);
1519652ae7b1SAdam Fenn 	else if ((cpu_feature & CPUID_SSE2) != 0)
1520652ae7b1SAdam Fenn 		return (cpu_is_amd ? rdtsc_ordered_mfence :
1521652ae7b1SAdam Fenn 		    rdtsc_ordered_lfence);
1522652ae7b1SAdam Fenn 	else
1523652ae7b1SAdam Fenn 		return (rdtsc);
1524652ae7b1SAdam Fenn }
1525