18854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel/* 28854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * Originally written by Glenn Engel, Lake Stevens Instrument Division 38854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * 48854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * Contributed by HP Systems 58854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * 68854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * Modified for Linux/MIPS (and MIPS in general) by Andreas Busse 78854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * Send complaints, suggestions etc. to <andy@waldorf-gmbh.de> 88854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * 98854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * Copyright (C) 1995 Andreas Busse 108854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * 118854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * Copyright (C) 2003 MontaVista Software Inc. 128854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * Author: Jun Sun, jsun@mvista.com or jsun@junsun.net 138854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * 148854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * Copyright (C) 2004-2005 MontaVista Software Inc. 158854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * Author: Manish Lachwani, mlachwani@mvista.com or manish@koffee-break.com 168854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * 178854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * Copyright (C) 2007-2008 Wind River Systems, Inc. 188854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * Author/Maintainer: Jason Wessel, jason.wessel@windriver.com 198854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * 208854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * This file is licensed under the terms of the GNU General Public License 218854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * version 2. This program is licensed "as is" without any warranty of any 228854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * kind, whether express or implied. 238854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel */ 248854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 258854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel#include <linux/ptrace.h> /* for linux pt_regs struct */ 268854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel#include <linux/kgdb.h> 278854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel#include <linux/kdebug.h> 288854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel#include <linux/sched.h> 29631330f5847b3f8a7ea67d689e9f7c56833ccaa6Ralf Baechle#include <linux/smp.h> 308854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel#include <asm/inst.h> 318854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel#include <asm/fpu.h> 328854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel#include <asm/cacheflush.h> 338854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel#include <asm/processor.h> 348854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel#include <asm/sigcontext.h> 356ebda44f366478d1eea180d93154e7d97b591f50Leonid Yegoshin#include <asm/uaccess.h> 368854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 378854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wesselstatic struct hard_trap_info { 388854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel unsigned char tt; /* Trap type code for MIPS R3xxx and R4xxx */ 398854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel unsigned char signo; /* Signal that we map this trap into */ 408854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel} hard_trap_info[] = { 418854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel { 6, SIGBUS }, /* instruction bus error */ 428854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel { 7, SIGBUS }, /* data bus error */ 438854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel { 9, SIGTRAP }, /* break */ 447034228792cc561e79ff8600f02884bd4c80e287Ralf Baechle/* { 11, SIGILL }, */ /* CPU unusable */ 458854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel { 12, SIGFPE }, /* overflow */ 468854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel { 13, SIGTRAP }, /* trap */ 478854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel { 14, SIGSEGV }, /* virtual instruction cache coherency */ 488854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel { 15, SIGFPE }, /* floating point exception */ 498854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel { 23, SIGSEGV }, /* watch */ 508854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel { 31, SIGSEGV }, /* virtual data cache coherency */ 518854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel { 0, 0} /* Must be last */ 528854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel}; 538854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 540896a9becdea36b2da21709b5e73ba47ae6481eaJason Wesselstruct dbg_reg_def_t dbg_reg_def[DBG_MAX_REG_NUM] = 550896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel{ 560896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "zero", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[0]) }, 570896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "at", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[1]) }, 580896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "v0", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[2]) }, 590896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "v1", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[3]) }, 600896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "a0", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[4]) }, 610896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "a1", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[5]) }, 620896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "a2", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[6]) }, 630896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "a3", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[7]) }, 640896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "t0", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[8]) }, 650896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "t1", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[9]) }, 660896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "t2", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[10]) }, 670896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "t3", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[11]) }, 680896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "t4", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[12]) }, 690896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "t5", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[13]) }, 700896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "t6", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[14]) }, 710896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "t7", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[15]) }, 720896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "s0", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[16]) }, 730896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "s1", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[17]) }, 740896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "s2", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[18]) }, 750896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "s3", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[19]) }, 760896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "s4", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[20]) }, 770896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "s5", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[21]) }, 780896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "s6", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[22]) }, 790896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "s7", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[23]) }, 800896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "t8", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[24]) }, 810896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "t9", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[25]) }, 820896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "k0", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[26]) }, 830896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "k1", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[27]) }, 840896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "gp", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[28]) }, 850896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "sp", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[29]) }, 860896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "s8", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[30]) }, 870896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "ra", GDB_SIZEOF_REG, offsetof(struct pt_regs, regs[31]) }, 880896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "sr", GDB_SIZEOF_REG, offsetof(struct pt_regs, cp0_status) }, 890896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "lo", GDB_SIZEOF_REG, offsetof(struct pt_regs, lo) }, 900896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "hi", GDB_SIZEOF_REG, offsetof(struct pt_regs, hi) }, 910896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "bad", GDB_SIZEOF_REG, offsetof(struct pt_regs, cp0_badvaddr) }, 920896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "cause", GDB_SIZEOF_REG, offsetof(struct pt_regs, cp0_cause) }, 930896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "pc", GDB_SIZEOF_REG, offsetof(struct pt_regs, cp0_epc) }, 940896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f0", GDB_SIZEOF_REG, 0 }, 950896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f1", GDB_SIZEOF_REG, 1 }, 960896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f2", GDB_SIZEOF_REG, 2 }, 970896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f3", GDB_SIZEOF_REG, 3 }, 980896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f4", GDB_SIZEOF_REG, 4 }, 990896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f5", GDB_SIZEOF_REG, 5 }, 1000896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f6", GDB_SIZEOF_REG, 6 }, 1010896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f7", GDB_SIZEOF_REG, 7 }, 1020896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f8", GDB_SIZEOF_REG, 8 }, 1030896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f9", GDB_SIZEOF_REG, 9 }, 1040896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f10", GDB_SIZEOF_REG, 10 }, 1050896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f11", GDB_SIZEOF_REG, 11 }, 1060896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f12", GDB_SIZEOF_REG, 12 }, 1070896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f13", GDB_SIZEOF_REG, 13 }, 1080896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f14", GDB_SIZEOF_REG, 14 }, 1090896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f15", GDB_SIZEOF_REG, 15 }, 1100896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f16", GDB_SIZEOF_REG, 16 }, 1110896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f17", GDB_SIZEOF_REG, 17 }, 1120896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f18", GDB_SIZEOF_REG, 18 }, 1130896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f19", GDB_SIZEOF_REG, 19 }, 1140896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f20", GDB_SIZEOF_REG, 20 }, 1150896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f21", GDB_SIZEOF_REG, 21 }, 1160896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f22", GDB_SIZEOF_REG, 22 }, 1170896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f23", GDB_SIZEOF_REG, 23 }, 1180896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f24", GDB_SIZEOF_REG, 24 }, 1190896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f25", GDB_SIZEOF_REG, 25 }, 1200896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f26", GDB_SIZEOF_REG, 26 }, 1210896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f27", GDB_SIZEOF_REG, 27 }, 1220896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f28", GDB_SIZEOF_REG, 28 }, 1230896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f29", GDB_SIZEOF_REG, 29 }, 1240896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f30", GDB_SIZEOF_REG, 30 }, 1250896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "f31", GDB_SIZEOF_REG, 31 }, 1260896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "fsr", GDB_SIZEOF_REG, 0 }, 1270896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel { "fir", GDB_SIZEOF_REG, 0 }, 1280896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel}; 1290896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel 1300896a9becdea36b2da21709b5e73ba47ae6481eaJason Wesselint dbg_set_reg(int regno, void *mem, struct pt_regs *regs) 1310896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel{ 1320896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel int fp_reg; 1330896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel 1340896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel if (regno < 0 || regno >= DBG_MAX_REG_NUM) 1350896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel return -EINVAL; 1360896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel 1370896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel if (dbg_reg_def[regno].offset != -1 && regno < 38) { 1380896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel memcpy((void *)regs + dbg_reg_def[regno].offset, mem, 1390896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel dbg_reg_def[regno].size); 1400896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel } else if (current && dbg_reg_def[regno].offset != -1 && regno < 72) { 1410896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel /* FP registers 38 -> 69 */ 1420896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel if (!(regs->cp0_status & ST0_CU1)) 1430896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel return 0; 1440896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel if (regno == 70) { 1450896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel /* Process the fcr31/fsr (register 70) */ 1460896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel memcpy((void *)¤t->thread.fpu.fcr31, mem, 1470896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel dbg_reg_def[regno].size); 1480896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel goto out_save; 1490896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel } else if (regno == 71) { 1500896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel /* Ignore the fir (register 71) */ 1510896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel goto out_save; 1520896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel } 1530896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel fp_reg = dbg_reg_def[regno].offset; 1540896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel memcpy((void *)¤t->thread.fpu.fpr[fp_reg], mem, 1550896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel dbg_reg_def[regno].size); 1560896a9becdea36b2da21709b5e73ba47ae6481eaJason Wesselout_save: 1570896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel restore_fp(current); 1580896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel } 1590896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel 1600896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel return 0; 1610896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel} 1620896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel 1630896a9becdea36b2da21709b5e73ba47ae6481eaJason Wesselchar *dbg_get_reg(int regno, void *mem, struct pt_regs *regs) 1640896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel{ 1650896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel int fp_reg; 1660896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel 1670896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel if (regno >= DBG_MAX_REG_NUM || regno < 0) 1680896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel return NULL; 1690896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel 1700896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel if (dbg_reg_def[regno].offset != -1 && regno < 38) { 1710896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel /* First 38 registers */ 1720896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel memcpy(mem, (void *)regs + dbg_reg_def[regno].offset, 1730896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel dbg_reg_def[regno].size); 1740896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel } else if (current && dbg_reg_def[regno].offset != -1 && regno < 72) { 1750896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel /* FP registers 38 -> 69 */ 1760896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel if (!(regs->cp0_status & ST0_CU1)) 1770896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel goto out; 1780896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel save_fp(current); 1790896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel if (regno == 70) { 1800896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel /* Process the fcr31/fsr (register 70) */ 1810896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel memcpy(mem, (void *)¤t->thread.fpu.fcr31, 1820896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel dbg_reg_def[regno].size); 1830896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel goto out; 1840896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel } else if (regno == 71) { 1850896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel /* Ignore the fir (register 71) */ 1860896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel memset(mem, 0, dbg_reg_def[regno].size); 1870896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel goto out; 1880896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel } 1890896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel fp_reg = dbg_reg_def[regno].offset; 1900896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel memcpy(mem, (void *)¤t->thread.fpu.fpr[fp_reg], 1910896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel dbg_reg_def[regno].size); 1920896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel } 1930896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel 1940896a9becdea36b2da21709b5e73ba47ae6481eaJason Wesselout: 1950896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel return dbg_reg_def[regno].name; 1960896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel 1970896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel} 1980896a9becdea36b2da21709b5e73ba47ae6481eaJason Wessel 1998854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wesselvoid arch_kgdb_breakpoint(void) 2008854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel{ 2018854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel __asm__ __volatile__( 2028854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel ".globl breakinst\n\t" 2038854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel ".set\tnoreorder\n\t" 2048854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel "nop\n" 2058854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel "breakinst:\tbreak\n\t" 2068854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel "nop\n\t" 2078854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel ".set\treorder"); 2088854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel} 2098854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 2108854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wesselstatic void kgdb_call_nmi_hook(void *ignored) 2118854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel{ 2126ebda44f366478d1eea180d93154e7d97b591f50Leonid Yegoshin mm_segment_t old_fs; 2136ebda44f366478d1eea180d93154e7d97b591f50Leonid Yegoshin 2146ebda44f366478d1eea180d93154e7d97b591f50Leonid Yegoshin old_fs = get_fs(); 2156ebda44f366478d1eea180d93154e7d97b591f50Leonid Yegoshin set_fs(get_ds()); 2166ebda44f366478d1eea180d93154e7d97b591f50Leonid Yegoshin 2179391d6bbedfd28c20531be75a3929c62bb43676eRalf Baechle kgdb_nmicallback(raw_smp_processor_id(), NULL); 2186ebda44f366478d1eea180d93154e7d97b591f50Leonid Yegoshin 2196ebda44f366478d1eea180d93154e7d97b591f50Leonid Yegoshin set_fs(old_fs); 2208854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel} 2218854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 2228854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wesselvoid kgdb_roundup_cpus(unsigned long flags) 2238854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel{ 2248854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel local_irq_enable(); 225e522b7ccd26a9774cac9379476ae3c6e005c88beRalf Baechle smp_call_function(kgdb_call_nmi_hook, NULL, 0); 2268854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel local_irq_disable(); 2278854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel} 2288854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 2298854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wesselstatic int compute_signal(int tt) 2308854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel{ 2318854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel struct hard_trap_info *ht; 2328854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 2338854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel for (ht = hard_trap_info; ht->tt && ht->signo; ht++) 2348854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel if (ht->tt == tt) 2358854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel return ht->signo; 2368854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 2378854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel return SIGHUP; /* default for things we don't know about */ 2388854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel} 2398854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 2408854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel/* 2418854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * Similar to regs_to_gdb_regs() except that process is sleeping and so 2428854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * we may not be able to get all the info. 2438854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel */ 2448854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wesselvoid sleeping_thread_to_gdb_regs(unsigned long *gdb_regs, struct task_struct *p) 2458854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel{ 2468854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel int reg; 2478854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel struct thread_info *ti = task_thread_info(p); 2488854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel unsigned long ksp = (unsigned long)ti + THREAD_SIZE - 32; 2498854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel struct pt_regs *regs = (struct pt_regs *)ksp - 1; 2508854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel#if (KGDB_GDB_REG_SIZE == 32) 2518854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel u32 *ptr = (u32 *)gdb_regs; 2528854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel#else 2538854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel u64 *ptr = (u64 *)gdb_regs; 2548854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel#endif 2558854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 2568854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel for (reg = 0; reg < 16; reg++) 2578854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel *(ptr++) = regs->regs[reg]; 2588854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 2598854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel /* S0 - S7 */ 2608854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel for (reg = 16; reg < 24; reg++) 2618854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel *(ptr++) = regs->regs[reg]; 2628854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 2638854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel for (reg = 24; reg < 28; reg++) 2648854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel *(ptr++) = 0; 2658854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 2668854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel /* GP, SP, FP, RA */ 2678854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel for (reg = 28; reg < 32; reg++) 2688854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel *(ptr++) = regs->regs[reg]; 2698854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 2708854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel *(ptr++) = regs->cp0_status; 2718854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel *(ptr++) = regs->lo; 2728854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel *(ptr++) = regs->hi; 2738854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel *(ptr++) = regs->cp0_badvaddr; 2748854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel *(ptr++) = regs->cp0_cause; 2758854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel *(ptr++) = regs->cp0_epc; 2768854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel} 2778854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 278dcc7871128e99458ca86186b7bc8bf27ff0c47b5Jason Wesselvoid kgdb_arch_set_pc(struct pt_regs *regs, unsigned long pc) 279dcc7871128e99458ca86186b7bc8bf27ff0c47b5Jason Wessel{ 280dcc7871128e99458ca86186b7bc8bf27ff0c47b5Jason Wessel regs->cp0_epc = pc; 281dcc7871128e99458ca86186b7bc8bf27ff0c47b5Jason Wessel} 282dcc7871128e99458ca86186b7bc8bf27ff0c47b5Jason Wessel 2838854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel/* 2848854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * Calls linux_debug_hook before the kernel dies. If KGDB is enabled, 2858854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * then try to fall into the debugger 2868854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel */ 2878854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wesselstatic int kgdb_mips_notify(struct notifier_block *self, unsigned long cmd, 2888854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel void *ptr) 2898854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel{ 2908854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel struct die_args *args = (struct die_args *)ptr; 2918854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel struct pt_regs *regs = args->regs; 2928854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel int trap = (regs->cp0_cause & 0x7c) >> 2; 2936ebda44f366478d1eea180d93154e7d97b591f50Leonid Yegoshin mm_segment_t old_fs; 2948854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 295f0a996eeeda214f4293e234df33b29bec003b536Jason Wessel#ifdef CONFIG_KPROBES 296f0a996eeeda214f4293e234df33b29bec003b536Jason Wessel /* 297f0a996eeeda214f4293e234df33b29bec003b536Jason Wessel * Return immediately if the kprobes fault notifier has set 298f0a996eeeda214f4293e234df33b29bec003b536Jason Wessel * DIE_PAGE_FAULT. 299f0a996eeeda214f4293e234df33b29bec003b536Jason Wessel */ 300f0a996eeeda214f4293e234df33b29bec003b536Jason Wessel if (cmd == DIE_PAGE_FAULT) 301f0a996eeeda214f4293e234df33b29bec003b536Jason Wessel return NOTIFY_DONE; 302f0a996eeeda214f4293e234df33b29bec003b536Jason Wessel#endif /* CONFIG_KPROBES */ 303f0a996eeeda214f4293e234df33b29bec003b536Jason Wessel 304eefc3f329d93404bfe1285d5b2f4380fede42e89Andrea Gelmini /* Userspace events, ignore. */ 3058854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel if (user_mode(regs)) 3068854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel return NOTIFY_DONE; 3078854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 3086ebda44f366478d1eea180d93154e7d97b591f50Leonid Yegoshin /* Kernel mode. Set correct address limit */ 3096ebda44f366478d1eea180d93154e7d97b591f50Leonid Yegoshin old_fs = get_fs(); 3106ebda44f366478d1eea180d93154e7d97b591f50Leonid Yegoshin set_fs(get_ds()); 3116ebda44f366478d1eea180d93154e7d97b591f50Leonid Yegoshin 3128854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel if (atomic_read(&kgdb_active) != -1) 3138854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel kgdb_nmicallback(smp_processor_id(), regs); 3148854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 3156ebda44f366478d1eea180d93154e7d97b591f50Leonid Yegoshin if (kgdb_handle_exception(trap, compute_signal(trap), cmd, regs)) { 3166ebda44f366478d1eea180d93154e7d97b591f50Leonid Yegoshin set_fs(old_fs); 3178854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel return NOTIFY_DONE; 3186ebda44f366478d1eea180d93154e7d97b591f50Leonid Yegoshin } 3198854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 3208854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel if (atomic_read(&kgdb_setting_breakpoint)) 3218854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel if ((trap == 9) && (regs->cp0_epc == (unsigned long)breakinst)) 3228854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel regs->cp0_epc += 4; 3238854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 3248854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel /* In SMP mode, __flush_cache_all does IPI */ 3258854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel local_irq_enable(); 3268854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel __flush_cache_all(); 3278854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 3286ebda44f366478d1eea180d93154e7d97b591f50Leonid Yegoshin set_fs(old_fs); 3298854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel return NOTIFY_STOP; 3308854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel} 3318854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 3325dd11d5d47d248850c58292513f0e164ba98b01eJason Wessel#ifdef CONFIG_KGDB_LOW_LEVEL_TRAP 3335dd11d5d47d248850c58292513f0e164ba98b01eJason Wesselint kgdb_ll_trap(int cmd, const char *str, 3345dd11d5d47d248850c58292513f0e164ba98b01eJason Wessel struct pt_regs *regs, long err, int trap, int sig) 3355dd11d5d47d248850c58292513f0e164ba98b01eJason Wessel{ 3365dd11d5d47d248850c58292513f0e164ba98b01eJason Wessel struct die_args args = { 3375dd11d5d47d248850c58292513f0e164ba98b01eJason Wessel .regs = regs, 3385dd11d5d47d248850c58292513f0e164ba98b01eJason Wessel .str = str, 3395dd11d5d47d248850c58292513f0e164ba98b01eJason Wessel .err = err, 3407034228792cc561e79ff8600f02884bd4c80e287Ralf Baechle .trapnr = trap, 3415dd11d5d47d248850c58292513f0e164ba98b01eJason Wessel .signr = sig, 3425dd11d5d47d248850c58292513f0e164ba98b01eJason Wessel 3435dd11d5d47d248850c58292513f0e164ba98b01eJason Wessel }; 3445dd11d5d47d248850c58292513f0e164ba98b01eJason Wessel 3455dd11d5d47d248850c58292513f0e164ba98b01eJason Wessel if (!kgdb_io_module_registered) 3465dd11d5d47d248850c58292513f0e164ba98b01eJason Wessel return NOTIFY_DONE; 3475dd11d5d47d248850c58292513f0e164ba98b01eJason Wessel 3485dd11d5d47d248850c58292513f0e164ba98b01eJason Wessel return kgdb_mips_notify(NULL, cmd, &args); 3495dd11d5d47d248850c58292513f0e164ba98b01eJason Wessel} 3505dd11d5d47d248850c58292513f0e164ba98b01eJason Wessel#endif /* CONFIG_KGDB_LOW_LEVEL_TRAP */ 3515dd11d5d47d248850c58292513f0e164ba98b01eJason Wessel 3528854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wesselstatic struct notifier_block kgdb_notifier = { 3538854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel .notifier_call = kgdb_mips_notify, 3548854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel}; 3558854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 3568854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel/* 3577aeb48b70b077375cdd2fe22f7a8b63ed6a98f25Jason Wessel * Handle the 'c' command 3588854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel */ 3598854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wesselint kgdb_arch_handle_exception(int vector, int signo, int err_code, 3608854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel char *remcom_in_buffer, char *remcom_out_buffer, 3618854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel struct pt_regs *regs) 3628854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel{ 3638854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel char *ptr; 3648854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel unsigned long address; 3658854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 3668854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel switch (remcom_in_buffer[0]) { 3678854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel case 'c': 3688854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel /* handle the optional parameter */ 3698854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel ptr = &remcom_in_buffer[1]; 3708854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel if (kgdb_hex2long(&ptr, &address)) 3718854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel regs->cp0_epc = address; 3728854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 3738854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel return 0; 3748854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel } 3758854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 3768854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel return -1; 3778854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel} 3788854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 3798854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wesselstruct kgdb_arch arch_kgdb_ops; 3808854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 3818854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel/* 3828854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * We use kgdb_early_setup so that functions we need to call now don't 3838854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * cause trouble when called again later. 3848854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel */ 3858854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wesselint kgdb_arch_init(void) 3868854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel{ 3878854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel union mips_instruction insn = { 3888854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel .r_format = { 3898854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel .opcode = spec_op, 3907034228792cc561e79ff8600f02884bd4c80e287Ralf Baechle .func = break_op, 3918854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel } 3928854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel }; 3938854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel memcpy(arch_kgdb_ops.gdb_bpt_instr, insn.byte, BREAK_INSTR_SIZE); 3948854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 3958854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel register_die_notifier(&kgdb_notifier); 3968854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 3978854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel return 0; 3988854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel} 3998854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel 4008854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel/* 4018854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * kgdb_arch_exit - Perform any architecture specific uninitalization. 4028854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * 4038854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * This function will handle the uninitalization of any architecture 4048854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel * specific callbacks, for dynamic registration and unregistration. 4058854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel */ 4068854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wesselvoid kgdb_arch_exit(void) 4078854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel{ 4088854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel unregister_die_notifier(&kgdb_notifier); 4098854700115ecf8aa6f087aa915b7b6cf18090d39Jason Wessel} 410