Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 | /* * H8/300 KGDB support * * Copyright (C) 2015 Yoshinori Sato <ysato@users.sourceforge.jp> * * This file is subject to the terms and conditions of the GNU General Public * License. See the file "COPYING" in the main directory of this archive * for more details. */ #include <linux/ptrace.h> #include <linux/kgdb.h> #include <linux/kdebug.h> #include <linux/io.h> struct dbg_reg_def_t dbg_reg_def[DBG_MAX_REG_NUM] = { { "er0", GDB_SIZEOF_REG, offsetof(struct pt_regs, er0) }, { "er1", GDB_SIZEOF_REG, offsetof(struct pt_regs, er1) }, { "er2", GDB_SIZEOF_REG, offsetof(struct pt_regs, er2) }, { "er3", GDB_SIZEOF_REG, offsetof(struct pt_regs, er3) }, { "er4", GDB_SIZEOF_REG, offsetof(struct pt_regs, er4) }, { "er5", GDB_SIZEOF_REG, offsetof(struct pt_regs, er5) }, { "er6", GDB_SIZEOF_REG, offsetof(struct pt_regs, er6) }, { "sp", GDB_SIZEOF_REG, offsetof(struct pt_regs, sp) }, { "ccr", GDB_SIZEOF_REG, offsetof(struct pt_regs, ccr) }, { "pc", GDB_SIZEOF_REG, offsetof(struct pt_regs, pc) }, { "cycles", GDB_SIZEOF_REG, -1 }, #if defined(CONFIG_CPU_H8S) { "exr", GDB_SIZEOF_REG, offsetof(struct pt_regs, exr) }, #endif { "tick", GDB_SIZEOF_REG, -1 }, { "inst", GDB_SIZEOF_REG, -1 }, }; char *dbg_get_reg(int regno, void *mem, struct pt_regs *regs) { if (regno >= DBG_MAX_REG_NUM || regno < 0) return NULL; switch (regno) { case GDB_CCR: #if defined(CONFIG_CPU_H8S) case GDB_EXR: #endif *(u32 *)mem = *(u16 *)((void *)regs + dbg_reg_def[regno].offset); break; default: if (dbg_reg_def[regno].offset >= 0) memcpy(mem, (void *)regs + dbg_reg_def[regno].offset, dbg_reg_def[regno].size); else memset(mem, 0, dbg_reg_def[regno].size); break; } return dbg_reg_def[regno].name; } int dbg_set_reg(int regno, void *mem, struct pt_regs *regs) { if (regno >= DBG_MAX_REG_NUM || regno < 0) return -EINVAL; switch (regno) { case GDB_CCR: #if defined(CONFIG_CPU_H8S) case GDB_EXR: #endif *(u16 *)((void *)regs + dbg_reg_def[regno].offset) = *(u32 *)mem; break; default: memcpy((void *)regs + dbg_reg_def[regno].offset, mem, dbg_reg_def[regno].size); } return 0; } asmlinkage void h8300_kgdb_trap(struct pt_regs *regs) { regs->pc &= 0x00ffffff; if (kgdb_handle_exception(10, SIGTRAP, 0, regs)) return; if (*(u16 *)(regs->pc) == *(u16 *)&arch_kgdb_ops.gdb_bpt_instr) regs->pc += BREAK_INSTR_SIZE; regs->pc |= regs->ccr << 24; } void sleeping_thread_to_gdb_regs(unsigned long *gdb_regs, struct task_struct *p) { memset((char *)gdb_regs, 0, NUMREGBYTES); gdb_regs[GDB_SP] = p->thread.ksp; gdb_regs[GDB_PC] = KSTK_EIP(p); } void kgdb_arch_set_pc(struct pt_regs *regs, unsigned long pc) { regs->pc = pc; } int kgdb_arch_handle_exception(int vector, int signo, int err_code, char *remcom_in_buffer, char *remcom_out_buffer, struct pt_regs *regs) { char *ptr; unsigned long addr; switch (remcom_in_buffer[0]) { case 's': case 'c': /* handle the optional parameters */ ptr = &remcom_in_buffer[1]; if (kgdb_hex2long(&ptr, &addr)) regs->pc = addr; return 0; } return -1; /* this means that we do not want to exit from the handler */ } int kgdb_arch_init(void) { return 0; } void kgdb_arch_exit(void) { /* Nothing to do */ } struct kgdb_arch arch_kgdb_ops = { /* Breakpoint instruction: trapa #2 */ .gdb_bpt_instr = { 0x57, 0x20 }, }; |