xref: /freebsd/sys/x86/x86/cpu_machdep.c (revision 55ba21d4fdd4003bab66e79325f21322307c7ae8)
1dfe7b3bfSKonstantin Belousov /*-
2dfe7b3bfSKonstantin Belousov  * Copyright (c) 2003 Peter Wemm.
3dfe7b3bfSKonstantin Belousov  * Copyright (c) 1992 Terrence R. Lambert.
4dfe7b3bfSKonstantin Belousov  * Copyright (c) 1982, 1987, 1990 The Regents of the University of California.
5dfe7b3bfSKonstantin Belousov  * All rights reserved.
6dfe7b3bfSKonstantin Belousov  *
7dfe7b3bfSKonstantin Belousov  * This code is derived from software contributed to Berkeley by
8dfe7b3bfSKonstantin Belousov  * William Jolitz.
9dfe7b3bfSKonstantin Belousov  *
10dfe7b3bfSKonstantin Belousov  * Redistribution and use in source and binary forms, with or without
11dfe7b3bfSKonstantin Belousov  * modification, are permitted provided that the following conditions
12dfe7b3bfSKonstantin Belousov  * are met:
13dfe7b3bfSKonstantin Belousov  * 1. Redistributions of source code must retain the above copyright
14dfe7b3bfSKonstantin Belousov  *    notice, this list of conditions and the following disclaimer.
15dfe7b3bfSKonstantin Belousov  * 2. Redistributions in binary form must reproduce the above copyright
16dfe7b3bfSKonstantin Belousov  *    notice, this list of conditions and the following disclaimer in the
17dfe7b3bfSKonstantin Belousov  *    documentation and/or other materials provided with the distribution.
18dfe7b3bfSKonstantin Belousov  * 3. All advertising materials mentioning features or use of this software
19dfe7b3bfSKonstantin Belousov  *    must display the following acknowledgement:
20dfe7b3bfSKonstantin Belousov  *	This product includes software developed by the University of
21dfe7b3bfSKonstantin Belousov  *	California, Berkeley and its contributors.
22dfe7b3bfSKonstantin Belousov  * 4. Neither the name of the University nor the names of its contributors
23dfe7b3bfSKonstantin Belousov  *    may be used to endorse or promote products derived from this software
24dfe7b3bfSKonstantin Belousov  *    without specific prior written permission.
25dfe7b3bfSKonstantin Belousov  *
26dfe7b3bfSKonstantin Belousov  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
27dfe7b3bfSKonstantin Belousov  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
28dfe7b3bfSKonstantin Belousov  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
29dfe7b3bfSKonstantin Belousov  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
30dfe7b3bfSKonstantin Belousov  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
31dfe7b3bfSKonstantin Belousov  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
32dfe7b3bfSKonstantin Belousov  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
33dfe7b3bfSKonstantin Belousov  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
34dfe7b3bfSKonstantin Belousov  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
35dfe7b3bfSKonstantin Belousov  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
36dfe7b3bfSKonstantin Belousov  * SUCH DAMAGE.
37dfe7b3bfSKonstantin Belousov  *
38dfe7b3bfSKonstantin Belousov  *	from: @(#)machdep.c	7.4 (Berkeley) 6/3/91
39dfe7b3bfSKonstantin Belousov  */
40dfe7b3bfSKonstantin Belousov 
41dfe7b3bfSKonstantin Belousov #include <sys/cdefs.h>
42dfe7b3bfSKonstantin Belousov __FBSDID("$FreeBSD$");
43dfe7b3bfSKonstantin Belousov 
44dfe7b3bfSKonstantin Belousov #include "opt_atpic.h"
45dfe7b3bfSKonstantin Belousov #include "opt_cpu.h"
46dfe7b3bfSKonstantin Belousov #include "opt_ddb.h"
47dfe7b3bfSKonstantin Belousov #include "opt_inet.h"
48dfe7b3bfSKonstantin Belousov #include "opt_isa.h"
49835c2787SKonstantin Belousov #include "opt_kdb.h"
50dfe7b3bfSKonstantin Belousov #include "opt_kstack_pages.h"
51dfe7b3bfSKonstantin Belousov #include "opt_maxmem.h"
52dfe7b3bfSKonstantin Belousov #include "opt_mp_watchdog.h"
53dfe7b3bfSKonstantin Belousov #include "opt_platform.h"
54dfe7b3bfSKonstantin Belousov #ifdef __i386__
55dfe7b3bfSKonstantin Belousov #include "opt_apic.h"
56dfe7b3bfSKonstantin Belousov #endif
57dfe7b3bfSKonstantin Belousov 
58dfe7b3bfSKonstantin Belousov #include <sys/param.h>
59dfe7b3bfSKonstantin Belousov #include <sys/proc.h>
60dfe7b3bfSKonstantin Belousov #include <sys/systm.h>
61dfe7b3bfSKonstantin Belousov #include <sys/bus.h>
62dfe7b3bfSKonstantin Belousov #include <sys/cpu.h>
63dfe7b3bfSKonstantin Belousov #include <sys/kdb.h>
64dfe7b3bfSKonstantin Belousov #include <sys/kernel.h>
65dfe7b3bfSKonstantin Belousov #include <sys/ktr.h>
66dfe7b3bfSKonstantin Belousov #include <sys/lock.h>
67dfe7b3bfSKonstantin Belousov #include <sys/malloc.h>
68dfe7b3bfSKonstantin Belousov #include <sys/mutex.h>
69dfe7b3bfSKonstantin Belousov #include <sys/pcpu.h>
70dfe7b3bfSKonstantin Belousov #include <sys/rwlock.h>
71dfe7b3bfSKonstantin Belousov #include <sys/sched.h>
72dfe7b3bfSKonstantin Belousov #ifdef SMP
73dfe7b3bfSKonstantin Belousov #include <sys/smp.h>
74dfe7b3bfSKonstantin Belousov #endif
75dfe7b3bfSKonstantin Belousov #include <sys/sysctl.h>
76dfe7b3bfSKonstantin Belousov 
77dfe7b3bfSKonstantin Belousov #include <machine/clock.h>
78dfe7b3bfSKonstantin Belousov #include <machine/cpu.h>
79dfe7b3bfSKonstantin Belousov #include <machine/cputypes.h>
80dfe7b3bfSKonstantin Belousov #include <machine/specialreg.h>
81dfe7b3bfSKonstantin Belousov #include <machine/md_var.h>
82dfe7b3bfSKonstantin Belousov #include <machine/mp_watchdog.h>
83dfe7b3bfSKonstantin Belousov #include <machine/tss.h>
84dfe7b3bfSKonstantin Belousov #ifdef SMP
85dfe7b3bfSKonstantin Belousov #include <machine/smp.h>
86dfe7b3bfSKonstantin Belousov #endif
873da25bdbSAndriy Gapon #ifdef CPU_ELAN
883da25bdbSAndriy Gapon #include <machine/elan_mmcr.h>
893da25bdbSAndriy Gapon #endif
90b57a73f8SKonstantin Belousov #include <x86/acpica_machdep.h>
91dfe7b3bfSKonstantin Belousov 
92dfe7b3bfSKonstantin Belousov #include <vm/vm.h>
93dfe7b3bfSKonstantin Belousov #include <vm/vm_extern.h>
94dfe7b3bfSKonstantin Belousov #include <vm/vm_kern.h>
95dfe7b3bfSKonstantin Belousov #include <vm/vm_page.h>
96dfe7b3bfSKonstantin Belousov #include <vm/vm_map.h>
97dfe7b3bfSKonstantin Belousov #include <vm/vm_object.h>
98dfe7b3bfSKonstantin Belousov #include <vm/vm_pager.h>
99dfe7b3bfSKonstantin Belousov #include <vm/vm_param.h>
100dfe7b3bfSKonstantin Belousov 
1018428d0f1SAndriy Gapon #include <isa/isareg.h>
1028428d0f1SAndriy Gapon 
103d9e8bbb6SKonstantin Belousov #define	STATE_RUNNING	0x0
104d9e8bbb6SKonstantin Belousov #define	STATE_MWAIT	0x1
105d9e8bbb6SKonstantin Belousov #define	STATE_SLEEPING	0x2
106d9e8bbb6SKonstantin Belousov 
1078428d0f1SAndriy Gapon #ifdef SMP
1088428d0f1SAndriy Gapon static u_int	cpu_reset_proxyid;
1098428d0f1SAndriy Gapon static volatile u_int	cpu_reset_proxy_active;
1108428d0f1SAndriy Gapon #endif
1118428d0f1SAndriy Gapon 
1128428d0f1SAndriy Gapon 
113dfe7b3bfSKonstantin Belousov /*
114dfe7b3bfSKonstantin Belousov  * Machine dependent boot() routine
115dfe7b3bfSKonstantin Belousov  *
116dfe7b3bfSKonstantin Belousov  * I haven't seen anything to put here yet
117dfe7b3bfSKonstantin Belousov  * Possibly some stuff might be grafted back here from boot()
118dfe7b3bfSKonstantin Belousov  */
119dfe7b3bfSKonstantin Belousov void
120dfe7b3bfSKonstantin Belousov cpu_boot(int howto)
121dfe7b3bfSKonstantin Belousov {
122dfe7b3bfSKonstantin Belousov }
123dfe7b3bfSKonstantin Belousov 
124dfe7b3bfSKonstantin Belousov /*
125dfe7b3bfSKonstantin Belousov  * Flush the D-cache for non-DMA I/O so that the I-cache can
126dfe7b3bfSKonstantin Belousov  * be made coherent later.
127dfe7b3bfSKonstantin Belousov  */
128dfe7b3bfSKonstantin Belousov void
129dfe7b3bfSKonstantin Belousov cpu_flush_dcache(void *ptr, size_t len)
130dfe7b3bfSKonstantin Belousov {
131dfe7b3bfSKonstantin Belousov 	/* Not applicable */
132dfe7b3bfSKonstantin Belousov }
133dfe7b3bfSKonstantin Belousov 
134b57a73f8SKonstantin Belousov void
135b57a73f8SKonstantin Belousov acpi_cpu_c1(void)
136b57a73f8SKonstantin Belousov {
137b57a73f8SKonstantin Belousov 
138b57a73f8SKonstantin Belousov 	__asm __volatile("sti; hlt");
139b57a73f8SKonstantin Belousov }
140b57a73f8SKonstantin Belousov 
14119d4720bSJonathan T. Looney /*
14219d4720bSJonathan T. Looney  * Use mwait to pause execution while waiting for an interrupt or
14319d4720bSJonathan T. Looney  * another thread to signal that there is more work.
14419d4720bSJonathan T. Looney  *
14519d4720bSJonathan T. Looney  * NOTE: Interrupts will cause a wakeup; however, this function does
14619d4720bSJonathan T. Looney  * not enable interrupt handling. The caller is responsible to enable
14719d4720bSJonathan T. Looney  * interrupts.
14819d4720bSJonathan T. Looney  */
149b57a73f8SKonstantin Belousov void
150b57a73f8SKonstantin Belousov acpi_cpu_idle_mwait(uint32_t mwait_hint)
151b57a73f8SKonstantin Belousov {
152b57a73f8SKonstantin Belousov 	int *state;
153b57a73f8SKonstantin Belousov 
154b57a73f8SKonstantin Belousov 	/*
155319117fdSKonstantin Belousov 	 * A comment in Linux patch claims that 'CPUs run faster with
156319117fdSKonstantin Belousov 	 * speculation protection disabled. All CPU threads in a core
157319117fdSKonstantin Belousov 	 * must disable speculation protection for it to be
158319117fdSKonstantin Belousov 	 * disabled. Disable it while we are idle so the other
159319117fdSKonstantin Belousov 	 * hyperthread can run fast.'
160319117fdSKonstantin Belousov 	 *
161b57a73f8SKonstantin Belousov 	 * XXXKIB.  Software coordination mode should be supported,
162b57a73f8SKonstantin Belousov 	 * but all Intel CPUs provide hardware coordination.
163b57a73f8SKonstantin Belousov 	 */
164d9e8bbb6SKonstantin Belousov 
165d9e8bbb6SKonstantin Belousov 	state = (int *)PCPU_PTR(monitorbuf);
166a5bd21d0SKonstantin Belousov 	KASSERT(atomic_load_int(state) == STATE_SLEEPING,
167d9e8bbb6SKonstantin Belousov 	    ("cpu_mwait_cx: wrong monitorbuf state"));
168a5bd21d0SKonstantin Belousov 	atomic_store_int(state, STATE_MWAIT);
169319117fdSKonstantin Belousov 	handle_ibrs_entry();
170b57a73f8SKonstantin Belousov 	cpu_monitor(state, 0, 0);
171a5bd21d0SKonstantin Belousov 	if (atomic_load_int(state) == STATE_MWAIT)
172b57a73f8SKonstantin Belousov 		cpu_mwait(MWAIT_INTRBREAK, mwait_hint);
173319117fdSKonstantin Belousov 	handle_ibrs_exit();
174d9e8bbb6SKonstantin Belousov 
175d9e8bbb6SKonstantin Belousov 	/*
176d9e8bbb6SKonstantin Belousov 	 * We should exit on any event that interrupts mwait, because
177d9e8bbb6SKonstantin Belousov 	 * that event might be a wanted interrupt.
178d9e8bbb6SKonstantin Belousov 	 */
179a5bd21d0SKonstantin Belousov 	atomic_store_int(state, STATE_RUNNING);
180b57a73f8SKonstantin Belousov }
181b57a73f8SKonstantin Belousov 
182dfe7b3bfSKonstantin Belousov /* Get current clock frequency for the given cpu id. */
183dfe7b3bfSKonstantin Belousov int
184dfe7b3bfSKonstantin Belousov cpu_est_clockrate(int cpu_id, uint64_t *rate)
185dfe7b3bfSKonstantin Belousov {
186dfe7b3bfSKonstantin Belousov 	uint64_t tsc1, tsc2;
187dfe7b3bfSKonstantin Belousov 	uint64_t acnt, mcnt, perf;
188dfe7b3bfSKonstantin Belousov 	register_t reg;
189dfe7b3bfSKonstantin Belousov 
190dfe7b3bfSKonstantin Belousov 	if (pcpu_find(cpu_id) == NULL || rate == NULL)
191dfe7b3bfSKonstantin Belousov 		return (EINVAL);
192dfe7b3bfSKonstantin Belousov #ifdef __i386__
193dfe7b3bfSKonstantin Belousov 	if ((cpu_feature & CPUID_TSC) == 0)
194dfe7b3bfSKonstantin Belousov 		return (EOPNOTSUPP);
195dfe7b3bfSKonstantin Belousov #endif
196dfe7b3bfSKonstantin Belousov 
197dfe7b3bfSKonstantin Belousov 	/*
198dfe7b3bfSKonstantin Belousov 	 * If TSC is P-state invariant and APERF/MPERF MSRs do not exist,
199dfe7b3bfSKonstantin Belousov 	 * DELAY(9) based logic fails.
200dfe7b3bfSKonstantin Belousov 	 */
201dfe7b3bfSKonstantin Belousov 	if (tsc_is_invariant && !tsc_perf_stat)
202dfe7b3bfSKonstantin Belousov 		return (EOPNOTSUPP);
203dfe7b3bfSKonstantin Belousov 
204dfe7b3bfSKonstantin Belousov #ifdef SMP
205dfe7b3bfSKonstantin Belousov 	if (smp_cpus > 1) {
206dfe7b3bfSKonstantin Belousov 		/* Schedule ourselves on the indicated cpu. */
207dfe7b3bfSKonstantin Belousov 		thread_lock(curthread);
208dfe7b3bfSKonstantin Belousov 		sched_bind(curthread, cpu_id);
209dfe7b3bfSKonstantin Belousov 		thread_unlock(curthread);
210dfe7b3bfSKonstantin Belousov 	}
211dfe7b3bfSKonstantin Belousov #endif
212dfe7b3bfSKonstantin Belousov 
213dfe7b3bfSKonstantin Belousov 	/* Calibrate by measuring a short delay. */
214dfe7b3bfSKonstantin Belousov 	reg = intr_disable();
215dfe7b3bfSKonstantin Belousov 	if (tsc_is_invariant) {
216dfe7b3bfSKonstantin Belousov 		wrmsr(MSR_MPERF, 0);
217dfe7b3bfSKonstantin Belousov 		wrmsr(MSR_APERF, 0);
218dfe7b3bfSKonstantin Belousov 		tsc1 = rdtsc();
219dfe7b3bfSKonstantin Belousov 		DELAY(1000);
220dfe7b3bfSKonstantin Belousov 		mcnt = rdmsr(MSR_MPERF);
221dfe7b3bfSKonstantin Belousov 		acnt = rdmsr(MSR_APERF);
222dfe7b3bfSKonstantin Belousov 		tsc2 = rdtsc();
223dfe7b3bfSKonstantin Belousov 		intr_restore(reg);
224dfe7b3bfSKonstantin Belousov 		perf = 1000 * acnt / mcnt;
225dfe7b3bfSKonstantin Belousov 		*rate = (tsc2 - tsc1) * perf;
226dfe7b3bfSKonstantin Belousov 	} else {
227dfe7b3bfSKonstantin Belousov 		tsc1 = rdtsc();
228dfe7b3bfSKonstantin Belousov 		DELAY(1000);
229dfe7b3bfSKonstantin Belousov 		tsc2 = rdtsc();
230dfe7b3bfSKonstantin Belousov 		intr_restore(reg);
231dfe7b3bfSKonstantin Belousov 		*rate = (tsc2 - tsc1) * 1000;
232dfe7b3bfSKonstantin Belousov 	}
233dfe7b3bfSKonstantin Belousov 
234dfe7b3bfSKonstantin Belousov #ifdef SMP
235dfe7b3bfSKonstantin Belousov 	if (smp_cpus > 1) {
236dfe7b3bfSKonstantin Belousov 		thread_lock(curthread);
237dfe7b3bfSKonstantin Belousov 		sched_unbind(curthread);
238dfe7b3bfSKonstantin Belousov 		thread_unlock(curthread);
239dfe7b3bfSKonstantin Belousov 	}
240dfe7b3bfSKonstantin Belousov #endif
241dfe7b3bfSKonstantin Belousov 
242dfe7b3bfSKonstantin Belousov 	return (0);
243dfe7b3bfSKonstantin Belousov }
244dfe7b3bfSKonstantin Belousov 
245dfe7b3bfSKonstantin Belousov /*
246dfe7b3bfSKonstantin Belousov  * Shutdown the CPU as much as possible
247dfe7b3bfSKonstantin Belousov  */
248dfe7b3bfSKonstantin Belousov void
249dfe7b3bfSKonstantin Belousov cpu_halt(void)
250dfe7b3bfSKonstantin Belousov {
251dfe7b3bfSKonstantin Belousov 	for (;;)
252dfe7b3bfSKonstantin Belousov 		halt();
253dfe7b3bfSKonstantin Belousov }
254dfe7b3bfSKonstantin Belousov 
2558428d0f1SAndriy Gapon static void
256b7b25af0SAndriy Gapon cpu_reset_real(void)
2578428d0f1SAndriy Gapon {
2588428d0f1SAndriy Gapon 	struct region_descriptor null_idt;
2598428d0f1SAndriy Gapon 	int b;
2608428d0f1SAndriy Gapon 
2618428d0f1SAndriy Gapon 	disable_intr();
2628428d0f1SAndriy Gapon #ifdef CPU_ELAN
2638428d0f1SAndriy Gapon 	if (elan_mmcr != NULL)
2648428d0f1SAndriy Gapon 		elan_mmcr->RESCFG = 1;
2658428d0f1SAndriy Gapon #endif
2668428d0f1SAndriy Gapon #ifdef __i386__
2678428d0f1SAndriy Gapon 	if (cpu == CPU_GEODE1100) {
2688428d0f1SAndriy Gapon 		/* Attempt Geode's own reset */
2698428d0f1SAndriy Gapon 		outl(0xcf8, 0x80009044ul);
2708428d0f1SAndriy Gapon 		outl(0xcfc, 0xf);
2718428d0f1SAndriy Gapon 	}
2728428d0f1SAndriy Gapon #endif
2738428d0f1SAndriy Gapon #if !defined(BROKEN_KEYBOARD_RESET)
2748428d0f1SAndriy Gapon 	/*
2758428d0f1SAndriy Gapon 	 * Attempt to do a CPU reset via the keyboard controller,
2768428d0f1SAndriy Gapon 	 * do not turn off GateA20, as any machine that fails
2778428d0f1SAndriy Gapon 	 * to do the reset here would then end up in no man's land.
2788428d0f1SAndriy Gapon 	 */
2798428d0f1SAndriy Gapon 	outb(IO_KBD + 4, 0xFE);
2808428d0f1SAndriy Gapon 	DELAY(500000);	/* wait 0.5 sec to see if that did it */
2818428d0f1SAndriy Gapon #endif
2828428d0f1SAndriy Gapon 
2838428d0f1SAndriy Gapon 	/*
2848428d0f1SAndriy Gapon 	 * Attempt to force a reset via the Reset Control register at
2858428d0f1SAndriy Gapon 	 * I/O port 0xcf9.  Bit 2 forces a system reset when it
2868428d0f1SAndriy Gapon 	 * transitions from 0 to 1.  Bit 1 selects the type of reset
2878428d0f1SAndriy Gapon 	 * to attempt: 0 selects a "soft" reset, and 1 selects a
2888428d0f1SAndriy Gapon 	 * "hard" reset.  We try a "hard" reset.  The first write sets
2898428d0f1SAndriy Gapon 	 * bit 1 to select a "hard" reset and clears bit 2.  The
2908428d0f1SAndriy Gapon 	 * second write forces a 0 -> 1 transition in bit 2 to trigger
2918428d0f1SAndriy Gapon 	 * a reset.
2928428d0f1SAndriy Gapon 	 */
2938428d0f1SAndriy Gapon 	outb(0xcf9, 0x2);
2948428d0f1SAndriy Gapon 	outb(0xcf9, 0x6);
2958428d0f1SAndriy Gapon 	DELAY(500000);  /* wait 0.5 sec to see if that did it */
2968428d0f1SAndriy Gapon 
2978428d0f1SAndriy Gapon 	/*
2988428d0f1SAndriy Gapon 	 * Attempt to force a reset via the Fast A20 and Init register
2998428d0f1SAndriy Gapon 	 * at I/O port 0x92.  Bit 1 serves as an alternate A20 gate.
3008428d0f1SAndriy Gapon 	 * Bit 0 asserts INIT# when set to 1.  We are careful to only
3018428d0f1SAndriy Gapon 	 * preserve bit 1 while setting bit 0.  We also must clear bit
3028428d0f1SAndriy Gapon 	 * 0 before setting it if it isn't already clear.
3038428d0f1SAndriy Gapon 	 */
3048428d0f1SAndriy Gapon 	b = inb(0x92);
3058428d0f1SAndriy Gapon 	if (b != 0xff) {
3068428d0f1SAndriy Gapon 		if ((b & 0x1) != 0)
3078428d0f1SAndriy Gapon 			outb(0x92, b & 0xfe);
3088428d0f1SAndriy Gapon 		outb(0x92, b | 0x1);
3098428d0f1SAndriy Gapon 		DELAY(500000);  /* wait 0.5 sec to see if that did it */
3108428d0f1SAndriy Gapon 	}
3118428d0f1SAndriy Gapon 
3128428d0f1SAndriy Gapon 	printf("No known reset method worked, attempting CPU shutdown\n");
3138428d0f1SAndriy Gapon 	DELAY(1000000); /* wait 1 sec for printf to complete */
3148428d0f1SAndriy Gapon 
3158428d0f1SAndriy Gapon 	/* Wipe the IDT. */
3168428d0f1SAndriy Gapon 	null_idt.rd_limit = 0;
3178428d0f1SAndriy Gapon 	null_idt.rd_base = 0;
3188428d0f1SAndriy Gapon 	lidt(&null_idt);
3198428d0f1SAndriy Gapon 
3208428d0f1SAndriy Gapon 	/* "good night, sweet prince .... <THUNK!>" */
3218428d0f1SAndriy Gapon 	breakpoint();
3228428d0f1SAndriy Gapon 
3238428d0f1SAndriy Gapon 	/* NOTREACHED */
3248428d0f1SAndriy Gapon 	while(1);
3258428d0f1SAndriy Gapon }
3268428d0f1SAndriy Gapon 
3278428d0f1SAndriy Gapon #ifdef SMP
3288428d0f1SAndriy Gapon static void
329b7b25af0SAndriy Gapon cpu_reset_proxy(void)
3308428d0f1SAndriy Gapon {
3318428d0f1SAndriy Gapon 
3328428d0f1SAndriy Gapon 	cpu_reset_proxy_active = 1;
3338428d0f1SAndriy Gapon 	while (cpu_reset_proxy_active == 1)
3348428d0f1SAndriy Gapon 		ia32_pause(); /* Wait for other cpu to see that we've started */
3358428d0f1SAndriy Gapon 
3368428d0f1SAndriy Gapon 	printf("cpu_reset_proxy: Stopped CPU %d\n", cpu_reset_proxyid);
3378428d0f1SAndriy Gapon 	DELAY(1000000);
3388428d0f1SAndriy Gapon 	cpu_reset_real();
3398428d0f1SAndriy Gapon }
3408428d0f1SAndriy Gapon #endif
3418428d0f1SAndriy Gapon 
3428428d0f1SAndriy Gapon void
343b7b25af0SAndriy Gapon cpu_reset(void)
3448428d0f1SAndriy Gapon {
3458428d0f1SAndriy Gapon #ifdef SMP
3468428d0f1SAndriy Gapon 	cpuset_t map;
3478428d0f1SAndriy Gapon 	u_int cnt;
3488428d0f1SAndriy Gapon 
3498428d0f1SAndriy Gapon 	if (smp_started) {
3508428d0f1SAndriy Gapon 		map = all_cpus;
3518428d0f1SAndriy Gapon 		CPU_CLR(PCPU_GET(cpuid), &map);
3528428d0f1SAndriy Gapon 		CPU_NAND(&map, &stopped_cpus);
3538428d0f1SAndriy Gapon 		if (!CPU_EMPTY(&map)) {
3548428d0f1SAndriy Gapon 			printf("cpu_reset: Stopping other CPUs\n");
3558428d0f1SAndriy Gapon 			stop_cpus(map);
3568428d0f1SAndriy Gapon 		}
3578428d0f1SAndriy Gapon 
3588428d0f1SAndriy Gapon 		if (PCPU_GET(cpuid) != 0) {
3598428d0f1SAndriy Gapon 			cpu_reset_proxyid = PCPU_GET(cpuid);
3608428d0f1SAndriy Gapon 			cpustop_restartfunc = cpu_reset_proxy;
3618428d0f1SAndriy Gapon 			cpu_reset_proxy_active = 0;
3628428d0f1SAndriy Gapon 			printf("cpu_reset: Restarting BSP\n");
3638428d0f1SAndriy Gapon 
3648428d0f1SAndriy Gapon 			/* Restart CPU #0. */
3658428d0f1SAndriy Gapon 			CPU_SETOF(0, &started_cpus);
3668428d0f1SAndriy Gapon 			wmb();
3678428d0f1SAndriy Gapon 
3688428d0f1SAndriy Gapon 			cnt = 0;
3698428d0f1SAndriy Gapon 			while (cpu_reset_proxy_active == 0 && cnt < 10000000) {
3708428d0f1SAndriy Gapon 				ia32_pause();
3718428d0f1SAndriy Gapon 				cnt++;	/* Wait for BSP to announce restart */
3728428d0f1SAndriy Gapon 			}
3738428d0f1SAndriy Gapon 			if (cpu_reset_proxy_active == 0) {
3748428d0f1SAndriy Gapon 				printf("cpu_reset: Failed to restart BSP\n");
3758428d0f1SAndriy Gapon 			} else {
3768428d0f1SAndriy Gapon 				cpu_reset_proxy_active = 2;
3778428d0f1SAndriy Gapon 				while (1)
3788428d0f1SAndriy Gapon 					ia32_pause();
3798428d0f1SAndriy Gapon 				/* NOTREACHED */
3808428d0f1SAndriy Gapon 			}
3818428d0f1SAndriy Gapon 		}
3828428d0f1SAndriy Gapon 
3838428d0f1SAndriy Gapon 		DELAY(1000000);
3848428d0f1SAndriy Gapon 	}
3858428d0f1SAndriy Gapon #endif
3868428d0f1SAndriy Gapon 	cpu_reset_real();
3878428d0f1SAndriy Gapon 	/* NOTREACHED */
3888428d0f1SAndriy Gapon }
3898428d0f1SAndriy Gapon 
390b57a73f8SKonstantin Belousov bool
391b57a73f8SKonstantin Belousov cpu_mwait_usable(void)
392b57a73f8SKonstantin Belousov {
393b57a73f8SKonstantin Belousov 
394b57a73f8SKonstantin Belousov 	return ((cpu_feature2 & CPUID2_MON) != 0 && ((cpu_mon_mwait_flags &
395b57a73f8SKonstantin Belousov 	    (CPUID5_MON_MWAIT_EXT | CPUID5_MWAIT_INTRBREAK)) ==
396b57a73f8SKonstantin Belousov 	    (CPUID5_MON_MWAIT_EXT | CPUID5_MWAIT_INTRBREAK)));
397b57a73f8SKonstantin Belousov }
398b57a73f8SKonstantin Belousov 
399dfe7b3bfSKonstantin Belousov void (*cpu_idle_hook)(sbintime_t) = NULL;	/* ACPI idle hook. */
400dfe7b3bfSKonstantin Belousov static int	cpu_ident_amdc1e = 0;	/* AMD C1E supported. */
401dfe7b3bfSKonstantin Belousov static int	idle_mwait = 1;		/* Use MONITOR/MWAIT for short idle. */
402dfe7b3bfSKonstantin Belousov SYSCTL_INT(_machdep, OID_AUTO, idle_mwait, CTLFLAG_RWTUN, &idle_mwait,
403dfe7b3bfSKonstantin Belousov     0, "Use MONITOR/MWAIT for short idle");
404dfe7b3bfSKonstantin Belousov 
405dfe7b3bfSKonstantin Belousov static void
406dfe7b3bfSKonstantin Belousov cpu_idle_acpi(sbintime_t sbt)
407dfe7b3bfSKonstantin Belousov {
408dfe7b3bfSKonstantin Belousov 	int *state;
409dfe7b3bfSKonstantin Belousov 
410dfe7b3bfSKonstantin Belousov 	state = (int *)PCPU_PTR(monitorbuf);
411a5bd21d0SKonstantin Belousov 	atomic_store_int(state, STATE_SLEEPING);
412dfe7b3bfSKonstantin Belousov 
413dfe7b3bfSKonstantin Belousov 	/* See comments in cpu_idle_hlt(). */
414dfe7b3bfSKonstantin Belousov 	disable_intr();
415dfe7b3bfSKonstantin Belousov 	if (sched_runnable())
416dfe7b3bfSKonstantin Belousov 		enable_intr();
417dfe7b3bfSKonstantin Belousov 	else if (cpu_idle_hook)
418dfe7b3bfSKonstantin Belousov 		cpu_idle_hook(sbt);
419dfe7b3bfSKonstantin Belousov 	else
420b57a73f8SKonstantin Belousov 		acpi_cpu_c1();
421a5bd21d0SKonstantin Belousov 	atomic_store_int(state, STATE_RUNNING);
422dfe7b3bfSKonstantin Belousov }
423dfe7b3bfSKonstantin Belousov 
424dfe7b3bfSKonstantin Belousov static void
425dfe7b3bfSKonstantin Belousov cpu_idle_hlt(sbintime_t sbt)
426dfe7b3bfSKonstantin Belousov {
427dfe7b3bfSKonstantin Belousov 	int *state;
428dfe7b3bfSKonstantin Belousov 
429dfe7b3bfSKonstantin Belousov 	state = (int *)PCPU_PTR(monitorbuf);
430a5bd21d0SKonstantin Belousov 	atomic_store_int(state, STATE_SLEEPING);
431dfe7b3bfSKonstantin Belousov 
432dfe7b3bfSKonstantin Belousov 	/*
433dfe7b3bfSKonstantin Belousov 	 * Since we may be in a critical section from cpu_idle(), if
434dfe7b3bfSKonstantin Belousov 	 * an interrupt fires during that critical section we may have
435dfe7b3bfSKonstantin Belousov 	 * a pending preemption.  If the CPU halts, then that thread
436dfe7b3bfSKonstantin Belousov 	 * may not execute until a later interrupt awakens the CPU.
437dfe7b3bfSKonstantin Belousov 	 * To handle this race, check for a runnable thread after
438dfe7b3bfSKonstantin Belousov 	 * disabling interrupts and immediately return if one is
439dfe7b3bfSKonstantin Belousov 	 * found.  Also, we must absolutely guarentee that hlt is
440dfe7b3bfSKonstantin Belousov 	 * the next instruction after sti.  This ensures that any
441dfe7b3bfSKonstantin Belousov 	 * interrupt that fires after the call to disable_intr() will
442dfe7b3bfSKonstantin Belousov 	 * immediately awaken the CPU from hlt.  Finally, please note
443dfe7b3bfSKonstantin Belousov 	 * that on x86 this works fine because of interrupts enabled only
444dfe7b3bfSKonstantin Belousov 	 * after the instruction following sti takes place, while IF is set
445dfe7b3bfSKonstantin Belousov 	 * to 1 immediately, allowing hlt instruction to acknowledge the
446dfe7b3bfSKonstantin Belousov 	 * interrupt.
447dfe7b3bfSKonstantin Belousov 	 */
448dfe7b3bfSKonstantin Belousov 	disable_intr();
449dfe7b3bfSKonstantin Belousov 	if (sched_runnable())
450dfe7b3bfSKonstantin Belousov 		enable_intr();
451dfe7b3bfSKonstantin Belousov 	else
452b57a73f8SKonstantin Belousov 		acpi_cpu_c1();
453a5bd21d0SKonstantin Belousov 	atomic_store_int(state, STATE_RUNNING);
454dfe7b3bfSKonstantin Belousov }
455dfe7b3bfSKonstantin Belousov 
456dfe7b3bfSKonstantin Belousov static void
457dfe7b3bfSKonstantin Belousov cpu_idle_mwait(sbintime_t sbt)
458dfe7b3bfSKonstantin Belousov {
459dfe7b3bfSKonstantin Belousov 	int *state;
460dfe7b3bfSKonstantin Belousov 
461dfe7b3bfSKonstantin Belousov 	state = (int *)PCPU_PTR(monitorbuf);
462a5bd21d0SKonstantin Belousov 	atomic_store_int(state, STATE_MWAIT);
463dfe7b3bfSKonstantin Belousov 
464dfe7b3bfSKonstantin Belousov 	/* See comments in cpu_idle_hlt(). */
465dfe7b3bfSKonstantin Belousov 	disable_intr();
466dfe7b3bfSKonstantin Belousov 	if (sched_runnable()) {
467a5bd21d0SKonstantin Belousov 		atomic_store_int(state, STATE_RUNNING);
468dfe7b3bfSKonstantin Belousov 		enable_intr();
469dfe7b3bfSKonstantin Belousov 		return;
470dfe7b3bfSKonstantin Belousov 	}
471a5bd21d0SKonstantin Belousov 
472dfe7b3bfSKonstantin Belousov 	cpu_monitor(state, 0, 0);
473a5bd21d0SKonstantin Belousov 	if (atomic_load_int(state) == STATE_MWAIT)
474dfe7b3bfSKonstantin Belousov 		__asm __volatile("sti; mwait" : : "a" (MWAIT_C1), "c" (0));
475dfe7b3bfSKonstantin Belousov 	else
476dfe7b3bfSKonstantin Belousov 		enable_intr();
477a5bd21d0SKonstantin Belousov 	atomic_store_int(state, STATE_RUNNING);
478dfe7b3bfSKonstantin Belousov }
479dfe7b3bfSKonstantin Belousov 
480dfe7b3bfSKonstantin Belousov static void
481dfe7b3bfSKonstantin Belousov cpu_idle_spin(sbintime_t sbt)
482dfe7b3bfSKonstantin Belousov {
483dfe7b3bfSKonstantin Belousov 	int *state;
484dfe7b3bfSKonstantin Belousov 	int i;
485dfe7b3bfSKonstantin Belousov 
486dfe7b3bfSKonstantin Belousov 	state = (int *)PCPU_PTR(monitorbuf);
487a5bd21d0SKonstantin Belousov 	atomic_store_int(state, STATE_RUNNING);
488dfe7b3bfSKonstantin Belousov 
489dfe7b3bfSKonstantin Belousov 	/*
490dfe7b3bfSKonstantin Belousov 	 * The sched_runnable() call is racy but as long as there is
491dfe7b3bfSKonstantin Belousov 	 * a loop missing it one time will have just a little impact if any
492dfe7b3bfSKonstantin Belousov 	 * (and it is much better than missing the check at all).
493dfe7b3bfSKonstantin Belousov 	 */
494dfe7b3bfSKonstantin Belousov 	for (i = 0; i < 1000; i++) {
495dfe7b3bfSKonstantin Belousov 		if (sched_runnable())
496dfe7b3bfSKonstantin Belousov 			return;
497dfe7b3bfSKonstantin Belousov 		cpu_spinwait();
498dfe7b3bfSKonstantin Belousov 	}
499dfe7b3bfSKonstantin Belousov }
500dfe7b3bfSKonstantin Belousov 
501dfe7b3bfSKonstantin Belousov /*
502dfe7b3bfSKonstantin Belousov  * C1E renders the local APIC timer dead, so we disable it by
503dfe7b3bfSKonstantin Belousov  * reading the Interrupt Pending Message register and clearing
504dfe7b3bfSKonstantin Belousov  * both C1eOnCmpHalt (bit 28) and SmiOnCmpHalt (bit 27).
505dfe7b3bfSKonstantin Belousov  *
506dfe7b3bfSKonstantin Belousov  * Reference:
507dfe7b3bfSKonstantin Belousov  *   "BIOS and Kernel Developer's Guide for AMD NPT Family 0Fh Processors"
508dfe7b3bfSKonstantin Belousov  *   #32559 revision 3.00+
509dfe7b3bfSKonstantin Belousov  */
510dfe7b3bfSKonstantin Belousov #define	MSR_AMDK8_IPM		0xc0010055
511dfe7b3bfSKonstantin Belousov #define	AMDK8_SMIONCMPHALT	(1ULL << 27)
512dfe7b3bfSKonstantin Belousov #define	AMDK8_C1EONCMPHALT	(1ULL << 28)
513dfe7b3bfSKonstantin Belousov #define	AMDK8_CMPHALT		(AMDK8_SMIONCMPHALT | AMDK8_C1EONCMPHALT)
514dfe7b3bfSKonstantin Belousov 
515dfe7b3bfSKonstantin Belousov void
516dfe7b3bfSKonstantin Belousov cpu_probe_amdc1e(void)
517dfe7b3bfSKonstantin Belousov {
518dfe7b3bfSKonstantin Belousov 
519dfe7b3bfSKonstantin Belousov 	/*
520dfe7b3bfSKonstantin Belousov 	 * Detect the presence of C1E capability mostly on latest
521dfe7b3bfSKonstantin Belousov 	 * dual-cores (or future) k8 family.
522dfe7b3bfSKonstantin Belousov 	 */
523dfe7b3bfSKonstantin Belousov 	if (cpu_vendor_id == CPU_VENDOR_AMD &&
524dfe7b3bfSKonstantin Belousov 	    (cpu_id & 0x00000f00) == 0x00000f00 &&
525dfe7b3bfSKonstantin Belousov 	    (cpu_id & 0x0fff0000) >=  0x00040000) {
526dfe7b3bfSKonstantin Belousov 		cpu_ident_amdc1e = 1;
527dfe7b3bfSKonstantin Belousov 	}
528dfe7b3bfSKonstantin Belousov }
529dfe7b3bfSKonstantin Belousov 
530dfe7b3bfSKonstantin Belousov void (*cpu_idle_fn)(sbintime_t) = cpu_idle_acpi;
531dfe7b3bfSKonstantin Belousov 
532dfe7b3bfSKonstantin Belousov void
533dfe7b3bfSKonstantin Belousov cpu_idle(int busy)
534dfe7b3bfSKonstantin Belousov {
535dfe7b3bfSKonstantin Belousov 	uint64_t msr;
536dfe7b3bfSKonstantin Belousov 	sbintime_t sbt = -1;
537dfe7b3bfSKonstantin Belousov 
538dfe7b3bfSKonstantin Belousov 	CTR2(KTR_SPARE2, "cpu_idle(%d) at %d",
539dfe7b3bfSKonstantin Belousov 	    busy, curcpu);
540ed95805eSJohn Baldwin #ifdef MP_WATCHDOG
541dfe7b3bfSKonstantin Belousov 	ap_watchdog(PCPU_GET(cpuid));
542dfe7b3bfSKonstantin Belousov #endif
543ed95805eSJohn Baldwin 
544dfe7b3bfSKonstantin Belousov 	/* If we are busy - try to use fast methods. */
545dfe7b3bfSKonstantin Belousov 	if (busy) {
546dfe7b3bfSKonstantin Belousov 		if ((cpu_feature2 & CPUID2_MON) && idle_mwait) {
547dfe7b3bfSKonstantin Belousov 			cpu_idle_mwait(busy);
548dfe7b3bfSKonstantin Belousov 			goto out;
549dfe7b3bfSKonstantin Belousov 		}
550dfe7b3bfSKonstantin Belousov 	}
551dfe7b3bfSKonstantin Belousov 
552dfe7b3bfSKonstantin Belousov 	/* If we have time - switch timers into idle mode. */
553dfe7b3bfSKonstantin Belousov 	if (!busy) {
554dfe7b3bfSKonstantin Belousov 		critical_enter();
555dfe7b3bfSKonstantin Belousov 		sbt = cpu_idleclock();
556dfe7b3bfSKonstantin Belousov 	}
557dfe7b3bfSKonstantin Belousov 
558dfe7b3bfSKonstantin Belousov 	/* Apply AMD APIC timer C1E workaround. */
559dfe7b3bfSKonstantin Belousov 	if (cpu_ident_amdc1e && cpu_disable_c3_sleep) {
560dfe7b3bfSKonstantin Belousov 		msr = rdmsr(MSR_AMDK8_IPM);
561dfe7b3bfSKonstantin Belousov 		if (msr & AMDK8_CMPHALT)
562dfe7b3bfSKonstantin Belousov 			wrmsr(MSR_AMDK8_IPM, msr & ~AMDK8_CMPHALT);
563dfe7b3bfSKonstantin Belousov 	}
564dfe7b3bfSKonstantin Belousov 
565dfe7b3bfSKonstantin Belousov 	/* Call main idle method. */
566dfe7b3bfSKonstantin Belousov 	cpu_idle_fn(sbt);
567dfe7b3bfSKonstantin Belousov 
568dfe7b3bfSKonstantin Belousov 	/* Switch timers back into active mode. */
569dfe7b3bfSKonstantin Belousov 	if (!busy) {
570dfe7b3bfSKonstantin Belousov 		cpu_activeclock();
571dfe7b3bfSKonstantin Belousov 		critical_exit();
572dfe7b3bfSKonstantin Belousov 	}
573dfe7b3bfSKonstantin Belousov out:
574dfe7b3bfSKonstantin Belousov 	CTR2(KTR_SPARE2, "cpu_idle(%d) at %d done",
575dfe7b3bfSKonstantin Belousov 	    busy, curcpu);
576dfe7b3bfSKonstantin Belousov }
577dfe7b3bfSKonstantin Belousov 
578dfe7b3bfSKonstantin Belousov int
579dfe7b3bfSKonstantin Belousov cpu_idle_wakeup(int cpu)
580dfe7b3bfSKonstantin Belousov {
581dfe7b3bfSKonstantin Belousov 	int *state;
582dfe7b3bfSKonstantin Belousov 
583a5bd21d0SKonstantin Belousov 	state = (int *)pcpu_find(cpu)->pc_monitorbuf;
584a5bd21d0SKonstantin Belousov 	switch (atomic_load_int(state)) {
585a5bd21d0SKonstantin Belousov 	case STATE_SLEEPING:
586dfe7b3bfSKonstantin Belousov 		return (0);
587a5bd21d0SKonstantin Belousov 	case STATE_MWAIT:
588a5bd21d0SKonstantin Belousov 		atomic_store_int(state, STATE_RUNNING);
589dfe7b3bfSKonstantin Belousov 		return (1);
590a5bd21d0SKonstantin Belousov 	case STATE_RUNNING:
591a5bd21d0SKonstantin Belousov 		return (1);
592a5bd21d0SKonstantin Belousov 	default:
593a5bd21d0SKonstantin Belousov 		panic("bad monitor state");
594a5bd21d0SKonstantin Belousov 		return (1);
595a5bd21d0SKonstantin Belousov 	}
596dfe7b3bfSKonstantin Belousov }
597dfe7b3bfSKonstantin Belousov 
598dfe7b3bfSKonstantin Belousov /*
599dfe7b3bfSKonstantin Belousov  * Ordered by speed/power consumption.
600dfe7b3bfSKonstantin Belousov  */
601dfe7b3bfSKonstantin Belousov struct {
602dfe7b3bfSKonstantin Belousov 	void	*id_fn;
603dfe7b3bfSKonstantin Belousov 	char	*id_name;
604dfe7b3bfSKonstantin Belousov } idle_tbl[] = {
605dfe7b3bfSKonstantin Belousov 	{ cpu_idle_spin, "spin" },
606dfe7b3bfSKonstantin Belousov 	{ cpu_idle_mwait, "mwait" },
607dfe7b3bfSKonstantin Belousov 	{ cpu_idle_hlt, "hlt" },
608dfe7b3bfSKonstantin Belousov 	{ cpu_idle_acpi, "acpi" },
609dfe7b3bfSKonstantin Belousov 	{ NULL, NULL }
610dfe7b3bfSKonstantin Belousov };
611dfe7b3bfSKonstantin Belousov 
612dfe7b3bfSKonstantin Belousov static int
613dfe7b3bfSKonstantin Belousov idle_sysctl_available(SYSCTL_HANDLER_ARGS)
614dfe7b3bfSKonstantin Belousov {
615dfe7b3bfSKonstantin Belousov 	char *avail, *p;
616dfe7b3bfSKonstantin Belousov 	int error;
617dfe7b3bfSKonstantin Belousov 	int i;
618dfe7b3bfSKonstantin Belousov 
619dfe7b3bfSKonstantin Belousov 	avail = malloc(256, M_TEMP, M_WAITOK);
620dfe7b3bfSKonstantin Belousov 	p = avail;
621dfe7b3bfSKonstantin Belousov 	for (i = 0; idle_tbl[i].id_name != NULL; i++) {
622dfe7b3bfSKonstantin Belousov 		if (strstr(idle_tbl[i].id_name, "mwait") &&
623dfe7b3bfSKonstantin Belousov 		    (cpu_feature2 & CPUID2_MON) == 0)
624dfe7b3bfSKonstantin Belousov 			continue;
625dfe7b3bfSKonstantin Belousov 		if (strcmp(idle_tbl[i].id_name, "acpi") == 0 &&
626dfe7b3bfSKonstantin Belousov 		    cpu_idle_hook == NULL)
627dfe7b3bfSKonstantin Belousov 			continue;
628dfe7b3bfSKonstantin Belousov 		p += sprintf(p, "%s%s", p != avail ? ", " : "",
629dfe7b3bfSKonstantin Belousov 		    idle_tbl[i].id_name);
630dfe7b3bfSKonstantin Belousov 	}
631dfe7b3bfSKonstantin Belousov 	error = sysctl_handle_string(oidp, avail, 0, req);
632dfe7b3bfSKonstantin Belousov 	free(avail, M_TEMP);
633dfe7b3bfSKonstantin Belousov 	return (error);
634dfe7b3bfSKonstantin Belousov }
635dfe7b3bfSKonstantin Belousov 
636dfe7b3bfSKonstantin Belousov SYSCTL_PROC(_machdep, OID_AUTO, idle_available, CTLTYPE_STRING | CTLFLAG_RD,
637dfe7b3bfSKonstantin Belousov     0, 0, idle_sysctl_available, "A", "list of available idle functions");
638dfe7b3bfSKonstantin Belousov 
639*55ba21d4SKonstantin Belousov static bool
640*55ba21d4SKonstantin Belousov idle_selector(const char *new_idle_name)
641*55ba21d4SKonstantin Belousov {
642*55ba21d4SKonstantin Belousov 	int i;
643*55ba21d4SKonstantin Belousov 
644*55ba21d4SKonstantin Belousov 	for (i = 0; idle_tbl[i].id_name != NULL; i++) {
645*55ba21d4SKonstantin Belousov 		if (strstr(idle_tbl[i].id_name, "mwait") &&
646*55ba21d4SKonstantin Belousov 		    (cpu_feature2 & CPUID2_MON) == 0)
647*55ba21d4SKonstantin Belousov 			continue;
648*55ba21d4SKonstantin Belousov 		if (strcmp(idle_tbl[i].id_name, "acpi") == 0 &&
649*55ba21d4SKonstantin Belousov 		    cpu_idle_hook == NULL)
650*55ba21d4SKonstantin Belousov 			continue;
651*55ba21d4SKonstantin Belousov 		if (strcmp(idle_tbl[i].id_name, new_idle_name))
652*55ba21d4SKonstantin Belousov 			continue;
653*55ba21d4SKonstantin Belousov 		cpu_idle_fn = idle_tbl[i].id_fn;
654*55ba21d4SKonstantin Belousov 		if (bootverbose)
655*55ba21d4SKonstantin Belousov 			printf("CPU idle set to %s\n", idle_tbl[i].id_name);
656*55ba21d4SKonstantin Belousov 		return (true);
657*55ba21d4SKonstantin Belousov 	}
658*55ba21d4SKonstantin Belousov 	return (false);
659*55ba21d4SKonstantin Belousov }
660*55ba21d4SKonstantin Belousov 
661dfe7b3bfSKonstantin Belousov static int
662dfe7b3bfSKonstantin Belousov idle_sysctl(SYSCTL_HANDLER_ARGS)
663dfe7b3bfSKonstantin Belousov {
664*55ba21d4SKonstantin Belousov 	char buf[16], *p;
665*55ba21d4SKonstantin Belousov 	int error, i;
666dfe7b3bfSKonstantin Belousov 
667dfe7b3bfSKonstantin Belousov 	p = "unknown";
668dfe7b3bfSKonstantin Belousov 	for (i = 0; idle_tbl[i].id_name != NULL; i++) {
669dfe7b3bfSKonstantin Belousov 		if (idle_tbl[i].id_fn == cpu_idle_fn) {
670dfe7b3bfSKonstantin Belousov 			p = idle_tbl[i].id_name;
671dfe7b3bfSKonstantin Belousov 			break;
672dfe7b3bfSKonstantin Belousov 		}
673dfe7b3bfSKonstantin Belousov 	}
674dfe7b3bfSKonstantin Belousov 	strncpy(buf, p, sizeof(buf));
675dfe7b3bfSKonstantin Belousov 	error = sysctl_handle_string(oidp, buf, sizeof(buf), req);
676dfe7b3bfSKonstantin Belousov 	if (error != 0 || req->newptr == NULL)
677dfe7b3bfSKonstantin Belousov 		return (error);
678*55ba21d4SKonstantin Belousov 	return (idle_selector(buf) ? 0 : EINVAL);
679dfe7b3bfSKonstantin Belousov }
680dfe7b3bfSKonstantin Belousov 
681dfe7b3bfSKonstantin Belousov SYSCTL_PROC(_machdep, OID_AUTO, idle, CTLTYPE_STRING | CTLFLAG_RW, 0, 0,
682dfe7b3bfSKonstantin Belousov     idle_sysctl, "A", "currently selected idle function");
683835c2787SKonstantin Belousov 
684*55ba21d4SKonstantin Belousov static void
685*55ba21d4SKonstantin Belousov idle_tun(void *unused __unused)
686*55ba21d4SKonstantin Belousov {
687*55ba21d4SKonstantin Belousov 	char tunvar[16];
688*55ba21d4SKonstantin Belousov 
689*55ba21d4SKonstantin Belousov 	if (TUNABLE_STR_FETCH("machdep.idle", tunvar, sizeof(tunvar)))
690*55ba21d4SKonstantin Belousov 		idle_selector(tunvar);
691*55ba21d4SKonstantin Belousov }
692*55ba21d4SKonstantin Belousov SYSINIT(idle_tun, SI_SUB_CPU, SI_ORDER_MIDDLE, idle_tun, NULL);
693*55ba21d4SKonstantin Belousov 
694295f4b6cSKonstantin Belousov static int panic_on_nmi = 1;
695295f4b6cSKonstantin Belousov SYSCTL_INT(_machdep, OID_AUTO, panic_on_nmi, CTLFLAG_RWTUN,
696295f4b6cSKonstantin Belousov     &panic_on_nmi, 0,
697295f4b6cSKonstantin Belousov     "Panic on NMI");
698835c2787SKonstantin Belousov int nmi_is_broadcast = 1;
699835c2787SKonstantin Belousov SYSCTL_INT(_machdep, OID_AUTO, nmi_is_broadcast, CTLFLAG_RWTUN,
700835c2787SKonstantin Belousov     &nmi_is_broadcast, 0,
701835c2787SKonstantin Belousov     "Chipset NMI is broadcast");
702835c2787SKonstantin Belousov #ifdef KDB
703835c2787SKonstantin Belousov int kdb_on_nmi = 1;
704835c2787SKonstantin Belousov SYSCTL_INT(_machdep, OID_AUTO, kdb_on_nmi, CTLFLAG_RWTUN,
705835c2787SKonstantin Belousov     &kdb_on_nmi, 0,
706835c2787SKonstantin Belousov     "Go to KDB on NMI");
707835c2787SKonstantin Belousov #endif
708835c2787SKonstantin Belousov 
709835c2787SKonstantin Belousov #ifdef DEV_ISA
710295f4b6cSKonstantin Belousov void
711295f4b6cSKonstantin Belousov nmi_call_kdb(u_int cpu, u_int type, struct trapframe *frame)
712835c2787SKonstantin Belousov {
713835c2787SKonstantin Belousov 
714835c2787SKonstantin Belousov 	/* machine/parity/power fail/"kitchen sink" faults */
715835c2787SKonstantin Belousov 	if (isa_nmi(frame->tf_err) == 0) {
716835c2787SKonstantin Belousov #ifdef KDB
717835c2787SKonstantin Belousov 		/*
718835c2787SKonstantin Belousov 		 * NMI can be hooked up to a pushbutton for debugging.
719835c2787SKonstantin Belousov 		 */
720835c2787SKonstantin Belousov 		if (kdb_on_nmi) {
721835c2787SKonstantin Belousov 			printf("NMI/cpu%d ... going to debugger\n", cpu);
722835c2787SKonstantin Belousov 			kdb_trap(type, 0, frame);
723835c2787SKonstantin Belousov 		}
724835c2787SKonstantin Belousov #endif /* KDB */
725295f4b6cSKonstantin Belousov 	} else if (panic_on_nmi) {
726835c2787SKonstantin Belousov 		panic("NMI indicates hardware failure");
727295f4b6cSKonstantin Belousov 	}
728835c2787SKonstantin Belousov }
729835c2787SKonstantin Belousov #endif
730835c2787SKonstantin Belousov 
731295f4b6cSKonstantin Belousov void
732295f4b6cSKonstantin Belousov nmi_handle_intr(u_int type, struct trapframe *frame)
733835c2787SKonstantin Belousov {
734835c2787SKonstantin Belousov 
735835c2787SKonstantin Belousov #ifdef DEV_ISA
736835c2787SKonstantin Belousov #ifdef SMP
737295f4b6cSKonstantin Belousov 	if (nmi_is_broadcast) {
738295f4b6cSKonstantin Belousov 		nmi_call_kdb_smp(type, frame);
739295f4b6cSKonstantin Belousov 		return;
740295f4b6cSKonstantin Belousov 	}
741835c2787SKonstantin Belousov #endif
7421d6dfd12SKonstantin Belousov 	nmi_call_kdb(PCPU_GET(cpuid), type, frame);
743835c2787SKonstantin Belousov #endif
744835c2787SKonstantin Belousov }
745319117fdSKonstantin Belousov 
746319117fdSKonstantin Belousov int hw_ibrs_active;
747319117fdSKonstantin Belousov int hw_ibrs_disable = 1;
748319117fdSKonstantin Belousov 
749319117fdSKonstantin Belousov SYSCTL_INT(_hw, OID_AUTO, ibrs_active, CTLFLAG_RD, &hw_ibrs_active, 0,
750b31b965eSKonstantin Belousov     "Indirect Branch Restricted Speculation active");
751319117fdSKonstantin Belousov 
752319117fdSKonstantin Belousov void
753319117fdSKonstantin Belousov hw_ibrs_recalculate(void)
754319117fdSKonstantin Belousov {
755319117fdSKonstantin Belousov 	uint64_t v;
756319117fdSKonstantin Belousov 
757319117fdSKonstantin Belousov 	if ((cpu_ia32_arch_caps & IA32_ARCH_CAP_IBRS_ALL) != 0) {
758319117fdSKonstantin Belousov 		if (hw_ibrs_disable) {
759319117fdSKonstantin Belousov 			v= rdmsr(MSR_IA32_SPEC_CTRL);
760c688c905SKonstantin Belousov 			v &= ~(uint64_t)IA32_SPEC_CTRL_IBRS;
761319117fdSKonstantin Belousov 			wrmsr(MSR_IA32_SPEC_CTRL, v);
762319117fdSKonstantin Belousov 		} else {
763319117fdSKonstantin Belousov 			v= rdmsr(MSR_IA32_SPEC_CTRL);
764319117fdSKonstantin Belousov 			v |= IA32_SPEC_CTRL_IBRS;
765319117fdSKonstantin Belousov 			wrmsr(MSR_IA32_SPEC_CTRL, v);
766319117fdSKonstantin Belousov 		}
767319117fdSKonstantin Belousov 		return;
768319117fdSKonstantin Belousov 	}
769319117fdSKonstantin Belousov 	hw_ibrs_active = (cpu_stdext_feature3 & CPUID_STDEXT3_IBPB) != 0 &&
770319117fdSKonstantin Belousov 	    !hw_ibrs_disable;
771319117fdSKonstantin Belousov }
772319117fdSKonstantin Belousov 
773319117fdSKonstantin Belousov static int
774319117fdSKonstantin Belousov hw_ibrs_disable_handler(SYSCTL_HANDLER_ARGS)
775319117fdSKonstantin Belousov {
776319117fdSKonstantin Belousov 	int error, val;
777319117fdSKonstantin Belousov 
778319117fdSKonstantin Belousov 	val = hw_ibrs_disable;
779319117fdSKonstantin Belousov 	error = sysctl_handle_int(oidp, &val, 0, req);
780319117fdSKonstantin Belousov 	if (error != 0 || req->newptr == NULL)
781319117fdSKonstantin Belousov 		return (error);
782319117fdSKonstantin Belousov 	hw_ibrs_disable = val != 0;
783319117fdSKonstantin Belousov 	hw_ibrs_recalculate();
784319117fdSKonstantin Belousov 	return (0);
785319117fdSKonstantin Belousov }
786319117fdSKonstantin Belousov SYSCTL_PROC(_hw, OID_AUTO, ibrs_disable, CTLTYPE_INT | CTLFLAG_RWTUN |
787319117fdSKonstantin Belousov     CTLFLAG_NOFETCH | CTLFLAG_MPSAFE, NULL, 0, hw_ibrs_disable_handler, "I",
788b31b965eSKonstantin Belousov     "Disable Indirect Branch Restricted Speculation");
7898fbcc334SKonstantin Belousov 
7908fbcc334SKonstantin Belousov /*
7918fbcc334SKonstantin Belousov  * Enable and restore kernel text write permissions.
7928fbcc334SKonstantin Belousov  * Callers must ensure that disable_wp()/restore_wp() are executed
7938fbcc334SKonstantin Belousov  * without rescheduling on the same core.
7948fbcc334SKonstantin Belousov  */
7958fbcc334SKonstantin Belousov bool
7968fbcc334SKonstantin Belousov disable_wp(void)
7978fbcc334SKonstantin Belousov {
7988fbcc334SKonstantin Belousov 	u_int cr0;
7998fbcc334SKonstantin Belousov 
8008fbcc334SKonstantin Belousov 	cr0 = rcr0();
8018fbcc334SKonstantin Belousov 	if ((cr0 & CR0_WP) == 0)
8028fbcc334SKonstantin Belousov 		return (false);
8038fbcc334SKonstantin Belousov 	load_cr0(cr0 & ~CR0_WP);
8048fbcc334SKonstantin Belousov 	return (true);
8058fbcc334SKonstantin Belousov }
8068fbcc334SKonstantin Belousov 
8078fbcc334SKonstantin Belousov void
8088fbcc334SKonstantin Belousov restore_wp(bool old_wp)
8098fbcc334SKonstantin Belousov {
8108fbcc334SKonstantin Belousov 
8118fbcc334SKonstantin Belousov 	if (old_wp)
8128fbcc334SKonstantin Belousov 		load_cr0(rcr0() | CR0_WP);
8138fbcc334SKonstantin Belousov }
8148fbcc334SKonstantin Belousov 
815