^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /* kgdb.c: KGDB support for 32-bit sparc.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) * Copyright (C) 2008 David S. Miller <davem@davemloft.net>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) #include <linux/kgdb.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <linux/kdebug.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/sched.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <asm/kdebug.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <asm/ptrace.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <asm/irq.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <asm/cacheflush.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include "kernel.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include "entry.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) void pt_regs_to_gdb_regs(unsigned long *gdb_regs, struct pt_regs *regs)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) struct reg_window32 *win;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) gdb_regs[GDB_G0] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) for (i = 0; i < 15; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) gdb_regs[GDB_G1 + i] = regs->u_regs[UREG_G1 + i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) win = (struct reg_window32 *) regs->u_regs[UREG_FP];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) for (i = 0; i < 8; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) gdb_regs[GDB_L0 + i] = win->locals[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) for (i = 0; i < 8; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) gdb_regs[GDB_I0 + i] = win->ins[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) for (i = GDB_F0; i <= GDB_F31; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) gdb_regs[i] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) gdb_regs[GDB_Y] = regs->y;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) gdb_regs[GDB_PSR] = regs->psr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) gdb_regs[GDB_WIM] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) gdb_regs[GDB_TBR] = (unsigned long) &trapbase;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) gdb_regs[GDB_PC] = regs->pc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) gdb_regs[GDB_NPC] = regs->npc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) gdb_regs[GDB_FSR] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) gdb_regs[GDB_CSR] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) void sleeping_thread_to_gdb_regs(unsigned long *gdb_regs, struct task_struct *p)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) struct thread_info *t = task_thread_info(p);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) struct reg_window32 *win;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) for (i = GDB_G0; i < GDB_G6; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) gdb_regs[i] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) gdb_regs[GDB_G6] = (unsigned long) t;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) gdb_regs[GDB_G7] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) for (i = GDB_O0; i < GDB_SP; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) gdb_regs[i] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) gdb_regs[GDB_SP] = t->ksp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) gdb_regs[GDB_O7] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) win = (struct reg_window32 *) t->ksp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) for (i = 0; i < 8; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) gdb_regs[GDB_L0 + i] = win->locals[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) for (i = 0; i < 8; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) gdb_regs[GDB_I0 + i] = win->ins[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) for (i = GDB_F0; i <= GDB_F31; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) gdb_regs[i] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) gdb_regs[GDB_Y] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) gdb_regs[GDB_PSR] = t->kpsr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) gdb_regs[GDB_WIM] = t->kwim;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) gdb_regs[GDB_TBR] = (unsigned long) &trapbase;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) gdb_regs[GDB_PC] = t->kpc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) gdb_regs[GDB_NPC] = t->kpc + 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) gdb_regs[GDB_FSR] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) gdb_regs[GDB_CSR] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) void gdb_regs_to_pt_regs(unsigned long *gdb_regs, struct pt_regs *regs)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) struct reg_window32 *win;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) for (i = 0; i < 15; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) regs->u_regs[UREG_G1 + i] = gdb_regs[GDB_G1 + i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) /* If the PSR register is changing, we have to preserve
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) * the CWP field, otherwise window save/restore explodes.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) if (regs->psr != gdb_regs[GDB_PSR]) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) unsigned long cwp = regs->psr & PSR_CWP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) regs->psr = (gdb_regs[GDB_PSR] & ~PSR_CWP) | cwp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) regs->pc = gdb_regs[GDB_PC];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) regs->npc = gdb_regs[GDB_NPC];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) regs->y = gdb_regs[GDB_Y];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) win = (struct reg_window32 *) regs->u_regs[UREG_FP];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) for (i = 0; i < 8; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) win->locals[i] = gdb_regs[GDB_L0 + i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) for (i = 0; i < 8; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) win->ins[i] = gdb_regs[GDB_I0 + i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) int kgdb_arch_handle_exception(int e_vector, int signo, int err_code,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) char *remcomInBuffer, char *remcomOutBuffer,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) struct pt_regs *linux_regs)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) unsigned long addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) char *ptr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) switch (remcomInBuffer[0]) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) case 'c':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) /* try to read optional parameter, pc unchanged if no parm */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) ptr = &remcomInBuffer[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) if (kgdb_hex2long(&ptr, &addr)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) linux_regs->pc = addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) linux_regs->npc = addr + 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) fallthrough;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) case 'D':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) case 'k':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) if (linux_regs->pc == (unsigned long) arch_kgdb_breakpoint) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) linux_regs->pc = linux_regs->npc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) linux_regs->npc += 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) asmlinkage void kgdb_trap(unsigned long trap_level, struct pt_regs *regs)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) if (user_mode(regs)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) do_hw_interrupt(regs, trap_level);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) flushw_all();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) local_irq_save(flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) kgdb_handle_exception(trap_level, SIGTRAP, 0, regs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) local_irq_restore(flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) int kgdb_arch_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) void kgdb_arch_exit(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) void kgdb_arch_set_pc(struct pt_regs *regs, unsigned long ip)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) regs->pc = ip;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) regs->npc = regs->pc + 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) const struct kgdb_arch arch_kgdb_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) /* Breakpoint instruction: ta 0x7d */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) .gdb_bpt_instr = { 0x91, 0xd0, 0x20, 0x7d },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) };
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags