1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * arch/x86/kernel/nmi-selftest.c
4  *
5  * Testsuite for NMI: IPIs
6  *
7  * Started by Don Zickus:
8  * (using lib/locking-selftest.c as a guide)
9  *
10  *   Copyright (C) 2011 Red Hat, Inc., Don Zickus <dzickus@redhat.com>
11  */
12 
13 #include <linux/smp.h>
14 #include <linux/cpumask.h>
15 #include <linux/delay.h>
16 #include <linux/init.h>
17 #include <linux/percpu.h>
18 
19 #include <asm/apic.h>
20 #include <asm/nmi.h>
21 
22 #define SUCCESS		0
23 #define FAILURE		1
24 #define TIMEOUT		2
25 
26 static int __initdata nmi_fail;
27 
28 /* check to see if NMI IPIs work on this machine */
29 static DECLARE_BITMAP(nmi_ipi_mask, NR_CPUS) __initdata;
30 
31 static int __initdata testcase_total;
32 static int __initdata testcase_successes;
33 static int __initdata expected_testcase_failures;
34 static int __initdata unexpected_testcase_failures;
35 static int __initdata unexpected_testcase_unknowns;
36 
nmi_unk_cb(unsigned int val,struct pt_regs * regs)37 static int __init nmi_unk_cb(unsigned int val, struct pt_regs *regs)
38 {
39 	unexpected_testcase_unknowns++;
40 	return NMI_HANDLED;
41 }
42 
init_nmi_testsuite(void)43 static void __init init_nmi_testsuite(void)
44 {
45 	/* trap all the unknown NMIs we may generate */
46 	register_nmi_handler(NMI_UNKNOWN, nmi_unk_cb, 0, "nmi_selftest_unk",
47 			__initdata);
48 }
49 
cleanup_nmi_testsuite(void)50 static void __init cleanup_nmi_testsuite(void)
51 {
52 	unregister_nmi_handler(NMI_UNKNOWN, "nmi_selftest_unk");
53 }
54 
test_nmi_ipi_callback(unsigned int val,struct pt_regs * regs)55 static int __init test_nmi_ipi_callback(unsigned int val, struct pt_regs *regs)
56 {
57         int cpu = raw_smp_processor_id();
58 
59         if (cpumask_test_and_clear_cpu(cpu, to_cpumask(nmi_ipi_mask)))
60                 return NMI_HANDLED;
61 
62         return NMI_DONE;
63 }
64 
test_nmi_ipi(struct cpumask * mask)65 static void __init test_nmi_ipi(struct cpumask *mask)
66 {
67 	unsigned long timeout;
68 
69 	if (register_nmi_handler(NMI_LOCAL, test_nmi_ipi_callback,
70 				 NMI_FLAG_FIRST, "nmi_selftest", __initdata)) {
71 		nmi_fail = FAILURE;
72 		return;
73 	}
74 
75 	/* sync above data before sending NMI */
76 	wmb();
77 
78 	__apic_send_IPI_mask(mask, NMI_VECTOR);
79 
80 	/* Don't wait longer than a second */
81 	timeout = USEC_PER_SEC;
82 	while (!cpumask_empty(mask) && --timeout)
83 	        udelay(1);
84 
85 	/* What happens if we timeout, do we still unregister?? */
86 	unregister_nmi_handler(NMI_LOCAL, "nmi_selftest");
87 
88 	if (!timeout)
89 		nmi_fail = TIMEOUT;
90 	return;
91 }
92 
remote_ipi(void)93 static void __init remote_ipi(void)
94 {
95 	cpumask_copy(to_cpumask(nmi_ipi_mask), cpu_online_mask);
96 	cpumask_clear_cpu(smp_processor_id(), to_cpumask(nmi_ipi_mask));
97 	if (!cpumask_empty(to_cpumask(nmi_ipi_mask)))
98 		test_nmi_ipi(to_cpumask(nmi_ipi_mask));
99 }
100 
local_ipi(void)101 static void __init local_ipi(void)
102 {
103 	cpumask_clear(to_cpumask(nmi_ipi_mask));
104 	cpumask_set_cpu(smp_processor_id(), to_cpumask(nmi_ipi_mask));
105 	test_nmi_ipi(to_cpumask(nmi_ipi_mask));
106 }
107 
reset_nmi(void)108 static void __init reset_nmi(void)
109 {
110 	nmi_fail = 0;
111 }
112 
dotest(void (* testcase_fn)(void),int expected)113 static void __init dotest(void (*testcase_fn)(void), int expected)
114 {
115 	testcase_fn();
116 	/*
117 	 * Filter out expected failures:
118 	 */
119 	if (nmi_fail != expected) {
120 		unexpected_testcase_failures++;
121 
122 		if (nmi_fail == FAILURE)
123 			printk(KERN_CONT "FAILED |");
124 		else if (nmi_fail == TIMEOUT)
125 			printk(KERN_CONT "TIMEOUT|");
126 		else
127 			printk(KERN_CONT "ERROR  |");
128 		dump_stack();
129 	} else {
130 		testcase_successes++;
131 		printk(KERN_CONT "  ok  |");
132 	}
133 	testcase_total++;
134 
135 	reset_nmi();
136 }
137 
print_testname(const char * testname)138 static inline void __init print_testname(const char *testname)
139 {
140 	printk("%12s:", testname);
141 }
142 
nmi_selftest(void)143 void __init nmi_selftest(void)
144 {
145 	init_nmi_testsuite();
146 
147         /*
148 	 * Run the testsuite:
149 	 */
150 	printk("----------------\n");
151 	printk("| NMI testsuite:\n");
152 	printk("--------------------\n");
153 
154 	print_testname("remote IPI");
155 	dotest(remote_ipi, SUCCESS);
156 	printk(KERN_CONT "\n");
157 	print_testname("local IPI");
158 	dotest(local_ipi, SUCCESS);
159 	printk(KERN_CONT "\n");
160 
161 	cleanup_nmi_testsuite();
162 
163 	if (unexpected_testcase_failures) {
164 		printk("--------------------\n");
165 		printk("BUG: %3d unexpected failures (out of %3d) - debugging disabled! |\n",
166 			unexpected_testcase_failures, testcase_total);
167 		printk("-----------------------------------------------------------------\n");
168 	} else if (expected_testcase_failures && testcase_successes) {
169 		printk("--------------------\n");
170 		printk("%3d out of %3d testcases failed, as expected. |\n",
171 			expected_testcase_failures, testcase_total);
172 		printk("----------------------------------------------------\n");
173 	} else if (expected_testcase_failures && !testcase_successes) {
174 		printk("--------------------\n");
175 		printk("All %3d testcases failed, as expected. |\n",
176 			expected_testcase_failures);
177 		printk("----------------------------------------\n");
178 	} else {
179 		printk("--------------------\n");
180 		printk("Good, all %3d testcases passed! |\n",
181 			testcase_successes);
182 		printk("---------------------------------\n");
183 	}
184 }
185