xref: /linux-6.15/kernel/debug/debug_core.c (revision fe557319)
1c4338209SJason Wessel /*
253197fc4SJason Wessel  * Kernel Debug Core
3c4338209SJason Wessel  *
4c4338209SJason Wessel  * Maintainer: Jason Wessel <[email protected]>
5c4338209SJason Wessel  *
6c4338209SJason Wessel  * Copyright (C) 2000-2001 VERITAS Software Corporation.
7c4338209SJason Wessel  * Copyright (C) 2002-2004 Timesys Corporation
8c4338209SJason Wessel  * Copyright (C) 2003-2004 Amit S. Kale <[email protected]>
9a2531293SPavel Machek  * Copyright (C) 2004 Pavel Machek <[email protected]>
10c4338209SJason Wessel  * Copyright (C) 2004-2006 Tom Rini <[email protected]>
11c4338209SJason Wessel  * Copyright (C) 2004-2006 LinSysSoft Technologies Pvt. Ltd.
1253197fc4SJason Wessel  * Copyright (C) 2005-2009 Wind River Systems, Inc.
13c4338209SJason Wessel  * Copyright (C) 2007 MontaVista Software, Inc.
14c4338209SJason Wessel  * Copyright (C) 2008 Red Hat, Inc., Ingo Molnar <[email protected]>
15c4338209SJason Wessel  *
16c4338209SJason Wessel  * Contributors at various stages not listed above:
17c4338209SJason Wessel  *  Jason Wessel ( [email protected] )
18c4338209SJason Wessel  *  George Anzinger <[email protected]>
19c4338209SJason Wessel  *  Anurekh Saxena ([email protected])
20c4338209SJason Wessel  *  Lake Stevens Instrument Division (Glenn Engel)
21c4338209SJason Wessel  *  Jim Kingdon, Cygnus Support.
22c4338209SJason Wessel  *
23c4338209SJason Wessel  * Original KGDB stub: David Grothe <[email protected]>,
24c4338209SJason Wessel  * Tigran Aivazian <[email protected]>
25c4338209SJason Wessel  *
26c4338209SJason Wessel  * This file is licensed under the terms of the GNU General Public License
27c4338209SJason Wessel  * version 2. This program is licensed "as is" without any warranty of any
28c4338209SJason Wessel  * kind, whether express or implied.
29c4338209SJason Wessel  */
300f16996cSFabian Frederick 
310f16996cSFabian Frederick #define pr_fmt(fmt) "KGDB: " fmt
320f16996cSFabian Frederick 
33c4338209SJason Wessel #include <linux/pid_namespace.h>
34c4338209SJason Wessel #include <linux/clocksource.h>
3516559ae4SGreg Kroah-Hartman #include <linux/serial_core.h>
36c4338209SJason Wessel #include <linux/interrupt.h>
37c4338209SJason Wessel #include <linux/spinlock.h>
38c4338209SJason Wessel #include <linux/console.h>
39c4338209SJason Wessel #include <linux/threads.h>
40c4338209SJason Wessel #include <linux/uaccess.h>
41c4338209SJason Wessel #include <linux/kernel.h>
42c4338209SJason Wessel #include <linux/module.h>
43c4338209SJason Wessel #include <linux/ptrace.h>
44c4338209SJason Wessel #include <linux/string.h>
45c4338209SJason Wessel #include <linux/delay.h>
46c4338209SJason Wessel #include <linux/sched.h>
47c4338209SJason Wessel #include <linux/sysrq.h>
482366e047SJason Wessel #include <linux/reboot.h>
49c4338209SJason Wessel #include <linux/init.h>
50c4338209SJason Wessel #include <linux/kgdb.h>
51dcc78711SJason Wessel #include <linux/kdb.h>
5238b8d208SIngo Molnar #include <linux/nmi.h>
53c4338209SJason Wessel #include <linux/pid.h>
54c4338209SJason Wessel #include <linux/smp.h>
55c4338209SJason Wessel #include <linux/mm.h>
56615d6e87SDavidlohr Bueso #include <linux/vmacache.h>
57fb70b588SJason Wessel #include <linux/rcupdate.h>
583cd99ac3SDouglas Anderson #include <linux/irq.h>
59c4338209SJason Wessel 
60c4338209SJason Wessel #include <asm/cacheflush.h>
61c4338209SJason Wessel #include <asm/byteorder.h>
6260063497SArun Sharma #include <linux/atomic.h>
6353197fc4SJason Wessel 
6453197fc4SJason Wessel #include "debug_core.h"
65c4338209SJason Wessel 
66c4338209SJason Wessel static int kgdb_break_asap;
67c4338209SJason Wessel 
6853197fc4SJason Wessel struct debuggerinfo_struct kgdb_info[NR_CPUS];
69c4338209SJason Wessel 
70a1350207SAndy Shevchenko /* kgdb_connected - Is a host GDB connected to us? */
71c4338209SJason Wessel int				kgdb_connected;
72c4338209SJason Wessel EXPORT_SYMBOL_GPL(kgdb_connected);
73c4338209SJason Wessel 
74c4338209SJason Wessel /* All the KGDB handlers are installed */
75f503b5aeSJason Wessel int			kgdb_io_module_registered;
76c4338209SJason Wessel 
77c4338209SJason Wessel /* Guard for recursive entry */
78c4338209SJason Wessel static int			exception_level;
79c4338209SJason Wessel 
8053197fc4SJason Wessel struct kgdb_io		*dbg_io_ops;
81c4338209SJason Wessel static DEFINE_SPINLOCK(kgdb_registration_lock);
82c4338209SJason Wessel 
83bec4d62eSJason Wessel /* Action for the reboot notifiter, a global allow kdb to change it */
84bec4d62eSJason Wessel static int kgdbreboot;
85c4338209SJason Wessel /* kgdb console driver is loaded */
86c4338209SJason Wessel static int kgdb_con_registered;
87c4338209SJason Wessel /* determine if kgdb console output should be used */
88c4338209SJason Wessel static int kgdb_use_con;
890b4b3827SJason Wessel /* Flag for alternate operations for early debugging */
900b4b3827SJason Wessel bool dbg_is_early = true;
91dcc78711SJason Wessel /* Next cpu to become the master debug core */
92dcc78711SJason Wessel int dbg_switch_cpu;
93dcc78711SJason Wessel 
94dcc78711SJason Wessel /* Use kdb or gdbserver mode */
95a0de055cSJason Wessel int dbg_kdb_mode = 1;
96c4338209SJason Wessel 
97c4338209SJason Wessel static int __init opt_kgdb_con(char *str)
98c4338209SJason Wessel {
99c4338209SJason Wessel 	kgdb_use_con = 1;
100c4338209SJason Wessel 	return 0;
101c4338209SJason Wessel }
102c4338209SJason Wessel 
103c4338209SJason Wessel early_param("kgdbcon", opt_kgdb_con);
104c4338209SJason Wessel 
105c4338209SJason Wessel module_param(kgdb_use_con, int, 0644);
106bec4d62eSJason Wessel module_param(kgdbreboot, int, 0644);
107c4338209SJason Wessel 
108c4338209SJason Wessel /*
109c4338209SJason Wessel  * Holds information about breakpoints in a kernel. These breakpoints are
110c4338209SJason Wessel  * added and removed by gdb.
111c4338209SJason Wessel  */
112c4338209SJason Wessel static struct kgdb_bkpt		kgdb_break[KGDB_MAX_BREAKPOINTS] = {
113c4338209SJason Wessel 	[0 ... KGDB_MAX_BREAKPOINTS-1] = { .state = BP_UNDEFINED }
114c4338209SJason Wessel };
115c4338209SJason Wessel 
116c4338209SJason Wessel /*
117c4338209SJason Wessel  * The CPU# of the active CPU, or -1 if none:
118c4338209SJason Wessel  */
119c4338209SJason Wessel atomic_t			kgdb_active = ATOMIC_INIT(-1);
120dcc78711SJason Wessel EXPORT_SYMBOL_GPL(kgdb_active);
121dfee3a7bSJason Wessel static DEFINE_RAW_SPINLOCK(dbg_master_lock);
122dfee3a7bSJason Wessel static DEFINE_RAW_SPINLOCK(dbg_slave_lock);
123c4338209SJason Wessel 
124c4338209SJason Wessel /*
125c4338209SJason Wessel  * We use NR_CPUs not PERCPU, in case kgdb is used to debug early
126c4338209SJason Wessel  * bootup code (which might not have percpu set up yet):
127c4338209SJason Wessel  */
128dfee3a7bSJason Wessel static atomic_t			masters_in_kgdb;
129dfee3a7bSJason Wessel static atomic_t			slaves_in_kgdb;
1301cee5e35SJason Wessel static atomic_t			kgdb_break_tasklet_var;
131c4338209SJason Wessel atomic_t			kgdb_setting_breakpoint;
132c4338209SJason Wessel 
133c4338209SJason Wessel struct task_struct		*kgdb_usethread;
134c4338209SJason Wessel struct task_struct		*kgdb_contthread;
135c4338209SJason Wessel 
136c4338209SJason Wessel int				kgdb_single_step;
13753197fc4SJason Wessel static pid_t			kgdb_sstep_pid;
138c4338209SJason Wessel 
139c4338209SJason Wessel /* to keep track of the CPU which is doing the single stepping*/
140c4338209SJason Wessel atomic_t			kgdb_cpu_doing_single_step = ATOMIC_INIT(-1);
141c4338209SJason Wessel 
142c4338209SJason Wessel /*
143c4338209SJason Wessel  * If you are debugging a problem where roundup (the collection of
144c4338209SJason Wessel  * all other CPUs) is a problem [this should be extremely rare],
145c4338209SJason Wessel  * then use the nokgdbroundup option to avoid roundup. In that case
146c4338209SJason Wessel  * the other CPUs might interfere with your debugging context, so
147c4338209SJason Wessel  * use this with care:
148c4338209SJason Wessel  */
149c4338209SJason Wessel static int kgdb_do_roundup = 1;
150c4338209SJason Wessel 
151c4338209SJason Wessel static int __init opt_nokgdbroundup(char *str)
152c4338209SJason Wessel {
153c4338209SJason Wessel 	kgdb_do_roundup = 0;
154c4338209SJason Wessel 
155c4338209SJason Wessel 	return 0;
156c4338209SJason Wessel }
157c4338209SJason Wessel 
158c4338209SJason Wessel early_param("nokgdbroundup", opt_nokgdbroundup);
159c4338209SJason Wessel 
160c4338209SJason Wessel /*
161c4338209SJason Wessel  * Finally, some KGDB code :-)
162c4338209SJason Wessel  */
163c4338209SJason Wessel 
164c4338209SJason Wessel /*
165c4338209SJason Wessel  * Weak aliases for breakpoint management,
166c4338209SJason Wessel  * can be overriden by architectures when needed:
167c4338209SJason Wessel  */
16898b54aa1SJason Wessel int __weak kgdb_arch_set_breakpoint(struct kgdb_bkpt *bpt)
169c4338209SJason Wessel {
170c4338209SJason Wessel 	int err;
171c4338209SJason Wessel 
172*fe557319SChristoph Hellwig 	err = copy_from_kernel_nofault(bpt->saved_instr, (char *)bpt->bpt_addr,
17398b54aa1SJason Wessel 				BREAK_INSTR_SIZE);
174c4338209SJason Wessel 	if (err)
175c4338209SJason Wessel 		return err;
176*fe557319SChristoph Hellwig 	err = copy_to_kernel_nofault((char *)bpt->bpt_addr,
17798b54aa1SJason Wessel 				 arch_kgdb_ops.gdb_bpt_instr, BREAK_INSTR_SIZE);
17898b54aa1SJason Wessel 	return err;
179c4338209SJason Wessel }
180c4338209SJason Wessel 
18198b54aa1SJason Wessel int __weak kgdb_arch_remove_breakpoint(struct kgdb_bkpt *bpt)
182c4338209SJason Wessel {
183*fe557319SChristoph Hellwig 	return copy_to_kernel_nofault((char *)bpt->bpt_addr,
18498b54aa1SJason Wessel 				  (char *)bpt->saved_instr, BREAK_INSTR_SIZE);
185c4338209SJason Wessel }
186c4338209SJason Wessel 
187c4338209SJason Wessel int __weak kgdb_validate_break_address(unsigned long addr)
188c4338209SJason Wessel {
18998b54aa1SJason Wessel 	struct kgdb_bkpt tmp;
190c4338209SJason Wessel 	int err;
19198b54aa1SJason Wessel 	/* Validate setting the breakpoint and then removing it.  If the
192c4338209SJason Wessel 	 * remove fails, the kernel needs to emit a bad message because we
193c4338209SJason Wessel 	 * are deep trouble not being able to put things back the way we
194c4338209SJason Wessel 	 * found them.
195c4338209SJason Wessel 	 */
19698b54aa1SJason Wessel 	tmp.bpt_addr = addr;
19798b54aa1SJason Wessel 	err = kgdb_arch_set_breakpoint(&tmp);
198c4338209SJason Wessel 	if (err)
199c4338209SJason Wessel 		return err;
20098b54aa1SJason Wessel 	err = kgdb_arch_remove_breakpoint(&tmp);
201c4338209SJason Wessel 	if (err)
2020f16996cSFabian Frederick 		pr_err("Critical breakpoint error, kernel memory destroyed at: %lx\n",
2030f16996cSFabian Frederick 		       addr);
204c4338209SJason Wessel 	return err;
205c4338209SJason Wessel }
206c4338209SJason Wessel 
207c4338209SJason Wessel unsigned long __weak kgdb_arch_pc(int exception, struct pt_regs *regs)
208c4338209SJason Wessel {
209c4338209SJason Wessel 	return instruction_pointer(regs);
210c4338209SJason Wessel }
211c4338209SJason Wessel 
212c4338209SJason Wessel int __weak kgdb_arch_init(void)
213c4338209SJason Wessel {
214c4338209SJason Wessel 	return 0;
215c4338209SJason Wessel }
216c4338209SJason Wessel 
217c4338209SJason Wessel int __weak kgdb_skipexception(int exception, struct pt_regs *regs)
218c4338209SJason Wessel {
219c4338209SJason Wessel 	return 0;
220c4338209SJason Wessel }
221c4338209SJason Wessel 
2223cd99ac3SDouglas Anderson #ifdef CONFIG_SMP
2233cd99ac3SDouglas Anderson 
2243cd99ac3SDouglas Anderson /*
2253cd99ac3SDouglas Anderson  * Default (weak) implementation for kgdb_roundup_cpus
2263cd99ac3SDouglas Anderson  */
2273cd99ac3SDouglas Anderson 
2283cd99ac3SDouglas Anderson static DEFINE_PER_CPU(call_single_data_t, kgdb_roundup_csd);
2293cd99ac3SDouglas Anderson 
2303cd99ac3SDouglas Anderson void __weak kgdb_call_nmi_hook(void *ignored)
2313cd99ac3SDouglas Anderson {
2323cd99ac3SDouglas Anderson 	/*
2333cd99ac3SDouglas Anderson 	 * NOTE: get_irq_regs() is supposed to get the registers from
2343cd99ac3SDouglas Anderson 	 * before the IPI interrupt happened and so is supposed to
2353cd99ac3SDouglas Anderson 	 * show where the processor was.  In some situations it's
2363cd99ac3SDouglas Anderson 	 * possible we might be called without an IPI, so it might be
2373cd99ac3SDouglas Anderson 	 * safer to figure out how to make kgdb_breakpoint() work
2383cd99ac3SDouglas Anderson 	 * properly here.
2393cd99ac3SDouglas Anderson 	 */
2403cd99ac3SDouglas Anderson 	kgdb_nmicallback(raw_smp_processor_id(), get_irq_regs());
2413cd99ac3SDouglas Anderson }
2423cd99ac3SDouglas Anderson 
2433cd99ac3SDouglas Anderson void __weak kgdb_roundup_cpus(void)
2443cd99ac3SDouglas Anderson {
2453cd99ac3SDouglas Anderson 	call_single_data_t *csd;
2463cd99ac3SDouglas Anderson 	int this_cpu = raw_smp_processor_id();
2473cd99ac3SDouglas Anderson 	int cpu;
24887b09592SDouglas Anderson 	int ret;
2493cd99ac3SDouglas Anderson 
2503cd99ac3SDouglas Anderson 	for_each_online_cpu(cpu) {
2513cd99ac3SDouglas Anderson 		/* No need to roundup ourselves */
2523cd99ac3SDouglas Anderson 		if (cpu == this_cpu)
2533cd99ac3SDouglas Anderson 			continue;
2543cd99ac3SDouglas Anderson 
2553cd99ac3SDouglas Anderson 		csd = &per_cpu(kgdb_roundup_csd, cpu);
25687b09592SDouglas Anderson 
25787b09592SDouglas Anderson 		/*
25887b09592SDouglas Anderson 		 * If it didn't round up last time, don't try again
25987b09592SDouglas Anderson 		 * since smp_call_function_single_async() will block.
26087b09592SDouglas Anderson 		 *
26187b09592SDouglas Anderson 		 * If rounding_up is false then we know that the
26287b09592SDouglas Anderson 		 * previous call must have at least started and that
26387b09592SDouglas Anderson 		 * means smp_call_function_single_async() won't block.
26487b09592SDouglas Anderson 		 */
26587b09592SDouglas Anderson 		if (kgdb_info[cpu].rounding_up)
26687b09592SDouglas Anderson 			continue;
26787b09592SDouglas Anderson 		kgdb_info[cpu].rounding_up = true;
26887b09592SDouglas Anderson 
2693cd99ac3SDouglas Anderson 		csd->func = kgdb_call_nmi_hook;
27087b09592SDouglas Anderson 		ret = smp_call_function_single_async(cpu, csd);
27187b09592SDouglas Anderson 		if (ret)
27287b09592SDouglas Anderson 			kgdb_info[cpu].rounding_up = false;
2733cd99ac3SDouglas Anderson 	}
2743cd99ac3SDouglas Anderson }
2753cd99ac3SDouglas Anderson 
2763cd99ac3SDouglas Anderson #endif
2773cd99ac3SDouglas Anderson 
278c4338209SJason Wessel /*
279c4338209SJason Wessel  * Some architectures need cache flushes when we set/clear a
280c4338209SJason Wessel  * breakpoint:
281c4338209SJason Wessel  */
282c4338209SJason Wessel static void kgdb_flush_swbreak_addr(unsigned long addr)
283c4338209SJason Wessel {
284c4338209SJason Wessel 	if (!CACHE_FLUSH_IS_SAFE)
285c4338209SJason Wessel 		return;
286c4338209SJason Wessel 
287615d6e87SDavidlohr Bueso 	if (current->mm) {
288615d6e87SDavidlohr Bueso 		int i;
289615d6e87SDavidlohr Bueso 
290615d6e87SDavidlohr Bueso 		for (i = 0; i < VMACACHE_SIZE; i++) {
291314ff785SIngo Molnar 			if (!current->vmacache.vmas[i])
292615d6e87SDavidlohr Bueso 				continue;
293314ff785SIngo Molnar 			flush_cache_range(current->vmacache.vmas[i],
294c4338209SJason Wessel 					  addr, addr + BREAK_INSTR_SIZE);
295c4338209SJason Wessel 		}
296615d6e87SDavidlohr Bueso 	}
297615d6e87SDavidlohr Bueso 
298c4338209SJason Wessel 	/* Force flush instruction cache if it was outside the mm */
299c4338209SJason Wessel 	flush_icache_range(addr, addr + BREAK_INSTR_SIZE);
300c4338209SJason Wessel }
301c4338209SJason Wessel 
302c4338209SJason Wessel /*
303c4338209SJason Wessel  * SW breakpoint management:
304c4338209SJason Wessel  */
30553197fc4SJason Wessel int dbg_activate_sw_breakpoints(void)
306c4338209SJason Wessel {
307c4338209SJason Wessel 	int error;
308c4338209SJason Wessel 	int ret = 0;
309c4338209SJason Wessel 	int i;
310c4338209SJason Wessel 
311c4338209SJason Wessel 	for (i = 0; i < KGDB_MAX_BREAKPOINTS; i++) {
312c4338209SJason Wessel 		if (kgdb_break[i].state != BP_SET)
313c4338209SJason Wessel 			continue;
314c4338209SJason Wessel 
31598b54aa1SJason Wessel 		error = kgdb_arch_set_breakpoint(&kgdb_break[i]);
316c4338209SJason Wessel 		if (error) {
317c4338209SJason Wessel 			ret = error;
3180f16996cSFabian Frederick 			pr_info("BP install failed: %lx\n",
31998b54aa1SJason Wessel 				kgdb_break[i].bpt_addr);
320c4338209SJason Wessel 			continue;
321c4338209SJason Wessel 		}
322c4338209SJason Wessel 
32398b54aa1SJason Wessel 		kgdb_flush_swbreak_addr(kgdb_break[i].bpt_addr);
324c4338209SJason Wessel 		kgdb_break[i].state = BP_ACTIVE;
325c4338209SJason Wessel 	}
326c4338209SJason Wessel 	return ret;
327c4338209SJason Wessel }
328c4338209SJason Wessel 
32953197fc4SJason Wessel int dbg_set_sw_break(unsigned long addr)
330c4338209SJason Wessel {
331c4338209SJason Wessel 	int err = kgdb_validate_break_address(addr);
332c4338209SJason Wessel 	int breakno = -1;
333c4338209SJason Wessel 	int i;
334c4338209SJason Wessel 
335c4338209SJason Wessel 	if (err)
336c4338209SJason Wessel 		return err;
337c4338209SJason Wessel 
338c4338209SJason Wessel 	for (i = 0; i < KGDB_MAX_BREAKPOINTS; i++) {
339c4338209SJason Wessel 		if ((kgdb_break[i].state == BP_SET) &&
340c4338209SJason Wessel 					(kgdb_break[i].bpt_addr == addr))
341c4338209SJason Wessel 			return -EEXIST;
342c4338209SJason Wessel 	}
343c4338209SJason Wessel 	for (i = 0; i < KGDB_MAX_BREAKPOINTS; i++) {
344c4338209SJason Wessel 		if (kgdb_break[i].state == BP_REMOVED &&
345c4338209SJason Wessel 					kgdb_break[i].bpt_addr == addr) {
346c4338209SJason Wessel 			breakno = i;
347c4338209SJason Wessel 			break;
348c4338209SJason Wessel 		}
349c4338209SJason Wessel 	}
350c4338209SJason Wessel 
351c4338209SJason Wessel 	if (breakno == -1) {
352c4338209SJason Wessel 		for (i = 0; i < KGDB_MAX_BREAKPOINTS; i++) {
353c4338209SJason Wessel 			if (kgdb_break[i].state == BP_UNDEFINED) {
354c4338209SJason Wessel 				breakno = i;
355c4338209SJason Wessel 				break;
356c4338209SJason Wessel 			}
357c4338209SJason Wessel 		}
358c4338209SJason Wessel 	}
359c4338209SJason Wessel 
360c4338209SJason Wessel 	if (breakno == -1)
361c4338209SJason Wessel 		return -E2BIG;
362c4338209SJason Wessel 
363c4338209SJason Wessel 	kgdb_break[breakno].state = BP_SET;
364c4338209SJason Wessel 	kgdb_break[breakno].type = BP_BREAKPOINT;
365c4338209SJason Wessel 	kgdb_break[breakno].bpt_addr = addr;
366c4338209SJason Wessel 
367c4338209SJason Wessel 	return 0;
368c4338209SJason Wessel }
369c4338209SJason Wessel 
370dcc78711SJason Wessel int dbg_deactivate_sw_breakpoints(void)
371c4338209SJason Wessel {
372c4338209SJason Wessel 	int error;
373c4338209SJason Wessel 	int ret = 0;
374c4338209SJason Wessel 	int i;
375c4338209SJason Wessel 
376c4338209SJason Wessel 	for (i = 0; i < KGDB_MAX_BREAKPOINTS; i++) {
377c4338209SJason Wessel 		if (kgdb_break[i].state != BP_ACTIVE)
378c4338209SJason Wessel 			continue;
37998b54aa1SJason Wessel 		error = kgdb_arch_remove_breakpoint(&kgdb_break[i]);
380c4338209SJason Wessel 		if (error) {
3810f16996cSFabian Frederick 			pr_info("BP remove failed: %lx\n",
38298b54aa1SJason Wessel 				kgdb_break[i].bpt_addr);
383c4338209SJason Wessel 			ret = error;
384c4338209SJason Wessel 		}
385c4338209SJason Wessel 
38698b54aa1SJason Wessel 		kgdb_flush_swbreak_addr(kgdb_break[i].bpt_addr);
387c4338209SJason Wessel 		kgdb_break[i].state = BP_SET;
388c4338209SJason Wessel 	}
389c4338209SJason Wessel 	return ret;
390c4338209SJason Wessel }
391c4338209SJason Wessel 
39253197fc4SJason Wessel int dbg_remove_sw_break(unsigned long addr)
393c4338209SJason Wessel {
394c4338209SJason Wessel 	int i;
395c4338209SJason Wessel 
396c4338209SJason Wessel 	for (i = 0; i < KGDB_MAX_BREAKPOINTS; i++) {
397c4338209SJason Wessel 		if ((kgdb_break[i].state == BP_SET) &&
398c4338209SJason Wessel 				(kgdb_break[i].bpt_addr == addr)) {
399c4338209SJason Wessel 			kgdb_break[i].state = BP_REMOVED;
400c4338209SJason Wessel 			return 0;
401c4338209SJason Wessel 		}
402c4338209SJason Wessel 	}
403c4338209SJason Wessel 	return -ENOENT;
404c4338209SJason Wessel }
405c4338209SJason Wessel 
406c4338209SJason Wessel int kgdb_isremovedbreak(unsigned long addr)
407c4338209SJason Wessel {
408c4338209SJason Wessel 	int i;
409c4338209SJason Wessel 
410c4338209SJason Wessel 	for (i = 0; i < KGDB_MAX_BREAKPOINTS; i++) {
411c4338209SJason Wessel 		if ((kgdb_break[i].state == BP_REMOVED) &&
412c4338209SJason Wessel 					(kgdb_break[i].bpt_addr == addr))
413c4338209SJason Wessel 			return 1;
414c4338209SJason Wessel 	}
415c4338209SJason Wessel 	return 0;
416c4338209SJason Wessel }
417c4338209SJason Wessel 
418f83b04d3SVincent Chen int kgdb_has_hit_break(unsigned long addr)
419f83b04d3SVincent Chen {
420f83b04d3SVincent Chen 	int i;
421f83b04d3SVincent Chen 
422f83b04d3SVincent Chen 	for (i = 0; i < KGDB_MAX_BREAKPOINTS; i++) {
423f83b04d3SVincent Chen 		if (kgdb_break[i].state == BP_ACTIVE &&
424f83b04d3SVincent Chen 		    kgdb_break[i].bpt_addr == addr)
425f83b04d3SVincent Chen 			return 1;
426f83b04d3SVincent Chen 	}
427f83b04d3SVincent Chen 	return 0;
428f83b04d3SVincent Chen }
429f83b04d3SVincent Chen 
43053197fc4SJason Wessel int dbg_remove_all_break(void)
431c4338209SJason Wessel {
432c4338209SJason Wessel 	int error;
433c4338209SJason Wessel 	int i;
434c4338209SJason Wessel 
435c4338209SJason Wessel 	/* Clear memory breakpoints. */
436c4338209SJason Wessel 	for (i = 0; i < KGDB_MAX_BREAKPOINTS; i++) {
437c4338209SJason Wessel 		if (kgdb_break[i].state != BP_ACTIVE)
438c4338209SJason Wessel 			goto setundefined;
43998b54aa1SJason Wessel 		error = kgdb_arch_remove_breakpoint(&kgdb_break[i]);
440c4338209SJason Wessel 		if (error)
4410f16996cSFabian Frederick 			pr_err("breakpoint remove failed: %lx\n",
44298b54aa1SJason Wessel 			       kgdb_break[i].bpt_addr);
443c4338209SJason Wessel setundefined:
444c4338209SJason Wessel 		kgdb_break[i].state = BP_UNDEFINED;
445c4338209SJason Wessel 	}
446c4338209SJason Wessel 
447c4338209SJason Wessel 	/* Clear hardware breakpoints. */
448c4338209SJason Wessel 	if (arch_kgdb_ops.remove_all_hw_break)
449c4338209SJason Wessel 		arch_kgdb_ops.remove_all_hw_break();
450c4338209SJason Wessel 
451c4338209SJason Wessel 	return 0;
452c4338209SJason Wessel }
453c4338209SJason Wessel 
4542277b492SDouglas Anderson #ifdef CONFIG_KGDB_KDB
4552277b492SDouglas Anderson void kdb_dump_stack_on_cpu(int cpu)
4562277b492SDouglas Anderson {
457d07ce4e3SDaniel Thompson 	if (cpu == raw_smp_processor_id() || !IS_ENABLED(CONFIG_SMP)) {
4582277b492SDouglas Anderson 		dump_stack();
4592277b492SDouglas Anderson 		return;
4602277b492SDouglas Anderson 	}
4612277b492SDouglas Anderson 
4622277b492SDouglas Anderson 	if (!(kgdb_info[cpu].exception_state & DCPU_IS_SLAVE)) {
4632277b492SDouglas Anderson 		kdb_printf("ERROR: Task on cpu %d didn't stop in the debugger\n",
4642277b492SDouglas Anderson 			   cpu);
4652277b492SDouglas Anderson 		return;
4662277b492SDouglas Anderson 	}
4672277b492SDouglas Anderson 
4682277b492SDouglas Anderson 	/*
4692277b492SDouglas Anderson 	 * In general, architectures don't support dumping the stack of a
4702277b492SDouglas Anderson 	 * "running" process that's not the current one.  From the point of
4712277b492SDouglas Anderson 	 * view of the Linux, kernel processes that are looping in the kgdb
4722277b492SDouglas Anderson 	 * slave loop are still "running".  There's also no API (that actually
4732277b492SDouglas Anderson 	 * works across all architectures) that can do a stack crawl based
4742277b492SDouglas Anderson 	 * on registers passed as a parameter.
4752277b492SDouglas Anderson 	 *
4762277b492SDouglas Anderson 	 * Solve this conundrum by asking slave CPUs to do the backtrace
4772277b492SDouglas Anderson 	 * themselves.
4782277b492SDouglas Anderson 	 */
4792277b492SDouglas Anderson 	kgdb_info[cpu].exception_state |= DCPU_WANT_BT;
4802277b492SDouglas Anderson 	while (kgdb_info[cpu].exception_state & DCPU_WANT_BT)
4812277b492SDouglas Anderson 		cpu_relax();
4822277b492SDouglas Anderson }
4832277b492SDouglas Anderson #endif
4842277b492SDouglas Anderson 
485c4338209SJason Wessel /*
486c4338209SJason Wessel  * Return true if there is a valid kgdb I/O module.  Also if no
487c4338209SJason Wessel  * debugger is attached a message can be printed to the console about
488c4338209SJason Wessel  * waiting for the debugger to attach.
489c4338209SJason Wessel  *
490c4338209SJason Wessel  * The print_wait argument is only to be true when called from inside
491c4338209SJason Wessel  * the core kgdb_handle_exception, because it will wait for the
492c4338209SJason Wessel  * debugger to attach.
493c4338209SJason Wessel  */
494c4338209SJason Wessel static int kgdb_io_ready(int print_wait)
495c4338209SJason Wessel {
49653197fc4SJason Wessel 	if (!dbg_io_ops)
497c4338209SJason Wessel 		return 0;
498c4338209SJason Wessel 	if (kgdb_connected)
499c4338209SJason Wessel 		return 1;
500c4338209SJason Wessel 	if (atomic_read(&kgdb_setting_breakpoint))
501c4338209SJason Wessel 		return 1;
502dcc78711SJason Wessel 	if (print_wait) {
503dcc78711SJason Wessel #ifdef CONFIG_KGDB_KDB
504dcc78711SJason Wessel 		if (!dbg_kdb_mode)
5050f16996cSFabian Frederick 			pr_crit("waiting... or $3#33 for KDB\n");
506dcc78711SJason Wessel #else
5070f16996cSFabian Frederick 		pr_crit("Waiting for remote debugger\n");
508dcc78711SJason Wessel #endif
509dcc78711SJason Wessel 	}
510c4338209SJason Wessel 	return 1;
511c4338209SJason Wessel }
512c4338209SJason Wessel 
513c4338209SJason Wessel static int kgdb_reenter_check(struct kgdb_state *ks)
514c4338209SJason Wessel {
515c4338209SJason Wessel 	unsigned long addr;
516c4338209SJason Wessel 
517c4338209SJason Wessel 	if (atomic_read(&kgdb_active) != raw_smp_processor_id())
518c4338209SJason Wessel 		return 0;
519c4338209SJason Wessel 
520c4338209SJason Wessel 	/* Panic on recursive debugger calls: */
521c4338209SJason Wessel 	exception_level++;
522c4338209SJason Wessel 	addr = kgdb_arch_pc(ks->ex_vector, ks->linux_regs);
523dcc78711SJason Wessel 	dbg_deactivate_sw_breakpoints();
524c4338209SJason Wessel 
525c4338209SJason Wessel 	/*
526c4338209SJason Wessel 	 * If the break point removed ok at the place exception
527c4338209SJason Wessel 	 * occurred, try to recover and print a warning to the end
528c4338209SJason Wessel 	 * user because the user planted a breakpoint in a place that
529c4338209SJason Wessel 	 * KGDB needs in order to function.
530c4338209SJason Wessel 	 */
53153197fc4SJason Wessel 	if (dbg_remove_sw_break(addr) == 0) {
532c4338209SJason Wessel 		exception_level = 0;
533c4338209SJason Wessel 		kgdb_skipexception(ks->ex_vector, ks->linux_regs);
53453197fc4SJason Wessel 		dbg_activate_sw_breakpoints();
5350f16996cSFabian Frederick 		pr_crit("re-enter error: breakpoint removed %lx\n", addr);
536c4338209SJason Wessel 		WARN_ON_ONCE(1);
537c4338209SJason Wessel 
538c4338209SJason Wessel 		return 1;
539c4338209SJason Wessel 	}
54053197fc4SJason Wessel 	dbg_remove_all_break();
541c4338209SJason Wessel 	kgdb_skipexception(ks->ex_vector, ks->linux_regs);
542c4338209SJason Wessel 
543c4338209SJason Wessel 	if (exception_level > 1) {
544c4338209SJason Wessel 		dump_stack();
5453ca676e4SDouglas Anderson 		kgdb_io_module_registered = false;
546c4338209SJason Wessel 		panic("Recursive entry to debugger");
547c4338209SJason Wessel 	}
548c4338209SJason Wessel 
5490f16996cSFabian Frederick 	pr_crit("re-enter exception: ALL breakpoints killed\n");
5506d906340SJason Wessel #ifdef CONFIG_KGDB_KDB
5516d906340SJason Wessel 	/* Allow kdb to debug itself one level */
5526d906340SJason Wessel 	return 0;
5536d906340SJason Wessel #endif
554c4338209SJason Wessel 	dump_stack();
555c4338209SJason Wessel 	panic("Recursive entry to debugger");
556c4338209SJason Wessel 
557c4338209SJason Wessel 	return 1;
558c4338209SJason Wessel }
559c4338209SJason Wessel 
56016cdc628SJason Wessel static void dbg_touch_watchdogs(void)
56116cdc628SJason Wessel {
56216cdc628SJason Wessel 	touch_softlockup_watchdog_sync();
56316cdc628SJason Wessel 	clocksource_touch_watchdog();
564fb70b588SJason Wessel 	rcu_cpu_stall_reset();
56516cdc628SJason Wessel }
56616cdc628SJason Wessel 
567dfee3a7bSJason Wessel static int kgdb_cpu_enter(struct kgdb_state *ks, struct pt_regs *regs,
568dfee3a7bSJason Wessel 		int exception_state)
569c4338209SJason Wessel {
570c4338209SJason Wessel 	unsigned long flags;
571c4338209SJason Wessel 	int sstep_tries = 100;
572dcc78711SJason Wessel 	int error;
573dfee3a7bSJason Wessel 	int cpu;
574c4338209SJason Wessel 	int trace_on = 0;
575dfee3a7bSJason Wessel 	int online_cpus = num_online_cpus();
576a1465d2fSDaniel Thompson 	u64 time_left;
577c1bb9a9cSDongdong Deng 
578dfee3a7bSJason Wessel 	kgdb_info[ks->cpu].enter_kgdb++;
579dfee3a7bSJason Wessel 	kgdb_info[ks->cpu].exception_state |= exception_state;
580dfee3a7bSJason Wessel 
581dfee3a7bSJason Wessel 	if (exception_state == DCPU_WANT_MASTER)
582dfee3a7bSJason Wessel 		atomic_inc(&masters_in_kgdb);
583dfee3a7bSJason Wessel 	else
584dfee3a7bSJason Wessel 		atomic_inc(&slaves_in_kgdb);
585d7ba979dSDongdong Deng 
586d7ba979dSDongdong Deng 	if (arch_kgdb_ops.disable_hw_break)
587d7ba979dSDongdong Deng 		arch_kgdb_ops.disable_hw_break(regs);
588c1bb9a9cSDongdong Deng 
589c4338209SJason Wessel acquirelock:
590c4338209SJason Wessel 	/*
591c4338209SJason Wessel 	 * Interrupts will be restored by the 'trap return' code, except when
592c4338209SJason Wessel 	 * single stepping.
593c4338209SJason Wessel 	 */
594c4338209SJason Wessel 	local_irq_save(flags);
595c4338209SJason Wessel 
596c4338209SJason Wessel 	cpu = ks->cpu;
597c4338209SJason Wessel 	kgdb_info[cpu].debuggerinfo = regs;
598c4338209SJason Wessel 	kgdb_info[cpu].task = current;
599dcc78711SJason Wessel 	kgdb_info[cpu].ret_state = 0;
600dcc78711SJason Wessel 	kgdb_info[cpu].irq_depth = hardirq_count() >> HARDIRQ_SHIFT;
601c4338209SJason Wessel 
602dfee3a7bSJason Wessel 	/* Make sure the above info reaches the primary CPU */
603dfee3a7bSJason Wessel 	smp_mb();
604dfee3a7bSJason Wessel 
605dfee3a7bSJason Wessel 	if (exception_level == 1) {
606dfee3a7bSJason Wessel 		if (raw_spin_trylock(&dbg_master_lock))
607dfee3a7bSJason Wessel 			atomic_xchg(&kgdb_active, cpu);
6086d906340SJason Wessel 		goto cpu_master_loop;
609dfee3a7bSJason Wessel 	}
6106d906340SJason Wessel 
611c4338209SJason Wessel 	/*
612c4338209SJason Wessel 	 * CPU will loop if it is a slave or request to become a kgdb
613c4338209SJason Wessel 	 * master cpu and acquire the kgdb_active lock:
614c4338209SJason Wessel 	 */
615c4338209SJason Wessel 	while (1) {
616dcc78711SJason Wessel cpu_loop:
617dcc78711SJason Wessel 		if (kgdb_info[cpu].exception_state & DCPU_NEXT_MASTER) {
618dcc78711SJason Wessel 			kgdb_info[cpu].exception_state &= ~DCPU_NEXT_MASTER;
619dcc78711SJason Wessel 			goto cpu_master_loop;
620dcc78711SJason Wessel 		} else if (kgdb_info[cpu].exception_state & DCPU_WANT_MASTER) {
621dfee3a7bSJason Wessel 			if (raw_spin_trylock(&dbg_master_lock)) {
622dfee3a7bSJason Wessel 				atomic_xchg(&kgdb_active, cpu);
623c4338209SJason Wessel 				break;
624dfee3a7bSJason Wessel 			}
6252277b492SDouglas Anderson 		} else if (kgdb_info[cpu].exception_state & DCPU_WANT_BT) {
6262277b492SDouglas Anderson 			dump_stack();
6272277b492SDouglas Anderson 			kgdb_info[cpu].exception_state &= ~DCPU_WANT_BT;
628c4338209SJason Wessel 		} else if (kgdb_info[cpu].exception_state & DCPU_IS_SLAVE) {
629dfee3a7bSJason Wessel 			if (!raw_spin_is_locked(&dbg_slave_lock))
630c4338209SJason Wessel 				goto return_normal;
631c4338209SJason Wessel 		} else {
632c4338209SJason Wessel return_normal:
633c4338209SJason Wessel 			/* Return to normal operation by executing any
634c4338209SJason Wessel 			 * hw breakpoint fixup.
635c4338209SJason Wessel 			 */
636c4338209SJason Wessel 			if (arch_kgdb_ops.correct_hw_break)
637c4338209SJason Wessel 				arch_kgdb_ops.correct_hw_break();
638c4338209SJason Wessel 			if (trace_on)
639c4338209SJason Wessel 				tracing_on();
640162bc7f5SDouglas Anderson 			kgdb_info[cpu].debuggerinfo = NULL;
641162bc7f5SDouglas Anderson 			kgdb_info[cpu].task = NULL;
642dfee3a7bSJason Wessel 			kgdb_info[cpu].exception_state &=
643dfee3a7bSJason Wessel 				~(DCPU_WANT_MASTER | DCPU_IS_SLAVE);
644dfee3a7bSJason Wessel 			kgdb_info[cpu].enter_kgdb--;
6454e857c58SPeter Zijlstra 			smp_mb__before_atomic();
646dfee3a7bSJason Wessel 			atomic_dec(&slaves_in_kgdb);
64716cdc628SJason Wessel 			dbg_touch_watchdogs();
648c4338209SJason Wessel 			local_irq_restore(flags);
649c4338209SJason Wessel 			return 0;
650c4338209SJason Wessel 		}
651c4338209SJason Wessel 		cpu_relax();
652c4338209SJason Wessel 	}
653c4338209SJason Wessel 
654c4338209SJason Wessel 	/*
655c4338209SJason Wessel 	 * For single stepping, try to only enter on the processor
65625985edcSLucas De Marchi 	 * that was single stepping.  To guard against a deadlock, the
657c4338209SJason Wessel 	 * kernel will only try for the value of sstep_tries before
658c4338209SJason Wessel 	 * giving up and continuing on.
659c4338209SJason Wessel 	 */
660c4338209SJason Wessel 	if (atomic_read(&kgdb_cpu_doing_single_step) != -1 &&
661c4338209SJason Wessel 	    (kgdb_info[cpu].task &&
662c4338209SJason Wessel 	     kgdb_info[cpu].task->pid != kgdb_sstep_pid) && --sstep_tries) {
663c4338209SJason Wessel 		atomic_set(&kgdb_active, -1);
664dfee3a7bSJason Wessel 		raw_spin_unlock(&dbg_master_lock);
66516cdc628SJason Wessel 		dbg_touch_watchdogs();
666c4338209SJason Wessel 		local_irq_restore(flags);
667c4338209SJason Wessel 
668c4338209SJason Wessel 		goto acquirelock;
669c4338209SJason Wessel 	}
670c4338209SJason Wessel 
671c4338209SJason Wessel 	if (!kgdb_io_ready(1)) {
672dcc78711SJason Wessel 		kgdb_info[cpu].ret_state = 1;
67353197fc4SJason Wessel 		goto kgdb_restore; /* No I/O connection, resume the system */
674c4338209SJason Wessel 	}
675c4338209SJason Wessel 
676c4338209SJason Wessel 	/*
677c4338209SJason Wessel 	 * Don't enter if we have hit a removed breakpoint.
678c4338209SJason Wessel 	 */
679c4338209SJason Wessel 	if (kgdb_skipexception(ks->ex_vector, ks->linux_regs))
680c4338209SJason Wessel 		goto kgdb_restore;
681c4338209SJason Wessel 
682202164fbSDouglas Anderson 	atomic_inc(&ignore_console_lock_warning);
683202164fbSDouglas Anderson 
684c4338209SJason Wessel 	/* Call the I/O driver's pre_exception routine */
68553197fc4SJason Wessel 	if (dbg_io_ops->pre_exception)
68653197fc4SJason Wessel 		dbg_io_ops->pre_exception();
687c4338209SJason Wessel 
688c4338209SJason Wessel 	/*
689c4338209SJason Wessel 	 * Get the passive CPU lock which will hold all the non-primary
690c4338209SJason Wessel 	 * CPU in a spin state while the debugger is active
691c4338209SJason Wessel 	 */
692dfee3a7bSJason Wessel 	if (!kgdb_single_step)
693dfee3a7bSJason Wessel 		raw_spin_lock(&dbg_slave_lock);
694c4338209SJason Wessel 
695c4338209SJason Wessel #ifdef CONFIG_SMP
6968daaa5f8SMike Travis 	/* If send_ready set, slaves are already waiting */
6978daaa5f8SMike Travis 	if (ks->send_ready)
6988daaa5f8SMike Travis 		atomic_set(ks->send_ready, 1);
6998daaa5f8SMike Travis 
700c4338209SJason Wessel 	/* Signal the other CPUs to enter kgdb_wait() */
7018daaa5f8SMike Travis 	else if ((!kgdb_single_step) && kgdb_do_roundup)
7029ef7fa50SDouglas Anderson 		kgdb_roundup_cpus();
703c4338209SJason Wessel #endif
704c4338209SJason Wessel 
705c4338209SJason Wessel 	/*
706c4338209SJason Wessel 	 * Wait for the other CPUs to be notified and be waiting for us:
707c4338209SJason Wessel 	 */
7082d13bb64SDouglas Anderson 	time_left = MSEC_PER_SEC;
709a1465d2fSDaniel Thompson 	while (kgdb_do_roundup && --time_left &&
710a1465d2fSDaniel Thompson 	       (atomic_read(&masters_in_kgdb) + atomic_read(&slaves_in_kgdb)) !=
711a1465d2fSDaniel Thompson 		   online_cpus)
7122d13bb64SDouglas Anderson 		udelay(1000);
713a1465d2fSDaniel Thompson 	if (!time_left)
714df0036d1SJason Wessel 		pr_crit("Timed out waiting for secondary CPUs.\n");
715c4338209SJason Wessel 
716c4338209SJason Wessel 	/*
717c4338209SJason Wessel 	 * At this point the primary processor is completely
718c4338209SJason Wessel 	 * in the debugger and all secondary CPUs are quiescent
719c4338209SJason Wessel 	 */
720dcc78711SJason Wessel 	dbg_deactivate_sw_breakpoints();
721c4338209SJason Wessel 	kgdb_single_step = 0;
722c4338209SJason Wessel 	kgdb_contthread = current;
723c4338209SJason Wessel 	exception_level = 0;
724c4338209SJason Wessel 	trace_on = tracing_is_on();
725c4338209SJason Wessel 	if (trace_on)
726c4338209SJason Wessel 		tracing_off();
727c4338209SJason Wessel 
728dcc78711SJason Wessel 	while (1) {
729dcc78711SJason Wessel cpu_master_loop:
730dcc78711SJason Wessel 		if (dbg_kdb_mode) {
731dcc78711SJason Wessel 			kgdb_connected = 1;
732dcc78711SJason Wessel 			error = kdb_stub(ks);
7333fa43abaSJason Wessel 			if (error == -1)
7343fa43abaSJason Wessel 				continue;
735b0679c63SJason Wessel 			kgdb_connected = 0;
736dcc78711SJason Wessel 		} else {
737c4338209SJason Wessel 			error = gdb_serial_stub(ks);
738dcc78711SJason Wessel 		}
739dcc78711SJason Wessel 
740dcc78711SJason Wessel 		if (error == DBG_PASS_EVENT) {
741dcc78711SJason Wessel 			dbg_kdb_mode = !dbg_kdb_mode;
742dcc78711SJason Wessel 		} else if (error == DBG_SWITCH_CPU_EVENT) {
743495363d3SJason Wessel 			kgdb_info[dbg_switch_cpu].exception_state |=
744495363d3SJason Wessel 				DCPU_NEXT_MASTER;
745dcc78711SJason Wessel 			goto cpu_loop;
746dcc78711SJason Wessel 		} else {
747dcc78711SJason Wessel 			kgdb_info[cpu].ret_state = error;
748dcc78711SJason Wessel 			break;
749dcc78711SJason Wessel 		}
750dcc78711SJason Wessel 	}
751c4338209SJason Wessel 
752c4338209SJason Wessel 	/* Call the I/O driver's post_exception routine */
75353197fc4SJason Wessel 	if (dbg_io_ops->post_exception)
75453197fc4SJason Wessel 		dbg_io_ops->post_exception();
755c4338209SJason Wessel 
756202164fbSDouglas Anderson 	atomic_dec(&ignore_console_lock_warning);
757202164fbSDouglas Anderson 
758c4338209SJason Wessel 	if (!kgdb_single_step) {
759dfee3a7bSJason Wessel 		raw_spin_unlock(&dbg_slave_lock);
760dfee3a7bSJason Wessel 		/* Wait till all the CPUs have quit from the debugger. */
761dfee3a7bSJason Wessel 		while (kgdb_do_roundup && atomic_read(&slaves_in_kgdb))
762c4338209SJason Wessel 			cpu_relax();
763c4338209SJason Wessel 	}
764c4338209SJason Wessel 
765c4338209SJason Wessel kgdb_restore:
766c4338209SJason Wessel 	if (atomic_read(&kgdb_cpu_doing_single_step) != -1) {
767c4338209SJason Wessel 		int sstep_cpu = atomic_read(&kgdb_cpu_doing_single_step);
768c4338209SJason Wessel 		if (kgdb_info[sstep_cpu].task)
769c4338209SJason Wessel 			kgdb_sstep_pid = kgdb_info[sstep_cpu].task->pid;
770c4338209SJason Wessel 		else
771c4338209SJason Wessel 			kgdb_sstep_pid = 0;
772c4338209SJason Wessel 	}
773c1bb9a9cSDongdong Deng 	if (arch_kgdb_ops.correct_hw_break)
774c1bb9a9cSDongdong Deng 		arch_kgdb_ops.correct_hw_break();
775c4338209SJason Wessel 	if (trace_on)
776c4338209SJason Wessel 		tracing_on();
777dfee3a7bSJason Wessel 
778162bc7f5SDouglas Anderson 	kgdb_info[cpu].debuggerinfo = NULL;
779162bc7f5SDouglas Anderson 	kgdb_info[cpu].task = NULL;
780dfee3a7bSJason Wessel 	kgdb_info[cpu].exception_state &=
781dfee3a7bSJason Wessel 		~(DCPU_WANT_MASTER | DCPU_IS_SLAVE);
782dfee3a7bSJason Wessel 	kgdb_info[cpu].enter_kgdb--;
7834e857c58SPeter Zijlstra 	smp_mb__before_atomic();
784dfee3a7bSJason Wessel 	atomic_dec(&masters_in_kgdb);
785c4338209SJason Wessel 	/* Free kgdb_active */
786c4338209SJason Wessel 	atomic_set(&kgdb_active, -1);
787dfee3a7bSJason Wessel 	raw_spin_unlock(&dbg_master_lock);
78816cdc628SJason Wessel 	dbg_touch_watchdogs();
789c4338209SJason Wessel 	local_irq_restore(flags);
790c4338209SJason Wessel 
791dcc78711SJason Wessel 	return kgdb_info[cpu].ret_state;
792c4338209SJason Wessel }
793c4338209SJason Wessel 
794c4338209SJason Wessel /*
795c4338209SJason Wessel  * kgdb_handle_exception() - main entry point from a kernel exception
796c4338209SJason Wessel  *
797c4338209SJason Wessel  * Locking hierarchy:
798c4338209SJason Wessel  *	interface locks, if any (begin_session)
799c4338209SJason Wessel  *	kgdb lock (kgdb_active)
800c4338209SJason Wessel  */
801c4338209SJason Wessel int
802c4338209SJason Wessel kgdb_handle_exception(int evector, int signo, int ecode, struct pt_regs *regs)
803c4338209SJason Wessel {
804c4338209SJason Wessel 	struct kgdb_state kgdb_var;
805c4338209SJason Wessel 	struct kgdb_state *ks = &kgdb_var;
8065a14feadSAnton Vorontsov 	int ret = 0;
8075a14feadSAnton Vorontsov 
8085a14feadSAnton Vorontsov 	if (arch_kgdb_ops.enable_nmi)
8095a14feadSAnton Vorontsov 		arch_kgdb_ops.enable_nmi(0);
8105516fd7bSColin Cross 	/*
8115516fd7bSColin Cross 	 * Avoid entering the debugger if we were triggered due to an oops
8125516fd7bSColin Cross 	 * but panic_timeout indicates the system should automatically
8135516fd7bSColin Cross 	 * reboot on panic. We don't want to get stuck waiting for input
8145516fd7bSColin Cross 	 * on such systems, especially if its "just" an oops.
8155516fd7bSColin Cross 	 */
8165516fd7bSColin Cross 	if (signo != SIGTRAP && panic_timeout)
8175516fd7bSColin Cross 		return 1;
818c4338209SJason Wessel 
8198daaa5f8SMike Travis 	memset(ks, 0, sizeof(struct kgdb_state));
820c4338209SJason Wessel 	ks->cpu			= raw_smp_processor_id();
821c4338209SJason Wessel 	ks->ex_vector		= evector;
822c4338209SJason Wessel 	ks->signo		= signo;
823c4338209SJason Wessel 	ks->err_code		= ecode;
824c4338209SJason Wessel 	ks->linux_regs		= regs;
825c4338209SJason Wessel 
826c4338209SJason Wessel 	if (kgdb_reenter_check(ks))
8275a14feadSAnton Vorontsov 		goto out; /* Ouch, double exception ! */
828dfee3a7bSJason Wessel 	if (kgdb_info[ks->cpu].enter_kgdb != 0)
8295a14feadSAnton Vorontsov 		goto out;
830dfee3a7bSJason Wessel 
8315a14feadSAnton Vorontsov 	ret = kgdb_cpu_enter(ks, regs, DCPU_WANT_MASTER);
8325a14feadSAnton Vorontsov out:
8335a14feadSAnton Vorontsov 	if (arch_kgdb_ops.enable_nmi)
8345a14feadSAnton Vorontsov 		arch_kgdb_ops.enable_nmi(1);
8355a14feadSAnton Vorontsov 	return ret;
836c4338209SJason Wessel }
837c4338209SJason Wessel 
838f30fed10SJason Wessel /*
839d8a050f5SNadav Amit  * GDB places a breakpoint at this function to know dynamically loaded objects.
840f30fed10SJason Wessel  */
841f30fed10SJason Wessel static int module_event(struct notifier_block *self, unsigned long val,
842f30fed10SJason Wessel 	void *data)
843f30fed10SJason Wessel {
844f30fed10SJason Wessel 	return 0;
845f30fed10SJason Wessel }
846f30fed10SJason Wessel 
847f30fed10SJason Wessel static struct notifier_block dbg_module_load_nb = {
848f30fed10SJason Wessel 	.notifier_call	= module_event,
849f30fed10SJason Wessel };
850f30fed10SJason Wessel 
851c4338209SJason Wessel int kgdb_nmicallback(int cpu, void *regs)
852c4338209SJason Wessel {
853c4338209SJason Wessel #ifdef CONFIG_SMP
854c4338209SJason Wessel 	struct kgdb_state kgdb_var;
855c4338209SJason Wessel 	struct kgdb_state *ks = &kgdb_var;
856c4338209SJason Wessel 
85787b09592SDouglas Anderson 	kgdb_info[cpu].rounding_up = false;
85887b09592SDouglas Anderson 
859c4338209SJason Wessel 	memset(ks, 0, sizeof(struct kgdb_state));
860c4338209SJason Wessel 	ks->cpu			= cpu;
861c4338209SJason Wessel 	ks->linux_regs		= regs;
862c4338209SJason Wessel 
863dfee3a7bSJason Wessel 	if (kgdb_info[ks->cpu].enter_kgdb == 0 &&
864dfee3a7bSJason Wessel 			raw_spin_is_locked(&dbg_master_lock)) {
865dfee3a7bSJason Wessel 		kgdb_cpu_enter(ks, regs, DCPU_IS_SLAVE);
866c4338209SJason Wessel 		return 0;
867c4338209SJason Wessel 	}
868c4338209SJason Wessel #endif
869c4338209SJason Wessel 	return 1;
870c4338209SJason Wessel }
871c4338209SJason Wessel 
872fc8b1374SMike Travis int kgdb_nmicallin(int cpu, int trapnr, void *regs, int err_code,
873fc8b1374SMike Travis 							atomic_t *send_ready)
8748daaa5f8SMike Travis {
8758daaa5f8SMike Travis #ifdef CONFIG_SMP
8768daaa5f8SMike Travis 	if (!kgdb_io_ready(0) || !send_ready)
8778daaa5f8SMike Travis 		return 1;
8788daaa5f8SMike Travis 
8798daaa5f8SMike Travis 	if (kgdb_info[cpu].enter_kgdb == 0) {
8808daaa5f8SMike Travis 		struct kgdb_state kgdb_var;
8818daaa5f8SMike Travis 		struct kgdb_state *ks = &kgdb_var;
8828daaa5f8SMike Travis 
8838daaa5f8SMike Travis 		memset(ks, 0, sizeof(struct kgdb_state));
8848daaa5f8SMike Travis 		ks->cpu			= cpu;
8858daaa5f8SMike Travis 		ks->ex_vector		= trapnr;
8868daaa5f8SMike Travis 		ks->signo		= SIGTRAP;
887fc8b1374SMike Travis 		ks->err_code		= err_code;
8888daaa5f8SMike Travis 		ks->linux_regs		= regs;
8898daaa5f8SMike Travis 		ks->send_ready		= send_ready;
8908daaa5f8SMike Travis 		kgdb_cpu_enter(ks, regs, DCPU_WANT_MASTER);
8918daaa5f8SMike Travis 		return 0;
8928daaa5f8SMike Travis 	}
8938daaa5f8SMike Travis #endif
8948daaa5f8SMike Travis 	return 1;
8958daaa5f8SMike Travis }
8968daaa5f8SMike Travis 
897c4338209SJason Wessel static void kgdb_console_write(struct console *co, const char *s,
898c4338209SJason Wessel    unsigned count)
899c4338209SJason Wessel {
900c4338209SJason Wessel 	unsigned long flags;
901c4338209SJason Wessel 
902c4338209SJason Wessel 	/* If we're debugging, or KGDB has not connected, don't try
903c4338209SJason Wessel 	 * and print. */
904dcc78711SJason Wessel 	if (!kgdb_connected || atomic_read(&kgdb_active) != -1 || dbg_kdb_mode)
905c4338209SJason Wessel 		return;
906c4338209SJason Wessel 
907c4338209SJason Wessel 	local_irq_save(flags);
90853197fc4SJason Wessel 	gdbstub_msg_write(s, count);
909c4338209SJason Wessel 	local_irq_restore(flags);
910c4338209SJason Wessel }
911c4338209SJason Wessel 
912c4338209SJason Wessel static struct console kgdbcons = {
913c4338209SJason Wessel 	.name		= "kgdb",
914c4338209SJason Wessel 	.write		= kgdb_console_write,
915c4338209SJason Wessel 	.flags		= CON_PRINTBUFFER | CON_ENABLED,
916c4338209SJason Wessel 	.index		= -1,
917c4338209SJason Wessel };
918c4338209SJason Wessel 
919c4338209SJason Wessel #ifdef CONFIG_MAGIC_SYSRQ
9201495cc9dSDmitry Torokhov static void sysrq_handle_dbg(int key)
921c4338209SJason Wessel {
92253197fc4SJason Wessel 	if (!dbg_io_ops) {
9230f16996cSFabian Frederick 		pr_crit("ERROR: No KGDB I/O module available\n");
924c4338209SJason Wessel 		return;
925c4338209SJason Wessel 	}
926dcc78711SJason Wessel 	if (!kgdb_connected) {
927dcc78711SJason Wessel #ifdef CONFIG_KGDB_KDB
928dcc78711SJason Wessel 		if (!dbg_kdb_mode)
9290f16996cSFabian Frederick 			pr_crit("KGDB or $3#33 for KDB\n");
930dcc78711SJason Wessel #else
9310f16996cSFabian Frederick 		pr_crit("Entering KGDB\n");
932dcc78711SJason Wessel #endif
933dcc78711SJason Wessel 	}
934c4338209SJason Wessel 
935c4338209SJason Wessel 	kgdb_breakpoint();
936c4338209SJason Wessel }
937c4338209SJason Wessel 
938c69b470eSEmil Velikov static const struct sysrq_key_op sysrq_dbg_op = {
93953197fc4SJason Wessel 	.handler	= sysrq_handle_dbg,
940f3456509Szhangwei(Jovi) 	.help_msg	= "debug(g)",
941c4338209SJason Wessel 	.action_msg	= "DEBUG",
942c4338209SJason Wessel };
943c4338209SJason Wessel #endif
944c4338209SJason Wessel 
9457d92bda2SDouglas Anderson void kgdb_panic(const char *msg)
9464402c153SJason Wessel {
9477d92bda2SDouglas Anderson 	if (!kgdb_io_module_registered)
9487d92bda2SDouglas Anderson 		return;
9497d92bda2SDouglas Anderson 
9505516fd7bSColin Cross 	/*
9517d92bda2SDouglas Anderson 	 * We don't want to get stuck waiting for input from user if
9527d92bda2SDouglas Anderson 	 * "panic_timeout" indicates the system should automatically
9535516fd7bSColin Cross 	 * reboot on panic.
9545516fd7bSColin Cross 	 */
9555516fd7bSColin Cross 	if (panic_timeout)
9567d92bda2SDouglas Anderson 		return;
9575516fd7bSColin Cross 
9584402c153SJason Wessel 	if (dbg_kdb_mode)
9597d92bda2SDouglas Anderson 		kdb_printf("PANIC: %s\n", msg);
9604402c153SJason Wessel 
9617d92bda2SDouglas Anderson 	kgdb_breakpoint();
9627d92bda2SDouglas Anderson }
9634402c153SJason Wessel 
964b1a57bbfSDouglas Anderson static void kgdb_initial_breakpoint(void)
965b1a57bbfSDouglas Anderson {
966b1a57bbfSDouglas Anderson 	kgdb_break_asap = 0;
967b1a57bbfSDouglas Anderson 
968b1a57bbfSDouglas Anderson 	pr_crit("Waiting for connection from remote gdb...\n");
969b1a57bbfSDouglas Anderson 	kgdb_breakpoint();
970b1a57bbfSDouglas Anderson }
971b1a57bbfSDouglas Anderson 
9720b4b3827SJason Wessel void __weak kgdb_arch_late(void)
9730b4b3827SJason Wessel {
9740b4b3827SJason Wessel }
9750b4b3827SJason Wessel 
9760b4b3827SJason Wessel void __init dbg_late_init(void)
9770b4b3827SJason Wessel {
9780b4b3827SJason Wessel 	dbg_is_early = false;
9790b4b3827SJason Wessel 	if (kgdb_io_module_registered)
9800b4b3827SJason Wessel 		kgdb_arch_late();
9810b4b3827SJason Wessel 	kdb_init(KDB_INIT_FULL);
982b1a57bbfSDouglas Anderson 
983b1a57bbfSDouglas Anderson 	if (kgdb_io_module_registered && kgdb_break_asap)
984b1a57bbfSDouglas Anderson 		kgdb_initial_breakpoint();
9850b4b3827SJason Wessel }
9860b4b3827SJason Wessel 
9872366e047SJason Wessel static int
9882366e047SJason Wessel dbg_notify_reboot(struct notifier_block *this, unsigned long code, void *x)
9892366e047SJason Wessel {
990bec4d62eSJason Wessel 	/*
991bec4d62eSJason Wessel 	 * Take the following action on reboot notify depending on value:
992bec4d62eSJason Wessel 	 *    1 == Enter debugger
993bec4d62eSJason Wessel 	 *    0 == [the default] detatch debug client
994bec4d62eSJason Wessel 	 *   -1 == Do nothing... and use this until the board resets
995bec4d62eSJason Wessel 	 */
996bec4d62eSJason Wessel 	switch (kgdbreboot) {
997bec4d62eSJason Wessel 	case 1:
998bec4d62eSJason Wessel 		kgdb_breakpoint();
999bec4d62eSJason Wessel 	case -1:
1000bec4d62eSJason Wessel 		goto done;
1001bec4d62eSJason Wessel 	}
10022366e047SJason Wessel 	if (!dbg_kdb_mode)
10032366e047SJason Wessel 		gdbstub_exit(code);
1004bec4d62eSJason Wessel done:
10052366e047SJason Wessel 	return NOTIFY_DONE;
10062366e047SJason Wessel }
10072366e047SJason Wessel 
10082366e047SJason Wessel static struct notifier_block dbg_reboot_notifier = {
10092366e047SJason Wessel 	.notifier_call		= dbg_notify_reboot,
10102366e047SJason Wessel 	.next			= NULL,
10112366e047SJason Wessel 	.priority		= INT_MAX,
10122366e047SJason Wessel };
10132366e047SJason Wessel 
1014c4338209SJason Wessel static void kgdb_register_callbacks(void)
1015c4338209SJason Wessel {
1016c4338209SJason Wessel 	if (!kgdb_io_module_registered) {
1017c4338209SJason Wessel 		kgdb_io_module_registered = 1;
1018c4338209SJason Wessel 		kgdb_arch_init();
10190b4b3827SJason Wessel 		if (!dbg_is_early)
10200b4b3827SJason Wessel 			kgdb_arch_late();
1021f30fed10SJason Wessel 		register_module_notifier(&dbg_module_load_nb);
10222366e047SJason Wessel 		register_reboot_notifier(&dbg_reboot_notifier);
1023c4338209SJason Wessel #ifdef CONFIG_MAGIC_SYSRQ
102453197fc4SJason Wessel 		register_sysrq_key('g', &sysrq_dbg_op);
1025c4338209SJason Wessel #endif
1026c4338209SJason Wessel 		if (kgdb_use_con && !kgdb_con_registered) {
1027c4338209SJason Wessel 			register_console(&kgdbcons);
1028c4338209SJason Wessel 			kgdb_con_registered = 1;
1029c4338209SJason Wessel 		}
1030c4338209SJason Wessel 	}
1031c4338209SJason Wessel }
1032c4338209SJason Wessel 
1033c4338209SJason Wessel static void kgdb_unregister_callbacks(void)
1034c4338209SJason Wessel {
1035c4338209SJason Wessel 	/*
10367d92bda2SDouglas Anderson 	 * When this routine is called KGDB should unregister from
10377d92bda2SDouglas Anderson 	 * handlers and clean up, making sure it is not handling any
1038c4338209SJason Wessel 	 * break exceptions at the time.
1039c4338209SJason Wessel 	 */
1040c4338209SJason Wessel 	if (kgdb_io_module_registered) {
1041c4338209SJason Wessel 		kgdb_io_module_registered = 0;
10422366e047SJason Wessel 		unregister_reboot_notifier(&dbg_reboot_notifier);
1043f30fed10SJason Wessel 		unregister_module_notifier(&dbg_module_load_nb);
1044c4338209SJason Wessel 		kgdb_arch_exit();
1045c4338209SJason Wessel #ifdef CONFIG_MAGIC_SYSRQ
104653197fc4SJason Wessel 		unregister_sysrq_key('g', &sysrq_dbg_op);
1047c4338209SJason Wessel #endif
1048c4338209SJason Wessel 		if (kgdb_con_registered) {
1049c4338209SJason Wessel 			unregister_console(&kgdbcons);
1050c4338209SJason Wessel 			kgdb_con_registered = 0;
1051c4338209SJason Wessel 		}
1052c4338209SJason Wessel 	}
1053c4338209SJason Wessel }
1054c4338209SJason Wessel 
10551cee5e35SJason Wessel /*
10561cee5e35SJason Wessel  * There are times a tasklet needs to be used vs a compiled in
10571cee5e35SJason Wessel  * break point so as to cause an exception outside a kgdb I/O module,
10581cee5e35SJason Wessel  * such as is the case with kgdboe, where calling a breakpoint in the
10591cee5e35SJason Wessel  * I/O driver itself would be fatal.
10601cee5e35SJason Wessel  */
10611cee5e35SJason Wessel static void kgdb_tasklet_bpt(unsigned long ing)
10621cee5e35SJason Wessel {
10631cee5e35SJason Wessel 	kgdb_breakpoint();
10641cee5e35SJason Wessel 	atomic_set(&kgdb_break_tasklet_var, 0);
10651cee5e35SJason Wessel }
10661cee5e35SJason Wessel 
10671cee5e35SJason Wessel static DECLARE_TASKLET(kgdb_tasklet_breakpoint, kgdb_tasklet_bpt, 0);
10681cee5e35SJason Wessel 
10691cee5e35SJason Wessel void kgdb_schedule_breakpoint(void)
10701cee5e35SJason Wessel {
10711cee5e35SJason Wessel 	if (atomic_read(&kgdb_break_tasklet_var) ||
10721cee5e35SJason Wessel 		atomic_read(&kgdb_active) != -1 ||
10731cee5e35SJason Wessel 		atomic_read(&kgdb_setting_breakpoint))
10741cee5e35SJason Wessel 		return;
10751cee5e35SJason Wessel 	atomic_inc(&kgdb_break_tasklet_var);
10761cee5e35SJason Wessel 	tasklet_schedule(&kgdb_tasklet_breakpoint);
10771cee5e35SJason Wessel }
10781cee5e35SJason Wessel EXPORT_SYMBOL_GPL(kgdb_schedule_breakpoint);
10791cee5e35SJason Wessel 
1080c4338209SJason Wessel /**
1081c4338209SJason Wessel  *	kgdb_register_io_module - register KGDB IO module
108253197fc4SJason Wessel  *	@new_dbg_io_ops: the io ops vector
1083c4338209SJason Wessel  *
1084c4338209SJason Wessel  *	Register it with the KGDB core.
1085c4338209SJason Wessel  */
108653197fc4SJason Wessel int kgdb_register_io_module(struct kgdb_io *new_dbg_io_ops)
1087c4338209SJason Wessel {
108822099562SDouglas Anderson 	struct kgdb_io *old_dbg_io_ops;
1089c4338209SJason Wessel 	int err;
1090c4338209SJason Wessel 
1091c4338209SJason Wessel 	spin_lock(&kgdb_registration_lock);
1092c4338209SJason Wessel 
109322099562SDouglas Anderson 	old_dbg_io_ops = dbg_io_ops;
109422099562SDouglas Anderson 	if (old_dbg_io_ops) {
109522099562SDouglas Anderson 		if (!old_dbg_io_ops->deinit) {
1096c4338209SJason Wessel 			spin_unlock(&kgdb_registration_lock);
1097c4338209SJason Wessel 
109822099562SDouglas Anderson 			pr_err("KGDB I/O driver %s can't replace %s.\n",
109922099562SDouglas Anderson 				new_dbg_io_ops->name, old_dbg_io_ops->name);
1100c4338209SJason Wessel 			return -EBUSY;
1101c4338209SJason Wessel 		}
110222099562SDouglas Anderson 		pr_info("Replacing I/O driver %s with %s\n",
110322099562SDouglas Anderson 			old_dbg_io_ops->name, new_dbg_io_ops->name);
110422099562SDouglas Anderson 	}
1105c4338209SJason Wessel 
110653197fc4SJason Wessel 	if (new_dbg_io_ops->init) {
110753197fc4SJason Wessel 		err = new_dbg_io_ops->init();
1108c4338209SJason Wessel 		if (err) {
1109c4338209SJason Wessel 			spin_unlock(&kgdb_registration_lock);
1110c4338209SJason Wessel 			return err;
1111c4338209SJason Wessel 		}
1112c4338209SJason Wessel 	}
1113c4338209SJason Wessel 
111453197fc4SJason Wessel 	dbg_io_ops = new_dbg_io_ops;
1115c4338209SJason Wessel 
1116c4338209SJason Wessel 	spin_unlock(&kgdb_registration_lock);
1117c4338209SJason Wessel 
1118b1350132SDouglas Anderson 	if (old_dbg_io_ops) {
1119b1350132SDouglas Anderson 		old_dbg_io_ops->deinit();
112022099562SDouglas Anderson 		return 0;
1121b1350132SDouglas Anderson 	}
112222099562SDouglas Anderson 
11230f16996cSFabian Frederick 	pr_info("Registered I/O driver %s\n", new_dbg_io_ops->name);
1124c4338209SJason Wessel 
1125c4338209SJason Wessel 	/* Arm KGDB now. */
1126c4338209SJason Wessel 	kgdb_register_callbacks();
1127c4338209SJason Wessel 
1128b1a57bbfSDouglas Anderson 	if (kgdb_break_asap &&
1129b1a57bbfSDouglas Anderson 	    (!dbg_is_early || IS_ENABLED(CONFIG_ARCH_HAS_EARLY_DEBUG)))
1130c4338209SJason Wessel 		kgdb_initial_breakpoint();
1131c4338209SJason Wessel 
1132c4338209SJason Wessel 	return 0;
1133c4338209SJason Wessel }
1134c4338209SJason Wessel EXPORT_SYMBOL_GPL(kgdb_register_io_module);
1135c4338209SJason Wessel 
1136c4338209SJason Wessel /**
1137c4338209SJason Wessel  *	kkgdb_unregister_io_module - unregister KGDB IO module
113853197fc4SJason Wessel  *	@old_dbg_io_ops: the io ops vector
1139c4338209SJason Wessel  *
1140c4338209SJason Wessel  *	Unregister it with the KGDB core.
1141c4338209SJason Wessel  */
114253197fc4SJason Wessel void kgdb_unregister_io_module(struct kgdb_io *old_dbg_io_ops)
1143c4338209SJason Wessel {
1144c4338209SJason Wessel 	BUG_ON(kgdb_connected);
1145c4338209SJason Wessel 
1146c4338209SJason Wessel 	/*
1147c4338209SJason Wessel 	 * KGDB is no longer able to communicate out, so
1148c4338209SJason Wessel 	 * unregister our callbacks and reset state.
1149c4338209SJason Wessel 	 */
1150c4338209SJason Wessel 	kgdb_unregister_callbacks();
1151c4338209SJason Wessel 
1152c4338209SJason Wessel 	spin_lock(&kgdb_registration_lock);
1153c4338209SJason Wessel 
115453197fc4SJason Wessel 	WARN_ON_ONCE(dbg_io_ops != old_dbg_io_ops);
115553197fc4SJason Wessel 	dbg_io_ops = NULL;
1156c4338209SJason Wessel 
1157c4338209SJason Wessel 	spin_unlock(&kgdb_registration_lock);
1158c4338209SJason Wessel 
115922099562SDouglas Anderson 	if (old_dbg_io_ops->deinit)
116022099562SDouglas Anderson 		old_dbg_io_ops->deinit();
116122099562SDouglas Anderson 
11620f16996cSFabian Frederick 	pr_info("Unregistered I/O driver %s, debugger disabled\n",
116353197fc4SJason Wessel 		old_dbg_io_ops->name);
1164c4338209SJason Wessel }
1165c4338209SJason Wessel EXPORT_SYMBOL_GPL(kgdb_unregister_io_module);
1166c4338209SJason Wessel 
1167dcc78711SJason Wessel int dbg_io_get_char(void)
1168dcc78711SJason Wessel {
1169dcc78711SJason Wessel 	int ret = dbg_io_ops->read_char();
1170f5316b4aSJason Wessel 	if (ret == NO_POLL_CHAR)
1171f5316b4aSJason Wessel 		return -1;
1172dcc78711SJason Wessel 	if (!dbg_kdb_mode)
1173dcc78711SJason Wessel 		return ret;
1174dcc78711SJason Wessel 	if (ret == 127)
1175dcc78711SJason Wessel 		return 8;
1176dcc78711SJason Wessel 	return ret;
1177dcc78711SJason Wessel }
1178dcc78711SJason Wessel 
1179c4338209SJason Wessel /**
1180c4338209SJason Wessel  * kgdb_breakpoint - generate breakpoint exception
1181c4338209SJason Wessel  *
1182c4338209SJason Wessel  * This function will generate a breakpoint exception.  It is used at the
1183c4338209SJason Wessel  * beginning of a program to sync up with a debugger and can be used
1184c4338209SJason Wessel  * otherwise as a quick means to stop program execution and "break" into
1185c4338209SJason Wessel  * the debugger.
1186c4338209SJason Wessel  */
1187d498d4b4SVijaya Kumar K noinline void kgdb_breakpoint(void)
1188c4338209SJason Wessel {
1189c4338209SJason Wessel 	atomic_inc(&kgdb_setting_breakpoint);
1190c4338209SJason Wessel 	wmb(); /* Sync point before breakpoint */
1191c4338209SJason Wessel 	arch_kgdb_breakpoint();
1192c4338209SJason Wessel 	wmb(); /* Sync point after breakpoint */
1193c4338209SJason Wessel 	atomic_dec(&kgdb_setting_breakpoint);
1194c4338209SJason Wessel }
1195c4338209SJason Wessel EXPORT_SYMBOL_GPL(kgdb_breakpoint);
1196c4338209SJason Wessel 
1197c4338209SJason Wessel static int __init opt_kgdb_wait(char *str)
1198c4338209SJason Wessel {
1199c4338209SJason Wessel 	kgdb_break_asap = 1;
1200c4338209SJason Wessel 
1201dcc78711SJason Wessel 	kdb_init(KDB_INIT_EARLY);
1202b1a57bbfSDouglas Anderson 	if (kgdb_io_module_registered &&
1203b1a57bbfSDouglas Anderson 	    IS_ENABLED(CONFIG_ARCH_HAS_EARLY_DEBUG))
1204c4338209SJason Wessel 		kgdb_initial_breakpoint();
1205c4338209SJason Wessel 
1206c4338209SJason Wessel 	return 0;
1207c4338209SJason Wessel }
1208c4338209SJason Wessel 
1209c4338209SJason Wessel early_param("kgdbwait", opt_kgdb_wait);
1210