1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun * Copyright (C) 1994 - 1999, 2000, 01, 06 Ralf Baechle
3*4882a593Smuzhiyun * Copyright (C) 1995, 1996 Paul M. Antoine
4*4882a593Smuzhiyun * Copyright (C) 1998 Ulf Carlsson
5*4882a593Smuzhiyun * Copyright (C) 1999 Silicon Graphics, Inc.
6*4882a593Smuzhiyun * Kevin D. Kissell, kevink@mips.com and Carsten Langgaard, carstenl@mips.com
7*4882a593Smuzhiyun * Copyright (C) 2002, 2003, 2004, 2005, 2007 Maciej W. Rozycki
8*4882a593Smuzhiyun * Copyright (C) 2000, 2001, 2012 MIPS Technologies, Inc. All rights reserved.
9*4882a593Smuzhiyun * Copyright (C) 2014, Imagination Technologies Ltd.
10*4882a593Smuzhiyun *
11*4882a593Smuzhiyun * SPDX-License-Identifier: GPL-2.0+
12*4882a593Smuzhiyun */
13*4882a593Smuzhiyun
14*4882a593Smuzhiyun #include <common.h>
15*4882a593Smuzhiyun #include <asm/mipsregs.h>
16*4882a593Smuzhiyun #include <asm/addrspace.h>
17*4882a593Smuzhiyun #include <asm/system.h>
18*4882a593Smuzhiyun
19*4882a593Smuzhiyun DECLARE_GLOBAL_DATA_PTR;
20*4882a593Smuzhiyun
show_regs(const struct pt_regs * regs)21*4882a593Smuzhiyun static void show_regs(const struct pt_regs *regs)
22*4882a593Smuzhiyun {
23*4882a593Smuzhiyun const int field = 2 * sizeof(unsigned long);
24*4882a593Smuzhiyun unsigned int cause = regs->cp0_cause;
25*4882a593Smuzhiyun unsigned int exccode;
26*4882a593Smuzhiyun int i;
27*4882a593Smuzhiyun
28*4882a593Smuzhiyun /*
29*4882a593Smuzhiyun * Saved main processor registers
30*4882a593Smuzhiyun */
31*4882a593Smuzhiyun for (i = 0; i < 32; ) {
32*4882a593Smuzhiyun if ((i % 4) == 0)
33*4882a593Smuzhiyun printf("$%2d :", i);
34*4882a593Smuzhiyun if (i == 0)
35*4882a593Smuzhiyun printf(" %0*lx", field, 0UL);
36*4882a593Smuzhiyun else if (i == 26 || i == 27)
37*4882a593Smuzhiyun printf(" %*s", field, "");
38*4882a593Smuzhiyun else
39*4882a593Smuzhiyun printf(" %0*lx", field, regs->regs[i]);
40*4882a593Smuzhiyun
41*4882a593Smuzhiyun i++;
42*4882a593Smuzhiyun if ((i % 4) == 0)
43*4882a593Smuzhiyun puts("\n");
44*4882a593Smuzhiyun }
45*4882a593Smuzhiyun
46*4882a593Smuzhiyun printf("Hi : %0*lx\n", field, regs->hi);
47*4882a593Smuzhiyun printf("Lo : %0*lx\n", field, regs->lo);
48*4882a593Smuzhiyun
49*4882a593Smuzhiyun /*
50*4882a593Smuzhiyun * Saved cp0 registers
51*4882a593Smuzhiyun */
52*4882a593Smuzhiyun printf("epc : %0*lx (text %0*lx)\n", field, regs->cp0_epc,
53*4882a593Smuzhiyun field, regs->cp0_epc - gd->reloc_off);
54*4882a593Smuzhiyun printf("ra : %0*lx (text %0*lx)\n", field, regs->regs[31],
55*4882a593Smuzhiyun field, regs->regs[31] - gd->reloc_off);
56*4882a593Smuzhiyun
57*4882a593Smuzhiyun printf("Status: %08x\n", (uint32_t) regs->cp0_status);
58*4882a593Smuzhiyun
59*4882a593Smuzhiyun exccode = (cause & CAUSEF_EXCCODE) >> CAUSEB_EXCCODE;
60*4882a593Smuzhiyun printf("Cause : %08x (ExcCode %02x)\n", cause, exccode);
61*4882a593Smuzhiyun
62*4882a593Smuzhiyun if (1 <= exccode && exccode <= 5)
63*4882a593Smuzhiyun printf("BadVA : %0*lx\n", field, regs->cp0_badvaddr);
64*4882a593Smuzhiyun
65*4882a593Smuzhiyun printf("PrId : %08x\n", read_c0_prid());
66*4882a593Smuzhiyun }
67*4882a593Smuzhiyun
do_reserved(const struct pt_regs * regs)68*4882a593Smuzhiyun void do_reserved(const struct pt_regs *regs)
69*4882a593Smuzhiyun {
70*4882a593Smuzhiyun puts("\nOoops:\n");
71*4882a593Smuzhiyun show_regs(regs);
72*4882a593Smuzhiyun hang();
73*4882a593Smuzhiyun }
74*4882a593Smuzhiyun
do_ejtag_debug(const struct pt_regs * regs)75*4882a593Smuzhiyun void do_ejtag_debug(const struct pt_regs *regs)
76*4882a593Smuzhiyun {
77*4882a593Smuzhiyun const int field = 2 * sizeof(unsigned long);
78*4882a593Smuzhiyun unsigned long depc;
79*4882a593Smuzhiyun unsigned int debug;
80*4882a593Smuzhiyun
81*4882a593Smuzhiyun depc = read_c0_depc();
82*4882a593Smuzhiyun debug = read_c0_debug();
83*4882a593Smuzhiyun
84*4882a593Smuzhiyun printf("SDBBP EJTAG debug exception: c0_depc = %0*lx, DEBUG = %08x\n",
85*4882a593Smuzhiyun field, depc, debug);
86*4882a593Smuzhiyun }
87*4882a593Smuzhiyun
set_handler(unsigned long offset,void * addr,unsigned long size)88*4882a593Smuzhiyun static void set_handler(unsigned long offset, void *addr, unsigned long size)
89*4882a593Smuzhiyun {
90*4882a593Smuzhiyun unsigned long ebase = gd->irq_sp;
91*4882a593Smuzhiyun
92*4882a593Smuzhiyun memcpy((void *)(ebase + offset), addr, size);
93*4882a593Smuzhiyun flush_cache(ebase + offset, size);
94*4882a593Smuzhiyun }
95*4882a593Smuzhiyun
trap_init(ulong reloc_addr)96*4882a593Smuzhiyun void trap_init(ulong reloc_addr)
97*4882a593Smuzhiyun {
98*4882a593Smuzhiyun unsigned long ebase = gd->irq_sp;
99*4882a593Smuzhiyun
100*4882a593Smuzhiyun set_handler(0x180, &except_vec3_generic, 0x80);
101*4882a593Smuzhiyun set_handler(0x280, &except_vec_ejtag_debug, 0x80);
102*4882a593Smuzhiyun
103*4882a593Smuzhiyun write_c0_ebase(ebase);
104*4882a593Smuzhiyun clear_c0_status(ST0_BEV);
105*4882a593Smuzhiyun execution_hazard_barrier();
106*4882a593Smuzhiyun }
107