136 lines
3.3 KiB
C
136 lines
3.3 KiB
C
/*
|
|
* 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 },
|
|
};
|