nand-ecoscentric: packages/hal/mips/arch/current/src/mips-stub.c annotate

annotate packages/hal/mips/arch/current/src/mips-stub.c @ 50:a0774359f013 ecos-sw-1999-11-02

Merge from eCos master repository on 1999-11-02-17:02:15-GMT

author	jlarmour
date	Tue, 02 Nov 1999 20:57:07 +0000
parents	4741a3c3496a
children	c38311975d4f

rev	line source
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1 /* mips-stub.c - helper functions for stub, generic to all MIPS processors
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	2 *
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	3 * Copyright (c) 1998,1999 Cygnus Solutions
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	4 *
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	5 * The authors hereby grant permission to use, copy, modify, distribute,
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	6 * and license this software and its documentation for any purpose, provided
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	7 * that existing copyright notices are retained in all copies and that this
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	8 * notice is included verbatim in any distributions. No written agreement,
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	9 * license, or royalty fee is required for any of the authorized uses.
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	10 * Modifications to this software may be copyrighted by their authors
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	11 * and need not follow the licensing terms described here, provided that
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	12 * the new terms are clearly indicated on the first page of each file where
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	13 * they apply.
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	14 */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	15
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	16 #include <stddef.h>
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	17
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	18 #include <pkgconf/hal.h>
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	19
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	20 #ifdef CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	21
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	22 #include <cyg/hal/hal_stub.h>
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	23
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	24 #define CYGARC_HAL_COMMON_EXPORT_CPU_MACROS
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	25 #include <cyg/hal/mips-regs.h>
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	26
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	27 #include <cyg/hal/hal_arch.h>
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	28 #include <cyg/hal/mips_opcode.h>
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	29
10 d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	30 typedef unsigned long t_inst;
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	31
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	32 /*----------------------------------------------------------------------
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	33 * Asynchronous interrupt support
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	34 */
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	35
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	36 static struct
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	37 {
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	38 t_inst *targetAddr;
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	39 t_inst savedInstr;
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	40 } asyncBuffer;
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	41
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	42 /* Called to asynchronously interrupt a running program.
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	43 Must be passed address of instruction interrupted.
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	44 This is typically called in response to a debug port
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	45 receive interrupt.
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	46 */
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	47
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	48 void
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	49 install_async_breakpoint(void *epc)
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	50 {
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	51 long gp_save;
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	52
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	53 /* This may be called from a separately linked program,
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	54 so we need to save and restore the incoming gp register
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	55 and setup our stub local gp register.
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	56 Alternatively, we could skip this foolishness if we
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	57 compiled libstub with "-G 0". */
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	58
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	59 __asm__ volatile ( "move %0,$28\n"
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	60 ".extern _gp\n"
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	61 "la $28,_gp\n"
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	62 : "=r" (gp_save) );
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	63
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	64 asyncBuffer.targetAddr = epc;
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	65 asyncBuffer.savedInstr = (t_inst )epc;
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	66 (t_inst )epc = (t_inst )_breakinst;
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	67 __instruction_cache(CACHE_FLUSH);
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	68 __data_cache(CACHE_FLUSH);
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	69
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	70 __asm__ volatile ( "move $28,%0\n" :: "r"(gp_save) );
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	71 }
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	72
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	73 /--------------------------------------------------------------------/
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	74 /* Given a trap value TRAP, return the corresponding signal. */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	75
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	76 int __computeSignal (unsigned int trap_number)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	77 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	78 switch (trap_number)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	79 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	80 case EXC_INT:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	81 /* External interrupt */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	82 return SIGINT;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	83
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	84 case EXC_RI:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	85 /* Reserved instruction */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	86 case EXC_CPU:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	87 /* Coprocessor unusable */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	88 return SIGILL;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	89
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	90 case EXC_BP:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	91 /* Break point */
10 d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	92 if (asyncBuffer.targetAddr != NULL)
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	93 {
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	94 /* BP installed by serial driver to stop running program */
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	95 *asyncBuffer.targetAddr = asyncBuffer.savedInstr;
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	96 __instruction_cache(CACHE_FLUSH);
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	97 __data_cache(CACHE_FLUSH);
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	98 asyncBuffer.targetAddr = NULL;
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	99 return SIGINT;
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST jlarmour parents: 8 diff changeset	100 }
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	101 return SIGTRAP;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	102
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	103 case EXC_OVF:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	104 /* Arithmetic overflow */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	105 case EXC_TRAP:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	106 /* Trap exception */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	107 case EXC_FPE:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	108 /* Floating Point Exception */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	109 return SIGFPE;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	110
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	111 case EXC_IBE:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	112 /* Bus error (Ifetch) */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	113 case EXC_DBE:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	114 /* Bus error (data load or store) */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	115 return SIGBUS;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	116
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	117 case EXC_MOD:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	118 /* TLB modification exception */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	119 case EXC_TLBL:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	120 /* TLB miss (Load or Ifetch) */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	121 case EXC_TLBS:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	122 /* TLB miss (Store) */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	123 case EXC_ADEL:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	124 /* Address error (Load or Ifetch) */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	125 case EXC_ADES:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	126 /* Address error (Store) */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	127 return SIGSEGV;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	128
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	129 case EXC_SYS:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	130 /* System call */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	131 return SIGSYS;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	132
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	133 default:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	134 return SIGTERM;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	135 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	136 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	137
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	138 /* Return the trap number corresponding to the last-taken trap. */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	139
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	140 int __get_trap_number (void)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	141 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	142 return (get_register (CAUSE) & CAUSE_EXCMASK) >> CAUSE_EXCSHIFT;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	143 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	144
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	145 /* Set the currently-saved pc register value to PC. This also updates NPC
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	146 as needed. */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	147
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	148 void set_pc (target_register_t pc)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	149 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	150 put_register (PC, pc);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	151 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	152
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	153
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	154 /*----------------------------------------------------------------------
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	155 * Single-step support
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	156 */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	157
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	158 /* Saved instruction data for single step support. */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	159
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	160 static struct
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	161 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	162 t_inst *targetAddr;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	163 t_inst savedInstr;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	164 } instrBuffer;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	165
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	166
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	167 /* Set things up so that the next user resume will execute one instruction.
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	168 This may be done by setting breakpoints or setting a single step flag
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	169 in the saved user registers, for example. */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	170
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	171 void __single_step (void)
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	172 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	173 InstFmt inst;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	174 t_inst pc = (t_inst ) get_register (PC);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	175
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	176 instrBuffer.targetAddr = pc + 1; /* set default */
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	177
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	178 inst.word = pc; / read the next instruction */
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	179
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	180 //diag_printf("pc %08x %08x\n",pc,inst.word);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	181
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	182 switch (inst.RType.op) { /* override default if branch */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	183 case OP_SPECIAL:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	184 switch (inst.RType.func) {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	185 case OP_JR:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	186 case OP_JALR:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	187 instrBuffer.targetAddr = (t_inst *) get_register (inst.RType.rs);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	188 break;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	189 };
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	190 break;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	191
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	192 case OP_REGIMM:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	193 switch (inst.IType.rt) {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	194 case OP_BLTZ:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	195 case OP_BLTZL:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	196 case OP_BLTZAL:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	197 case OP_BLTZALL:
26 4741a3c3496a Merge from eCos master repository on 1999-07-23-05:47:06-BST jlarmour parents: 10 diff changeset	198 if ((int)get_register (inst.IType.rs) < 0 )
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	199 instrBuffer.targetAddr =
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	200 (t_inst *)(((signed short)inst.IType.imm<<2)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	201 + (get_register (PC) + 4));
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	202 else
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	203 instrBuffer.targetAddr = (t_inst *)(get_register (PC) + 8);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	204 break;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	205 case OP_BGEZ:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	206 case OP_BGEZL:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	207 case OP_BGEZAL:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	208 case OP_BGEZALL:
26 4741a3c3496a Merge from eCos master repository on 1999-07-23-05:47:06-BST jlarmour parents: 10 diff changeset	209 if ((int)get_register (inst.IType.rs) >= 0 )
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	210 instrBuffer.targetAddr =
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	211 (t_inst *)(((signed short)inst.IType.imm<<2)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	212 + (get_register (PC) + 4));
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	213 else
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	214 instrBuffer.targetAddr = (t_inst *)(get_register (PC) + 8);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	215 break;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	216 };
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	217 break;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	218
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	219 case OP_J:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	220 case OP_JAL:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	221 instrBuffer.targetAddr =
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	222 (t_inst *)((inst.JType.target<<2)
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	223 + ((get_register (PC) + 4)&0xf0000000));
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	224 break;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	225
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	226 case OP_BEQ:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	227 case OP_BEQL:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	228 if (get_register (inst.IType.rs) == get_register (inst.IType.rt))
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	229 instrBuffer.targetAddr =
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	230 (t_inst *)(((signed short)inst.IType.imm<<2)
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	231 + (get_register (PC) + 4));
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	232 else
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	233 instrBuffer.targetAddr = (t_inst *)(get_register (PC) + 8);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	234 break;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	235 case OP_BNE:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	236 case OP_BNEL:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	237 if (get_register (inst.IType.rs) != get_register (inst.IType.rt))
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	238 instrBuffer.targetAddr =
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	239 (t_inst *)(((signed short)inst.IType.imm<<2)
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	240 + (get_register (PC) + 4));
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	241 else
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	242 instrBuffer.targetAddr = (t_inst *)(get_register (PC) + 8);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	243 break;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	244 case OP_BLEZ:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	245 case OP_BLEZL:
26 4741a3c3496a Merge from eCos master repository on 1999-07-23-05:47:06-BST jlarmour parents: 10 diff changeset	246 if ((int)get_register (inst.IType.rs) <= 0)
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	247 instrBuffer.targetAddr =
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	248 (t_inst *)(((signed short)inst.IType.imm<<2) + (get_register (PC) + 4));
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	249 else
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	250 instrBuffer.targetAddr = (t_inst *)(get_register (PC) + 8);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	251 break;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	252 case OP_BGTZ:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	253 case OP_BGTZL:
26 4741a3c3496a Merge from eCos master repository on 1999-07-23-05:47:06-BST jlarmour parents: 10 diff changeset	254 if ((int)get_register (inst.IType.rs) > 0)
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	255 instrBuffer.targetAddr =
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	256 (t_inst *)(((signed short)inst.IType.imm<<2) + (get_register (PC) + 4));
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	257 else
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	258 instrBuffer.targetAddr = (t_inst *)(get_register (PC) + 8);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	259 break;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	260
26 4741a3c3496a Merge from eCos master repository on 1999-07-23-05:47:06-BST jlarmour parents: 10 diff changeset	261 #ifdef CYGHWR_HAL_MIPS_FPU
4741a3c3496a Merge from eCos master repository on 1999-07-23-05:47:06-BST jlarmour parents: 10 diff changeset	262
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	263 case OP_COP1:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	264 if (inst.RType.rs == OP_BC)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	265 switch (inst.RType.rt) {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	266 case COPz_BCF:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	267 case COPz_BCFL:
26 4741a3c3496a Merge from eCos master repository on 1999-07-23-05:47:06-BST jlarmour parents: 10 diff changeset	268 if (get_register (FCR31) & FCR31_C)
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	269 instrBuffer.targetAddr = (t_inst *)(get_register (PC) + 8);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	270 else
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	271 instrBuffer.targetAddr =
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	272 (t_inst *)(((signed short)inst.IType.imm<<2)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	273 + (get_register (PC) + 4));
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	274 break;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	275 case COPz_BCT:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	276 case COPz_BCTL:
26 4741a3c3496a Merge from eCos master repository on 1999-07-23-05:47:06-BST jlarmour parents: 10 diff changeset	277 if (get_register (FCR31) & FCR31_C)
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	278 instrBuffer.targetAddr =
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	279 (t_inst *)(((signed short)inst.IType.imm<<2)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	280 + (get_register (PC) + 4));
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	281 else
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	282 instrBuffer.targetAddr = (t_inst *)(get_register (PC) + 8);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	283 break;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	284 };
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	285 break;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	286 #endif
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	287
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	288 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	289 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	290
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	291
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	292 /* Clear the single-step state. */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	293
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	294 void __clear_single_step (void)
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	295 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	296 //diag_printf("clear_ss ta %08x\n",instrBuffer.targetAddr);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	297 if (instrBuffer.targetAddr != NULL)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	298 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	299 *instrBuffer.targetAddr = instrBuffer.savedInstr;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	300 instrBuffer.targetAddr = NULL;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	301 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	302 instrBuffer.savedInstr = NOP_INSTR;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	303 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	304
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	305
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	306 void __install_breakpoints ()
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	307 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	308 //diag_printf("install_bpt ta %08x\n",instrBuffer.targetAddr);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	309 if (instrBuffer.targetAddr != NULL)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	310 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	311 instrBuffer.savedInstr = *instrBuffer.targetAddr;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	312 *instrBuffer.targetAddr = __break_opcode ();
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	313 //diag_printf("ta %08x si %08x *ta %08x\n",
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	314 // instrBuffer.targetAddr,instrBuffer.savedInstr,*instrBuffer.targetAddr);
8 ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST jlarmour parents: 2 diff changeset	315
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST jlarmour parents: 2 diff changeset	316 /* Ensure that the planted breakpoint makes it out to memory and
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST jlarmour parents: 2 diff changeset	317 is subsequently loaded into the instruction cache.
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST jlarmour parents: 2 diff changeset	318 */
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST jlarmour parents: 2 diff changeset	319 __data_cache (CACHE_FLUSH) ;
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST jlarmour parents: 2 diff changeset	320 __instruction_cache (CACHE_FLUSH) ;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	321 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	322 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	323
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	324 void __clear_breakpoints (void)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	325 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	326 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	327
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	328
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	329 /* If the breakpoint we hit is in the breakpoint() instruction, return a
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	330 non-zero value. */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	331
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	332 int
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	333 __is_breakpoint_function ()
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	334 {
50 a0774359f013 Merge from eCos master repository on 1999-11-02-17:02:15-GMT jlarmour parents: 26 diff changeset	335 return get_register (PC) == (target_register_t)(unsigned long)&CYG_LABEL_NAME(breakinst);
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	336 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	337
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	338
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	339 /* Skip the current instruction. Since this is only called by the
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	340 stub when the PC points to a breakpoint or trap instruction,
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	341 we can safely just skip 4. */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	342
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	343 void __skipinst (void)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	344 {
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	345 put_register (PC, get_register (PC) + 4);
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	346 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	347
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	348 #endif // CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS

Mercurial > nand-ecoscentric

annotate packages/hal/mips/arch/current/src/mips-stub.c @ 50:a0774359f013 ecos-sw-1999-11-02