redonkable
/
alistair23-linux
1
0
Fork 0
Code Releases Activity

h8300: Add KGDB support. 

Signed-off-by: Yoshinori Sato <ysato@users.sourceforge.jp>
hifive-unleashed-5.1
Yoshinori Sato 2016-01-20 23:27:30 +09:00
parent be13326058
commit 96ff2d7081
5 changed files with 201 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

1
arch/h8300/Kconfig
View File

@ -20,6 +20,7 @@ config H8300
select H8300_TMR8
select HAVE_KERNEL_GZIP
select HAVE_KERNEL_LZO
select HAVE_ARCH_KGDB
config RWSEM_GENERIC_SPINLOCK
def_bool y

45
arch/h8300/include/asm/kgdb.h 100644
View File

@ -0,0 +1,45 @@
/*
* 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.
*/
#ifndef _ASM_H8300_KGDB_H
#define _ASM_H8300_KGDB_H
#define CACHE_FLUSH_IS_SAFE 1
#define BUFMAX 2048
enum regnames {
GDB_ER0, GDB_ER1, GDB_ER2, GDB_ER3,
GDB_ER4, GDB_ER5, GDB_ER6, GDB_SP,
GDB_CCR, GDB_PC,
GDB_CYCLLE,
#if defined(CONFIG_CPU_H8S)
GDB_EXR,
#endif
GDB_TICK, GDB_INST,
#if defined(CONFIG_CPU_H8S)
GDB_MACH, GDB_MACL,
#endif
/* do not change the last entry or anything below! */
GDB_NUMREGBYTES, /* number of registers */
};
#define GDB_SIZEOF_REG sizeof(u32)
#if defined(CONFIG_CPU_H8300H)
#define DBG_MAX_REG_NUM (13)
#elif defined(CONFIG_CPU_H8S)
#define DBG_MAX_REG_NUM (14)
#endif
#define NUMREGBYTES (DBG_MAX_REG_NUM * GDB_SIZEOF_REG)
#define BREAK_INSTR_SIZE 2
static inline void arch_kgdb_breakpoint(void)
{
__asm__ __volatile__("trapa #2");
}
#endif /* _ASM_H8300_KGDB_H */

2
arch/h8300/kernel/Makefile
View File

@ -17,3 +17,5 @@ obj-$(CONFIG_H8S_SIM) += sim-console.o
obj-$(CONFIG_CPU_H8300H) += ptrace_h.o
obj-$(CONFIG_CPU_H8S) += ptrace_s.o
obj-$(CONFIG_KGDB) += kgdb.o

18
arch/h8300/kernel/entry.S
View File

@ -188,7 +188,11 @@ _interrupt_redirect_table:
jsr @_interrupt_entry /* NMI */
jmp @_system_call /* TRAPA #0 (System call) */
.long 0
#if defined(CONFIG_KGDB)
jmp @_kgdb_trap
#else
.long 0
#endif
jmp @_trace_break /* TRAPA #3 (breakpoint) */
.rept INTERRUPTS-12
jsr @_interrupt_entry
@ -405,6 +409,20 @@ _nmi:
mov.l @sp+, er0
jmp @_interrupt_entry
#if defined(CONFIG_KGDB)
_kgdb_trap:
subs #4,sp
SAVE_ALL
mov.l sp,er0
add.l #LRET,er0
mov.l er0,@(LSP,sp)
jsr @set_esp0
mov.l sp,er0
subs #4,er0
jsr @h8300_kgdb_trap
jmp @ret_from_exception
#endif
.section .bss
_sw_ksp:
.space 4

135
arch/h8300/kernel/kgdb.c 100644
View File

@ -0,0 +1,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 */
}
const struct kgdb_arch arch_kgdb_ops = {
/* Breakpoint instruction: trapa #2 */
.gdb_bpt_instr = { 0x57, 0x20 },
};