Quelle  kgdb.c   Sprache: C

/*
 * Microblaze KGDB support
 *
 * 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/kgdb.h>
#include <linux/kdebug.h>
#include <linux/irq.h>
#include <linux/io.h>
#include <asm/cacheflush.h>
#include <asm/asm-offsets.h>
#include <asm/kgdb.h>
#include <asm/pvr.h>

#define GDB_REG  0
#define GDB_PC  32
#define GDB_MSR  33
#define GDB_EAR  34
#define GDB_ESR  35
#define GDB_FSR  36
#define GDB_BTR  37
#define GDB_PVR  38
#define GDB_REDR 50
#define GDB_RPID 51
#define GDB_RZPR 52
#define GDB_RTLBX 53
#define GDB_RTLBSX 54 /* mfs can't read it */
#define GDB_RTLBLO 55
#define GDB_RTLBHI 56

/* keep pvr separately because it is unchangeable */
static struct pvr_s pvr;

void pt_regs_to_gdb_regs(unsigned long *gdb_regs, struct pt_regs *regs)
{
 unsigned int i;
 unsigned long *pt_regb = (unsigned long *)regs;
 int temp;

 /* registers r0 - r31, pc, msr, ear, esr, fsr + do not save pt_mode */
 for (i = 0; i < (sizeof(struct pt_regs) / 4) - 1; i++)
  gdb_regs[i] = pt_regb[i];

 /* Branch target register can't be changed */
 __asm__ __volatile__ ("mfs %0, rbtr;" : "=r"(temp) : );
 gdb_regs[GDB_BTR] = temp;

 /* pvr part  - we have 11 pvr regs */
 for (i = 0; i < sizeof(struct pvr_s)/4; i++)
  gdb_regs[GDB_PVR + i] = pvr.pvr[i];

 /* read special registers - can't be changed */
 __asm__ __volatile__ ("mfs %0, redr;" : "=r"(temp) : );
 gdb_regs[GDB_REDR] = temp;
 __asm__ __volatile__ ("mfs %0, rpid;" : "=r"(temp) : );
 gdb_regs[GDB_RPID] = temp;
 __asm__ __volatile__ ("mfs %0, rzpr;" : "=r"(temp) : );
 gdb_regs[GDB_RZPR] = temp;
 __asm__ __volatile__ ("mfs %0, rtlbx;" : "=r"(temp) : );
 gdb_regs[GDB_RTLBX] = temp;
 __asm__ __volatile__ ("mfs %0, rtlblo;" : "=r"(temp) : );
 gdb_regs[GDB_RTLBLO] = temp;
 __asm__ __volatile__ ("mfs %0, rtlbhi;" : "=r"(temp) : );
 gdb_regs[GDB_RTLBHI] = temp;
}

void gdb_regs_to_pt_regs(unsigned long *gdb_regs, struct pt_regs *regs)
{
 unsigned int i;
 unsigned long *pt_regb = (unsigned long *)regs;

 /* pt_regs and gdb_regs have the same 37 values.
 * The rest of gdb_regs are unused and can't be changed.
 * r0 register value can't be changed too. */
 for (i = 1; i < (sizeof(struct pt_regs) / 4) - 1; i++)
  pt_regb[i] = gdb_regs[i];
}

asmlinkage void microblaze_kgdb_break(struct pt_regs *regs)
{
 if (kgdb_handle_exception(1, SIGTRAP, 0, regs) != 0)
  return;

 /* Jump over the first arch_kgdb_breakpoint which is barrier to
 * get kgdb work. The same solution is used for powerpc */
 if (*(u32 *) (regs->pc) == *(u32 *) (&arch_kgdb_ops.gdb_bpt_instr))
  regs->pc += BREAK_INSTR_SIZE;
}

/* untested */
void sleeping_thread_to_gdb_regs(unsigned long *gdb_regs, struct task_struct *p)
{
 unsigned int i;
 unsigned long *pt_regb = (unsigned long *)(p->thread.regs);

 /* registers r0 - r31, pc, msr, ear, esr, fsr + do not save pt_mode */
 for (i = 0; i < (sizeof(struct pt_regs) / 4) - 1; i++)
  gdb_regs[i] = pt_regb[i];

 /* pvr part  - we have 11 pvr regs */
 for (i = 0; i < sizeof(struct pvr_s)/4; i++)
  gdb_regs[GDB_PVR + i] = pvr.pvr[i];
}

void kgdb_arch_set_pc(struct pt_regs *regs, unsigned long ip)
{
 regs->pc = ip;
}

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 address;

 switch (remcom_in_buffer[0]) {
 case 'c':
  /* handle the optional parameter */
  ptr = &remcom_in_buffer[1];
  if (kgdb_hex2long(&ptr, &address))
   regs->pc = address;

  return 0;
 }
 return -1; /* this means that we do not want to exit from the handler */
}

int kgdb_arch_init(void)
{
 get_pvr(&pvr); /* Fill PVR structure */
 return 0;
}

void kgdb_arch_exit(void)
{
 /* Nothing to do */
}

/*
 * Global data
 */
const struct kgdb_arch arch_kgdb_ops = {
#ifdef __MICROBLAZEEL__
 .gdb_bpt_instr = {0x18, 0x00, 0x0c, 0xba}, /* brki r16, 0x18 */
#else
 .gdb_bpt_instr = {0xba, 0x0c, 0x00, 0x18}, /* brki r16, 0x18 */
#endif
};