ecos: packages/hal/arm/arch/current/src/arm

annotate packages/hal/arm/arch/current/src/arm_stub.c @ 115:6ed91473a1cd ecos-sw-2000-08-21

Merge from eCos master repository on 2000-08-21-22:40:54-BST

author	jlarmour
date	Fri, 25 Aug 2000 17:32:38 +0000
parents	84e4bde58b26
children	0ae0bc38e387

rev	line source
64 c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	1 //========================================================================
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	2 //
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	3 // arm_stub.c
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	4 //
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	5 // Helper functions for stub, generic to all ARM processors
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	6 //
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	7 //========================================================================
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	8 //####COPYRIGHTBEGIN####
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	9 //
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	10 // -------------------------------------------
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	11 // The contents of this file are subject to the Red Hat eCos Public License
66 bf00f99aec69 Merge from eCos master repository on 2000-02-02-19:16:44-GMT jlarmour parents: 64 diff changeset	12 // Version 1.1 (the "License"); you may not use this file except in
64 c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	13 // compliance with the License. You may obtain a copy of the License at
66 bf00f99aec69 Merge from eCos master repository on 2000-02-02-19:16:44-GMT jlarmour parents: 64 diff changeset	14 // http://www.redhat.com/
64 c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	15 //
66 bf00f99aec69 Merge from eCos master repository on 2000-02-02-19:16:44-GMT jlarmour parents: 64 diff changeset	16 // Software distributed under the License is distributed on an "AS IS"
64 c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	17 // basis, WITHOUT WARRANTY OF ANY KIND, either express or implied. See the
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	18 // License for the specific language governing rights and limitations under
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	19 // the License.
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	20 //
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	21 // The Original Code is eCos - Embedded Configurable Operating System,
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	22 // released September 30, 1998.
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	23 //
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	24 // The Initial Developer of the Original Code is Red Hat.
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	25 // Portions created by Red Hat are
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	26 // Copyright (C) 1998, 1999, 2000 Red Hat, Inc.
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	27 // All Rights Reserved.
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	28 // -------------------------------------------
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	29 //
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	30 //####COPYRIGHTEND####
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	31 //========================================================================
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	32 //#####DESCRIPTIONBEGIN####
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	33 //
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	34 // Author(s): Red Hat, gthomas
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	35 // Contributors: Red Hat, gthomas, jskov
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	36 // Date: 1998-11-26
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	37 // Purpose:
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	38 // Description: Helper functions for stub, generic to all ARM processors
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	39 // Usage:
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	40 //
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	41 //####DESCRIPTIONEND####
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	42 //
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 54 diff changeset	43 //========================================================================
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	44
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	45 #include <stddef.h>
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	46
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	47 #include <pkgconf/hal.h>
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	48
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	49 #ifdef CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	50
72 da3908c9cd10 Merge from eCos master repository on 2000-02-17-18:56:14-GMT jlarmour parents: 66 diff changeset	51 #ifdef CYGPKG_HAL_ARM_SIM
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	52 #error "GDB Stub support not implemented for ARM SIM"
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	53 #endif
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	54
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	55 #include <cyg/hal/hal_stub.h>
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	56 #include <cyg/hal/hal_arch.h>
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	57 #include <cyg/hal/hal_intr.h>
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	58
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	59 #ifndef FALSE
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	60 #define FALSE 0
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	61 #define TRUE 1
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	62 #endif
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	63
76 435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	64 // Use bit 0 as a thumb-mode flag for next address to be executed.
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	65 // Alternative would be to keep track of it using a C variable, but
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	66 // since bit 0 is used by the BX instruction, we might as well do the
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	67 // same thing and thus avoid checking two different flags.
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	68 #define IS_THUMB_ADDR(addr) ((addr) & 1)
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	69 #define MAKE_THUMB_ADDR(addr) ((addr) \| 1)
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	70 #define UNMAKE_THUMB_ADDR(addr) ((addr) & ~1)
36 e97d78785e2d Merge from eCos master repository on 1999-09-12-15:40:34-BST jlarmour parents: 34 diff changeset	71
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	72 #ifdef CYGDBG_HAL_DEBUG_GDB_THREAD_SUPPORT
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	73 #include <cyg/hal/dbg-threads-api.h> // dbg_currthread_id
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	74 #endif
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	75
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	76 /* Given a trap value TRAP, return the corresponding signal. */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	77
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	78 int __computeSignal (unsigned int trap_number)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	79 {
36 e97d78785e2d Merge from eCos master repository on 1999-09-12-15:40:34-BST jlarmour parents: 34 diff changeset	80 // should also catch CYGNUM_HAL_VECTOR_UNDEF_INSTRUCTION here but we
e97d78785e2d Merge from eCos master repository on 1999-09-12-15:40:34-BST jlarmour parents: 34 diff changeset	81 // can't tell the different between a real one and a breakpoint :-(
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	82 switch (trap_number) {
36 e97d78785e2d Merge from eCos master repository on 1999-09-12-15:40:34-BST jlarmour parents: 34 diff changeset	83 case CYGNUM_HAL_VECTOR_ABORT_PREFETCH: // Fall through
e97d78785e2d Merge from eCos master repository on 1999-09-12-15:40:34-BST jlarmour parents: 34 diff changeset	84 case CYGNUM_HAL_VECTOR_ABORT_DATA: // Fall through
e97d78785e2d Merge from eCos master repository on 1999-09-12-15:40:34-BST jlarmour parents: 34 diff changeset	85 case CYGNUM_HAL_VECTOR_reserved:
e97d78785e2d Merge from eCos master repository on 1999-09-12-15:40:34-BST jlarmour parents: 34 diff changeset	86 return SIGBUS;
e97d78785e2d Merge from eCos master repository on 1999-09-12-15:40:34-BST jlarmour parents: 34 diff changeset	87 case CYGNUM_HAL_VECTOR_IRQ:
e97d78785e2d Merge from eCos master repository on 1999-09-12-15:40:34-BST jlarmour parents: 34 diff changeset	88 case CYGNUM_HAL_VECTOR_FIQ:
e97d78785e2d Merge from eCos master repository on 1999-09-12-15:40:34-BST jlarmour parents: 34 diff changeset	89 return SIGINT;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	90 default:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	91 return SIGTRAP;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	92 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	93 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	94
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	95
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	96 /* Return the trap number corresponding to the last-taken trap. */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	97 int __get_trap_number (void)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	98 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	99 // The vector is not not part of the GDB register set so get it
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	100 // directly from the save context.
36 e97d78785e2d Merge from eCos master repository on 1999-09-12-15:40:34-BST jlarmour parents: 34 diff changeset	101 return _hal_registers->vector;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	102 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	103
76 435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	104 /* Set the currently-saved pc register value to PC. */
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	105
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	106 void set_pc (target_register_t pc)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	107 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	108 put_register (PC, pc);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	109 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	110
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	111
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	112 /*----------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	113 * Single-step support
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	114 */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	115
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	116 /* Set things up so that the next user resume will execute one instruction.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	117 This may be done by setting breakpoints or setting a single step flag
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	118 in the saved user registers, for example. */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	119
54 f10165814f1e Merge from eCos master repository on 1999-11-19-22:24:39-GMT jlarmour parents: 50 diff changeset	120 static unsigned long ss_saved_pc = 0;
f10165814f1e Merge from eCos master repository on 1999-11-19-22:24:39-GMT jlarmour parents: 50 diff changeset	121 static unsigned long ss_saved_instr;
76 435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	122 static unsigned short ss_saved_thumb_instr;
36 e97d78785e2d Merge from eCos master repository on 1999-09-12-15:40:34-BST jlarmour parents: 34 diff changeset	123
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	124 #define FIXME() {diag_printf("FIXME - %s\n", __FUNCTION__); }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	125
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	126 static int
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	127 ins_will_execute(unsigned long ins)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	128 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	129 unsigned long psr = get_register(PS); // condition codes
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	130 int res = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	131 switch ((ins & 0xF0000000) >> 28) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	132 case 0x0: // EQ
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	133 res = (psr & PS_Z) != 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	134 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	135 case 0x1: // NE
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	136 res = (psr & PS_Z) == 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	137 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	138 case 0x2: // CS
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	139 res = (psr & PS_C) != 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	140 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	141 case 0x3: // CC
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	142 res = (psr & PS_C) == 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	143 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	144 case 0x4: // MI
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	145 res = (psr & PS_N) != 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	146 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	147 case 0x5: // PL
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	148 res = (psr & PS_N) == 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	149 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	150 case 0x6: // VS
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	151 res = (psr & PS_V) != 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	152 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	153 case 0x7: // VC
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	154 res = (psr & PS_V) == 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	155 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	156 case 0x8: // HI
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 2 diff changeset	157 res = ((psr & PS_C) != 0) && ((psr & PS_Z) == 0);
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	158 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	159 case 0x9: // LS
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 2 diff changeset	160 res = ((psr & PS_C) == 0) \|\| ((psr & PS_Z) != 0);
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	161 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	162 case 0xA: // GE
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	163 res = ((psr & (PS_N\|PS_V)) == (PS_N\|PS_V)) \|\|
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	164 ((psr & (PS_N\|PS_V)) == 0);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	165 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	166 case 0xB: // LT
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	167 res = ((psr & (PS_N\|PS_V)) == PS_N) \|\|
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	168 ((psr & (PS_N\|PS_V)) == PS_V);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	169 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	170 case 0xC: // GT
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	171 res = ((psr & (PS_N\|PS_V)) == (PS_N\|PS_V)) \|\|
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	172 ((psr & (PS_N\|PS_V)) == 0);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	173 res = ((psr & PS_Z) == 0) && res;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	174 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	175 case 0xD: // LE
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	176 res = ((psr & (PS_N\|PS_V)) == PS_N) \|\|
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	177 ((psr & (PS_N\|PS_V)) == PS_V);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	178 res = ((psr & PS_Z) == PS_Z) \|\| res;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	179 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	180 case 0xE: // AL
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	181 res = TRUE;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	182 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	183 case 0xF: // NV
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	184 res = FALSE;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	185 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	186 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	187 return res;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	188 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	189
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	190 static unsigned long
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	191 RmShifted(int shift)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	192 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	193 unsigned long Rm = get_register(shift & 0x00F);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	194 int shift_count;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	195 if ((shift & 0x010) == 0) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	196 shift_count = (shift & 0xF80) >> 7;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	197 } else {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	198 shift_count = get_register((shift & 0xF00) >> 8);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	199 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	200 switch ((shift & 0x060) >> 5) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	201 case 0x0: // Logical left
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	202 Rm <<= shift_count;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	203 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	204 case 0x1: // Logical right
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	205 Rm >>= shift_count;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	206 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	207 case 0x2: // Arithmetic right
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	208 Rm = (unsigned long)((long)Rm >> shift_count);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	209 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	210 case 0x3: // Rotate right
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	211 if (shift_count == 0) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	212 // Special case, RORx
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	213 Rm >>= 1;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	214 if (get_register(PS) & PS_C) Rm \|= 0x80000000;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	215 } else {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	216 Rm = (Rm >> shift_count) \| (Rm << (32-shift_count));
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	217 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	218 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	219 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	220 return Rm;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	221 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	222
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	223 // Decide the next instruction to be executed for a given instruction
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	224 static unsigned long *
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	225 target_ins(unsigned long *pc, unsigned long ins)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	226 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	227 unsigned long new_pc, offset, op2;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	228 unsigned long Rn;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	229 int i, reg_count, c;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	230 switch ((ins & 0x0C000000) >> 26) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	231 case 0x0:
76 435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	232 // BX
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	233 if ((ins & 0x0FFFFFF0) == 0x012FFF10) {
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	234 new_pc = (unsigned long)get_register(ins & 0x0000000F);
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	235 return ((unsigned long *)new_pc);
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	236 }
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	237 // Data processing
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	238 new_pc = (unsigned long)(pc+1);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	239 if ((ins & 0x0000F000) == 0x0000F000) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	240 // Destination register is PC
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	241 if ((ins & 0x0FBF0000) != 0x010F0000) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	242 Rn = (unsigned long)get_register((ins & 0x000F0000) >> 16);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	243 if ((ins & 0x02000000) == 0) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	244 op2 = RmShifted(ins & 0x00000FFF);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	245 } else {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	246 op2 = ins & 0x000000FF;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	247 i = (ins & 0x00000F00) >> 8; // Rotate count
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	248 op2 = (op2 >> (i2)) \| (op2 << (32-(i2)));
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	249 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	250 switch ((ins & 0x01E00000) >> 21) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	251 case 0x0: // AND
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	252 new_pc = Rn & op2;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	253 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	254 case 0x1: // EOR
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	255 new_pc = Rn ^ op2;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	256 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	257 case 0x2: // SUB
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	258 new_pc = Rn - op2;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	259 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	260 case 0x3: // RSB
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	261 new_pc = op2 - Rn;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	262 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	263 case 0x4: // ADD
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	264 new_pc = Rn + op2;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	265 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	266 case 0x5: // ADC
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	267 c = (get_register(PS) & PS_C) != 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	268 new_pc = Rn + op2 + c;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	269 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	270 case 0x6: // SBC
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	271 c = (get_register(PS) & PS_C) != 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	272 new_pc = Rn - op2 + c - 1;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	273 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	274 case 0x7: // RSC
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	275 c = (get_register(PS) & PS_C) != 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	276 new_pc = op2 - Rn +c - 1;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	277 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	278 case 0x8: // TST
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	279 case 0x9: // TEQ
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	280 case 0xA: // CMP
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	281 case 0xB: // CMN
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	282 break; // PC doesn't change
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	283 case 0xC: // ORR
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	284 new_pc = Rn \| op2;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	285 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	286 case 0xD: // MOV
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	287 new_pc = op2;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	288 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	289 case 0xE: // BIC
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	290 new_pc = Rn & ~op2;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	291 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	292 case 0xF: // MVN
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	293 new_pc = ~op2;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	294 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	295 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	296 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	297 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	298 return ((unsigned long *)new_pc);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	299 case 0x1:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	300 if ((ins & 0x02000010) == 0x02000010) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	301 // Undefined!
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	302 return (pc+1);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	303 } else {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	304 if ((ins & 0x00100000) == 0) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	305 // STR
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	306 return (pc+1);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	307 } else {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	308 // LDR
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	309 if ((ins & 0x0000F000) != 0x0000F000) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	310 // Rd not PC
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	311 return (pc+1);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	312 } else {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	313 Rn = (unsigned long)get_register((ins & 0x000F0000) >> 16);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	314 if ((ins & 0x000F0000) == 0x000F0000) Rn += 8; // PC prefetch!
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	315 if (ins & 0x01000000) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	316 // Add/subtract offset before
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	317 if ((ins & 0x02000000) == 0) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	318 // Immediate offset
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	319 if (ins & 0x00800000) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	320 // Add offset
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	321 Rn += (ins & 0x00000FFF);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	322 } else {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	323 // Subtract offset
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	324 Rn -= (ins & 0x00000FFF);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	325 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	326 } else {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	327 // Offset is in a register
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	328 if (ins & 0x00800000) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	329 // Add offset
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	330 Rn += RmShifted(ins & 0x00000FFF);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	331 } else {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	332 // Subtract offset
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	333 Rn -= RmShifted(ins & 0x00000FFF);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	334 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	335 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	336 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	337 return ((unsigned long )(unsigned long *)Rn);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	338 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	339 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	340 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	341 return (pc+1);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	342 case 0x2: // Branch, LDM/STM
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	343 if ((ins & 0x02000000) == 0) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	344 // LDM/STM
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	345 if ((ins & 0x00100000) == 0) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	346 // STM
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	347 return (pc+1);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	348 } else {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	349 // LDM
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	350 if ((ins & 0x00008000) == 0) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	351 // PC not in list
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	352 return (pc+1);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	353 } else {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	354 Rn = (unsigned long)get_register((ins & 0x000F0000) >> 16);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	355 if ((ins & 0x000F0000) == 0x000F0000) Rn += 8; // PC prefetch!
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	356 offset = ins & 0x0000FFFF;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	357 reg_count = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	358 for (i = 0; i < 15; i++) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	359 if (offset & (1<<i)) reg_count++;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	360 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	361 if (ins & 0x00800000) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	362 // Add offset
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	363 Rn += reg_count*4;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	364 } else {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	365 // Subtract offset
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	366 Rn -= 4;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	367 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	368 return ((unsigned long )(unsigned long *)Rn);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	369 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	370 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	371 } else {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	372 // Branch
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 2 diff changeset	373 if (ins_will_execute(ins)) {
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 2 diff changeset	374 offset = (ins & 0x00FFFFFF) << 2;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 2 diff changeset	375 if (ins & 0x00800000) offset \|= 0xFC000000; // sign extend
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 2 diff changeset	376 new_pc = (unsigned long)(pc+2) + offset;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 2 diff changeset	377 return ((unsigned long *)new_pc);
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 2 diff changeset	378 } else {
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 2 diff changeset	379 // Falls through
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 2 diff changeset	380 return (pc+1);
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 2 diff changeset	381 }
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	382 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	383 case 0x3: // Coprocessor & SWI
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	384 return (pc+1);
78 59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 76 diff changeset	385 default:
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 76 diff changeset	386 // Never reached - but fixes compiler warning.
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 76 diff changeset	387 return 0;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	388 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	389 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	390
76 435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	391 // FIXME: target_ins also needs to check for CPSR/THUMB being set and
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	392 // set the thumb bit accordingly.
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	393
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	394 static unsigned long
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	395 target_thumb_ins(unsigned long pc, unsigned short ins)
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	396 {
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	397 unsigned long new_pc = MAKE_THUMB_ADDR(pc+2); // default is fall-through
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	398 // to next thumb instruction
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	399 unsigned long offset, arm_ins;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	400
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	401 switch ((ins & 0xf000) >> 12) {
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	402 case 0x4:
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	403 // Check for BX
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	404 if ((ins & 0xff87) == 0x4700)
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	405 new_pc = (unsigned long)get_register((ins & 0x00078) >> 3);
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	406 break;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	407 case 0xd:
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	408 // Bcc
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	409 // Use ARM function to check condition
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	410 arm_ins = ((unsigned long)(ins & 0x0f00)) << 20;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	411 if (ins_will_execute(arm_ins)) {
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	412 offset = (ins & 0x00FF) << 1;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	413 if (ins & 0x0080) offset \|= 0xFFFFFE00; // sign extend
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	414 new_pc = MAKE_THUMB_ADDR((unsigned long)(pc+4) + offset);
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	415 }
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	416 break;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	417 case 0xe:
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	418 // check for B
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	419 if ((ins & 0x0800) == 0) {
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	420 offset = (ins & 0x07FF) << 1;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	421 if (ins & 0x0400) offset \|= 0xFFFFF800; // sign extend
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	422 new_pc = MAKE_THUMB_ADDR((unsigned long)(pc+4) + offset);
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	423 }
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	424 break;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	425 case 0xf:
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	426 // BL (4byte instruction!)
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	427 // First instruction (bit 11 == 0) holds top-part of offset
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	428 offset = (ins & 0x07FF) << 12;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	429 if (ins & 0x0400) offset \|= 0xFF800000; // sign extend
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	430 // Get second instruction
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	431 // Second instruction (bit 11 == 1) holds bottom-part of offset
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	432 ins = (unsigned short)(pc+2);
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	433 offset \|= (ins & 0x07ff) << 1;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	434 new_pc = MAKE_THUMB_ADDR((unsigned long)(pc+4) + offset);
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	435 break;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	436 }
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	437
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	438 return new_pc;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	439 }
54 f10165814f1e Merge from eCos master repository on 1999-11-19-22:24:39-GMT jlarmour parents: 50 diff changeset	440
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	441 void __single_step (void)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	442 {
54 f10165814f1e Merge from eCos master repository on 1999-11-19-22:24:39-GMT jlarmour parents: 50 diff changeset	443 unsigned long pc = get_register(PC);
76 435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	444 unsigned long cpsr = get_register(PS);
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	445
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	446 // Calculate address of next instruction to be executed
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	447 if (cpsr & CPSR_THUMB_ENABLE) {
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	448 // thumb
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	449 ss_saved_pc = target_thumb_ins(pc, (unsigned short)pc);
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	450 } else {
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	451 // ARM
54 f10165814f1e Merge from eCos master repository on 1999-11-19-22:24:39-GMT jlarmour parents: 50 diff changeset	452 unsigned long curins = (unsigned long)pc;
f10165814f1e Merge from eCos master repository on 1999-11-19-22:24:39-GMT jlarmour parents: 50 diff changeset	453 if (ins_will_execute(curins)) {
f10165814f1e Merge from eCos master repository on 1999-11-19-22:24:39-GMT jlarmour parents: 50 diff changeset	454 // Decode instruction to decide what the next PC will be
f10165814f1e Merge from eCos master repository on 1999-11-19-22:24:39-GMT jlarmour parents: 50 diff changeset	455 ss_saved_pc = (unsigned long) target_ins((unsigned long*)pc,
f10165814f1e Merge from eCos master repository on 1999-11-19-22:24:39-GMT jlarmour parents: 50 diff changeset	456 curins);
f10165814f1e Merge from eCos master repository on 1999-11-19-22:24:39-GMT jlarmour parents: 50 diff changeset	457 } else {
f10165814f1e Merge from eCos master repository on 1999-11-19-22:24:39-GMT jlarmour parents: 50 diff changeset	458 // The current instruction will not execute (the conditions
f10165814f1e Merge from eCos master repository on 1999-11-19-22:24:39-GMT jlarmour parents: 50 diff changeset	459 // don't hold)
f10165814f1e Merge from eCos master repository on 1999-11-19-22:24:39-GMT jlarmour parents: 50 diff changeset	460 ss_saved_pc = pc+4;
f10165814f1e Merge from eCos master repository on 1999-11-19-22:24:39-GMT jlarmour parents: 50 diff changeset	461 }
76 435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	462 }
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	463
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	464 // Set breakpoint according to type
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	465 if (IS_THUMB_ADDR(ss_saved_pc)) {
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	466 // Thumb instruction
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	467 unsigned long t_pc = UNMAKE_THUMB_ADDR(ss_saved_pc);
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	468 ss_saved_thumb_instr = (unsigned short)t_pc;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	469 (unsigned short)t_pc = HAL_BREAKINST_THUMB;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	470 } else {
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	471 // ARM instruction
54 f10165814f1e Merge from eCos master repository on 1999-11-19-22:24:39-GMT jlarmour parents: 50 diff changeset	472 ss_saved_instr = (unsigned long)ss_saved_pc;
f10165814f1e Merge from eCos master repository on 1999-11-19-22:24:39-GMT jlarmour parents: 50 diff changeset	473 (unsigned long)ss_saved_pc = HAL_BREAKINST_ARM;
76 435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	474 }
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	475 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	476
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	477 /* Clear the single-step state. */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	478
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	479 void __clear_single_step (void)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	480 {
54 f10165814f1e Merge from eCos master repository on 1999-11-19-22:24:39-GMT jlarmour parents: 50 diff changeset	481 if (ss_saved_pc != 0) {
76 435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	482 // Restore instruction according to type
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	483 if (IS_THUMB_ADDR(ss_saved_pc)) {
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	484 // Thumb instruction
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	485 unsigned long t_pc = UNMAKE_THUMB_ADDR(ss_saved_pc);
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	486 (unsigned short)t_pc = ss_saved_thumb_instr;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	487 } else {
54 f10165814f1e Merge from eCos master repository on 1999-11-19-22:24:39-GMT jlarmour parents: 50 diff changeset	488 // ARM instruction
f10165814f1e Merge from eCos master repository on 1999-11-19-22:24:39-GMT jlarmour parents: 50 diff changeset	489 (unsigned long)ss_saved_pc = ss_saved_instr;
76 435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	490 }
54 f10165814f1e Merge from eCos master repository on 1999-11-19-22:24:39-GMT jlarmour parents: 50 diff changeset	491 ss_saved_pc = 0;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	492 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	493 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	494
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	495 void __install_breakpoints (void)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	496 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	497 // FIXME();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	498 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	499
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	500 void __clear_breakpoints (void)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	501 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	502 // FIXME();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	503 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	504
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	505 /* If the breakpoint we hit is in the breakpoint() instruction, return a
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	506 non-zero value. */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	507
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	508 int
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	509 __is_breakpoint_function ()
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	510 {
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: 110 diff changeset	511 return get_register (PC) == (target_register_t)&_breakinst;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	512 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	513
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	514
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	515 /* Skip the current instruction. Since this is only called by the
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	516 stub when the PC points to a breakpoint or trap instruction,
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	517 we can safely just skip 4. */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	518
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	519 void __skipinst (void)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	520 {
54 f10165814f1e Merge from eCos master repository on 1999-11-19-22:24:39-GMT jlarmour parents: 50 diff changeset	521 unsigned long pc = get_register(PC);
76 435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	522 unsigned long cpsr = get_register(PS);
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	523
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	524 if (cpsr & CPSR_THUMB_ENABLE)
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	525 pc += 2;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	526 else
54 f10165814f1e Merge from eCos master repository on 1999-11-19-22:24:39-GMT jlarmour parents: 50 diff changeset	527 pc += 4;
f10165814f1e Merge from eCos master repository on 1999-11-19-22:24:39-GMT jlarmour parents: 50 diff changeset	528
f10165814f1e Merge from eCos master repository on 1999-11-19-22:24:39-GMT jlarmour parents: 50 diff changeset	529 put_register(PC, pc);
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	530 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	531
76 435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	532 //-----------------------------------------------------------------------
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	533 // Thumb-aware GDB interrupt handler.
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	534 // This is a brute-force replacement of the ones in hal_stub.c. Need to
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	535 // find a better way of handling it... Maybe... Probably only ARM/thumb
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	536 // that is this weird.
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	537
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	538 typedef struct
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	539 {
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	540 cyg_uint32 targetAddr;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	541 union {
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	542 cyg_uint32 arm_instr;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	543 cyg_uint16 thumb_instr;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	544 } savedInstr;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	545 } instrBuffer;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	546
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	547 static instrBuffer break_buffer;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	548
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	549 volatile int cyg_hal_gdb_running_step = 0;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	550
78 59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 76 diff changeset	551 // This function is passed thumb/arm information about the PC address
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 76 diff changeset	552 // in bit 0. This information is passed on to the break_buffer.
76 435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	553 void
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	554 cyg_hal_gdb_place_break (target_register_t pc)
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	555 {
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	556 // Clear flag that we Continued instead of Stepping
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	557 cyg_hal_gdb_running_step = 0;
78 59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 76 diff changeset	558
76 435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	559 if (0 == break_buffer.targetAddr) {
78 59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 76 diff changeset	560 // Setting a breakpoint in Thumb or ARM code?
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 76 diff changeset	561 if (IS_THUMB_ADDR(pc)) {
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 76 diff changeset	562 break_buffer.targetAddr = (cyg_uint32)pc;
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 76 diff changeset	563 pc = UNMAKE_THUMB_ADDR(pc);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 76 diff changeset	564 break_buffer.savedInstr.thumb_instr = (cyg_uint16)pc;
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 76 diff changeset	565 (cyg_uint16)pc = HAL_BREAKINST_THUMB;
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 76 diff changeset	566 } else {
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 76 diff changeset	567 break_buffer.targetAddr = (cyg_uint32)pc;
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 76 diff changeset	568 break_buffer.savedInstr.arm_instr = (cyg_uint32)pc;
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 76 diff changeset	569 (cyg_uint32)pc = HAL_BREAKINST_ARM;
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 76 diff changeset	570 }
76 435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	571
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	572 __data_cache(CACHE_FLUSH);
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	573 __instruction_cache(CACHE_FLUSH);
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	574 }
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	575 }
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	576
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	577 int
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	578 cyg_hal_gdb_remove_break (target_register_t pc)
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	579 {
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	580 if ( cyg_hal_gdb_running_step )
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	581 return 0; // Do not remove the break: we must hit it!
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	582
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	583 if (pc == UNMAKE_THUMB_ADDR(break_buffer.targetAddr)) {
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	584 if (IS_THUMB_ADDR(break_buffer.targetAddr)) {
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	585 (cyg_uint16)pc = break_buffer.savedInstr.thumb_instr;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	586 } else {
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	587 (cyg_uint32)pc = break_buffer.savedInstr.arm_instr;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	588 }
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	589 break_buffer.targetAddr = 0;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	590
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	591 __data_cache(CACHE_FLUSH);
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	592 __instruction_cache(CACHE_FLUSH);
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	593 return 1;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	594 }
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	595 return 0;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	596 }
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	597
105 5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 80 diff changeset	598 void
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 80 diff changeset	599 cyg_hal_gdb_interrupt (target_register_t pc)
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 80 diff changeset	600 {
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 80 diff changeset	601 // Clear flag that we Continued instead of Stepping
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 80 diff changeset	602 cyg_hal_gdb_running_step = 0;
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 80 diff changeset	603 // and override existing break? So that a ^C takes effect...
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 80 diff changeset	604 if (0 != break_buffer.targetAddr)
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 80 diff changeset	605 cyg_hal_gdb_remove_break( break_buffer.targetAddr );
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 80 diff changeset	606
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 80 diff changeset	607 if (0 == break_buffer.targetAddr) {
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 80 diff changeset	608 cyg_uint32 cpsr = get_register(PS);
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 80 diff changeset	609
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 80 diff changeset	610 if (cpsr & CPSR_THUMB_ENABLE) {
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 80 diff changeset	611 break_buffer.targetAddr = MAKE_THUMB_ADDR((cyg_uint32)pc);
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 80 diff changeset	612 break_buffer.savedInstr.thumb_instr = (cyg_uint16)pc;
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 80 diff changeset	613 (cyg_uint16)pc = HAL_BREAKINST_THUMB;
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 80 diff changeset	614 } else {
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 80 diff changeset	615 break_buffer.targetAddr = (cyg_uint32)pc;
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 80 diff changeset	616 break_buffer.savedInstr.arm_instr = (cyg_uint32)pc;
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 80 diff changeset	617 (cyg_uint32)pc = HAL_BREAKINST_ARM;
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 80 diff changeset	618 }
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 80 diff changeset	619
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 80 diff changeset	620 __data_cache(CACHE_FLUSH);
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 80 diff changeset	621 __instruction_cache(CACHE_FLUSH);
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 80 diff changeset	622 }
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 80 diff changeset	623 }
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 80 diff changeset	624
76 435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	625 int
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	626 cyg_hal_gdb_break_is_set (void)
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	627 {
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	628 if (0 != break_buffer.targetAddr) {
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	629 return 1;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	630 }
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	631 return 0;
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	632 }
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 72 diff changeset	633
36 e97d78785e2d Merge from eCos master repository on 1999-09-12-15:40:34-BST jlarmour parents: 34 diff changeset	634
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	635 #endif // CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS

Mercurial > ecos

annotate packages/hal/arm/arch/current/src/arm_stub.c @ 115:6ed91473a1cd ecos-sw-2000-08-21