ecos: packages/hal/common/current/src/hal

annotate packages/hal/common/current/src/hal_stub.c @ 163:0d2b193a635f

Merge from eCos master repository on 2001-06-22-17:38:39-BST

author	jlarmour
date	Fri, 22 Jun 2001 18:18:44 +0000
parents	2395031e7a66
children	9160a8005d76

rev	line source
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	1 //=============================================================================
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	2 //
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	3 // hal_stub.c
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	4 //
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	5 // Helper functions for stub, specific to eCos HAL
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	6 //
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	7 //=============================================================================
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	8 //####COPYRIGHTBEGIN####
64 c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 50 diff changeset	9 //
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 50 diff changeset	10 // -------------------------------------------
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 50 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: 50 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: 50 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: 50 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: 50 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: 50 diff changeset	19 // the License.
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 50 diff changeset	20 //
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 50 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: 50 diff changeset	22 // released September 30, 1998.
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 50 diff changeset	23 //
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 50 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: 50 diff changeset	25 // Portions created by Red Hat are
154 e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	26 // Copyright (C) 1998, 1999, 2000, 2001 Red Hat, Inc.
64 c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 50 diff changeset	27 // All Rights Reserved.
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 50 diff changeset	28 // -------------------------------------------
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 50 diff changeset	29 //
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	30 //####COPYRIGHTEND####
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	31 //=============================================================================
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	32 //#####DESCRIPTIONBEGIN####
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	33 //
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	34 // Author(s): jskov (based on powerpc/cogent hal_stub.c)
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: 112 diff changeset	35 // Contributors:jskov, dmoseley
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	36 // Date: 1999-02-12
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	37 // Purpose: Helper functions for stub, specific to eCos HAL
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	38 // Description: Parts of the GDB stub requirements are provided by
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	39 // the eCos HAL, rather than target and/or board specific
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	40 // code.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	41 //
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	42 //####DESCRIPTIONEND####
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	43 //
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
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	46 #include <pkgconf/hal.h>
50 a0774359f013 Merge from eCos master repository on 1999-11-02-17:02:15-GMT jlarmour parents: 48 diff changeset	47 #ifdef CYGPKG_CYGMON
a0774359f013 Merge from eCos master repository on 1999-11-02-17:02:15-GMT jlarmour parents: 48 diff changeset	48 #include <pkgconf/cygmon.h>
a0774359f013 Merge from eCos master repository on 1999-11-02-17:02:15-GMT jlarmour parents: 48 diff changeset	49 #endif
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	50
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	51 #ifdef CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	52
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	53 #include <cyg/hal/hal_stub.h> // Our header
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_arch.h> // HAL_BREAKINST
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	56 #include <cyg/hal/hal_cache.h> // HAL_xCACHE_x
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	57 #include <cyg/hal/hal_intr.h> // interrupt disable/restore
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	58
101 c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	59 #include <cyg/hal/hal_if.h> // ROM calling interface
c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	60 #include <cyg/hal/hal_misc.h> // Helper functions
c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	61
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	62 #ifdef CYGDBG_HAL_DEBUG_GDB_THREAD_SUPPORT
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	63 #include <cyg/hal/dbg-threads-api.h> // dbg_currthread_id
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	64 #endif
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	65
112 02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	66 #ifdef USE_LONG_NAMES_FOR_ENUM_REGNAMES
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: 112 diff changeset	67 #ifndef PC
112 02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	68 #define PC REG_PC
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: 112 diff changeset	69 #endif
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: 112 diff changeset	70 #ifndef SP
112 02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	71 #define SP REG_SP
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	72 #endif
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: 112 diff changeset	73 #endif
112 02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	74
2 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 // Extra eCos data.
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 // Saved registers.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	79 HAL_SavedRegisters *_hal_registers;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	80 target_register_t registers[NUMREGS];
14 01ce82f3e11a Merge from eCos master repository on 1999-06-11-17:05:41-BST jlarmour parents: 12 diff changeset	81 target_register_t alt_registers[NUMREGS] ; // Thread or saved process state
01ce82f3e11a Merge from eCos master repository on 1999-06-11-17:05:41-BST jlarmour parents: 12 diff changeset	82 target_register_t * _registers = registers; // Pointer to current set of registers
154 e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	83 target_register_t orig_registers[NUMREGS]; // Registers to get back to original state
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	84
136 a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	85 #if defined(HAL_STUB_HW_WATCHPOINT) \|\| defined(HAL_STUB_HW_BREAKPOINT)
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	86 static int _hw_stop_reason; // Reason we were stopped by hw.
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	87
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	88 // strings indexed by hw stop reasons defined in hal_stub.h
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	89 static const char * const _hw_stop_str[] = {
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	90 "",
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	91 "hbreak",
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	92 "watch",
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	93 "rwatch",
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	94 "awatch"
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	95 };
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	96
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	97 static void *_watch_data_addr; // The data address if stopped by watchpoint
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	98 #endif
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	99
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: 112 diff changeset	100 // Register validity checking
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: 112 diff changeset	101 #ifdef CYGHWR_REGISTER_VALIDITY_CHECKING
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: 112 diff changeset	102 int registers_valid[NUMREGS];
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: 112 diff changeset	103 int *_registers_valid = registers_valid;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: 112 diff changeset	104 #endif
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: 112 diff changeset	105
105 5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	106 #ifndef CYGSEM_HAL_VIRTUAL_VECTOR_SUPPORT // this should go away
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	107 // Interrupt control.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	108 static volatile __PFI __interruptible_control;
105 5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	109 #endif
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	110
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	111 // Some architectures need extras regs reported in T packet
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	112 #ifndef HAL_STUB_ARCH_T_PACKET_EXTRAS
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	113 #define HAL_STUB_ARCH_T_PACKET_EXTRAS(x)
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	114 #endif
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	115
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	116 //-----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	117 // Register access
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	118
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	119 // Return the currently-saved value corresponding to register REG of
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	120 // the exception context.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	121 target_register_t
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	122 get_register (regnames_t reg)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	123 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	124 return _registers[reg];
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
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: 112 diff changeset	127 #ifdef CYGHWR_REGISTER_VALIDITY_CHECKING
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: 112 diff changeset	128 // Return the validity of register REG.
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: 112 diff changeset	129 int
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: 112 diff changeset	130 get_register_valid (regnames_t reg)
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: 112 diff changeset	131 {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: 112 diff changeset	132 return _registers_valid[reg];
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: 112 diff changeset	133 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: 112 diff changeset	134 #endif
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: 112 diff changeset	135
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	136 // Store VALUE in the register corresponding to WHICH in the exception
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	137 // context.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	138 void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	139 put_register (regnames_t which, target_register_t value)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	140 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	141 _registers[which] = value;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	142 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	143
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	144 //-----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	145 // Serial stuff
76 435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 70 diff changeset	146 #ifdef CYGPKG_CYGMON
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 70 diff changeset	147 extern void ecos_bsp_console_putc(char);
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 70 diff changeset	148 extern char ecos_bsp_console_getc(void);
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 70 diff changeset	149 #endif
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	150
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	151 // Write C to the current serial port.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	152 void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	153 putDebugChar (int c)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	154 {
101 c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	155 #ifdef CYGSEM_HAL_VIRTUAL_VECTOR_SUPPORT
c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	156 __call_if_debug_procs_t __debug_procs = CYGACC_CALL_IF_DEBUG_PROCS();
107 7f461c3a372c Merge from eCos master repository on 2000-07-04-08:04:30-BST jlarmour parents: 105 diff changeset	157 CYGACC_COMM_IF_PUTC(*__debug_procs, c);
101 c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	158 #elif defined(CYGPKG_CYGMON)
76 435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 70 diff changeset	159 ecos_bsp_console_putc(c);
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 70 diff changeset	160 #else
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	161 HAL_STUB_PLATFORM_PUT_CHAR(c);
76 435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 70 diff changeset	162 #endif
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	163 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	164
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	165 // Read one character from the current serial port.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	166 int
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	167 getDebugChar (void)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	168 {
101 c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	169 #ifdef CYGSEM_HAL_VIRTUAL_VECTOR_SUPPORT
c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	170 __call_if_debug_procs_t __debug_procs = CYGACC_CALL_IF_DEBUG_PROCS();
107 7f461c3a372c Merge from eCos master repository on 2000-07-04-08:04:30-BST jlarmour parents: 105 diff changeset	171 return CYGACC_COMM_IF_GETC(*__debug_procs);
101 c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	172 #elif defined(CYGPKG_CYGMON)
76 435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 70 diff changeset	173 return ecos_bsp_console_getc();
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 70 diff changeset	174 #else
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	175 return HAL_STUB_PLATFORM_GET_CHAR();
76 435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 70 diff changeset	176 #endif
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	177 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	178
138 289bf90c6a9b Merge from eCos master repository on 2000-11-24-06:43:05-GMT jlarmour parents: 136 diff changeset	179 // Flush output channel
289bf90c6a9b Merge from eCos master repository on 2000-11-24-06:43:05-GMT jlarmour parents: 136 diff changeset	180 void
289bf90c6a9b Merge from eCos master repository on 2000-11-24-06:43:05-GMT jlarmour parents: 136 diff changeset	181 hal_flush_output(void)
289bf90c6a9b Merge from eCos master repository on 2000-11-24-06:43:05-GMT jlarmour parents: 136 diff changeset	182 {
289bf90c6a9b Merge from eCos master repository on 2000-11-24-06:43:05-GMT jlarmour parents: 136 diff changeset	183 #ifdef CYGSEM_HAL_VIRTUAL_VECTOR_SUPPORT
289bf90c6a9b Merge from eCos master repository on 2000-11-24-06:43:05-GMT jlarmour parents: 136 diff changeset	184 __call_if_debug_procs_t __debug_procs = CYGACC_CALL_IF_DEBUG_PROCS();
289bf90c6a9b Merge from eCos master repository on 2000-11-24-06:43:05-GMT jlarmour parents: 136 diff changeset	185 CYGACC_COMM_IF_CONTROL(*__debug_procs, __COMMCTL_FLUSH_OUTPUT);
289bf90c6a9b Merge from eCos master repository on 2000-11-24-06:43:05-GMT jlarmour parents: 136 diff changeset	186 #endif
289bf90c6a9b Merge from eCos master repository on 2000-11-24-06:43:05-GMT jlarmour parents: 136 diff changeset	187 }
289bf90c6a9b Merge from eCos master repository on 2000-11-24-06:43:05-GMT jlarmour parents: 136 diff changeset	188
289bf90c6a9b Merge from eCos master repository on 2000-11-24-06:43:05-GMT jlarmour parents: 136 diff changeset	189
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	190 // Set the baud rate for the current serial port.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	191 void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	192 __set_baud_rate (int baud)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	193 {
101 c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	194 #ifdef CYGSEM_HAL_VIRTUAL_VECTOR_SUPPORT
c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	195 __call_if_debug_procs_t __debug_procs = CYGACC_CALL_IF_DEBUG_PROCS();
107 7f461c3a372c Merge from eCos master repository on 2000-07-04-08:04:30-BST jlarmour parents: 105 diff changeset	196 CYGACC_COMM_IF_CONTROL(*__debug_procs, __COMMCTL_SETBAUD, baud);
101 c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	197 #elif defined(CYGPKG_CYGMON)
76 435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 70 diff changeset	198 // FIXME!
435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 70 diff changeset	199 #else
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	200 HAL_STUB_PLATFORM_SET_BAUD_RATE(baud);
76 435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 70 diff changeset	201 #endif
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	202 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	203
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	204 //-----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	205 // GDB interrupt (BREAK) support.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	206
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	207 #ifdef CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	208
76 435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 70 diff changeset	209 #ifndef CYGPKG_HAL_ARM
38 e7ba79f6d3a8 Merge from eCos master repository on 1999-09-23-20:10:25-BST jlarmour parents: 34 diff changeset	210
30 641b639be825 Merge from eCos master repository on 1999-08-16-22:01:37-BST jlarmour parents: 14 diff changeset	211 #if (HAL_BREAKINST_SIZE == 1)
641b639be825 Merge from eCos master repository on 1999-08-16-22:01:37-BST jlarmour parents: 14 diff changeset	212 typedef cyg_uint8 t_inst;
641b639be825 Merge from eCos master repository on 1999-08-16-22:01:37-BST jlarmour parents: 14 diff changeset	213 #elif (HAL_BREAKINST_SIZE == 2)
12 4cc3eff958ab Merge from eCos master repository on 1999-06-04-22:24:56-BST jlarmour parents: 10 diff changeset	214 typedef cyg_uint16 t_inst;
4cc3eff958ab Merge from eCos master repository on 1999-06-04-22:24:56-BST jlarmour parents: 10 diff changeset	215 #elif (HAL_BREAKINST_SIZE == 4)
4cc3eff958ab Merge from eCos master repository on 1999-06-04-22:24:56-BST jlarmour parents: 10 diff changeset	216 typedef cyg_uint32 t_inst;
4cc3eff958ab Merge from eCos master repository on 1999-06-04-22:24:56-BST jlarmour parents: 10 diff changeset	217 #else
4cc3eff958ab Merge from eCos master repository on 1999-06-04-22:24:56-BST jlarmour parents: 10 diff changeset	218 #error "Don't know how to handle that size"
4cc3eff958ab Merge from eCos master repository on 1999-06-04-22:24:56-BST jlarmour parents: 10 diff changeset	219 #endif
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	220
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	221 typedef struct
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 t_inst *targetAddr;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	224 t_inst savedInstr;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	225 } instrBuffer;
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 static instrBuffer break_buffer;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	228
48 1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 38 diff changeset	229 volatile int cyg_hal_gdb_running_step = 0;
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 38 diff changeset	230
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	231 void
50 a0774359f013 Merge from eCos master repository on 1999-11-02-17:02:15-GMT jlarmour parents: 48 diff changeset	232 cyg_hal_gdb_place_break (target_register_t pc)
a0774359f013 Merge from eCos master repository on 1999-11-02-17:02:15-GMT jlarmour parents: 48 diff changeset	233 {
a0774359f013 Merge from eCos master repository on 1999-11-02-17:02:15-GMT jlarmour parents: 48 diff changeset	234 cyg_hal_gdb_interrupt( pc ); // Let's hope this becomes a drop-through:
a0774359f013 Merge from eCos master repository on 1999-11-02-17:02:15-GMT jlarmour parents: 48 diff changeset	235 }
a0774359f013 Merge from eCos master repository on 1999-11-02-17:02:15-GMT jlarmour parents: 48 diff changeset	236
a0774359f013 Merge from eCos master repository on 1999-11-02-17:02:15-GMT jlarmour parents: 48 diff changeset	237 void
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	238 cyg_hal_gdb_interrupt (target_register_t pc)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	239 {
101 c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	240 CYGARC_HAL_SAVE_GP();
c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	241
50 a0774359f013 Merge from eCos master repository on 1999-11-02-17:02:15-GMT jlarmour parents: 48 diff changeset	242 // Clear flag that we Continued instead of Stepping
48 1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 38 diff changeset	243 cyg_hal_gdb_running_step = 0;
50 a0774359f013 Merge from eCos master repository on 1999-11-02-17:02:15-GMT jlarmour parents: 48 diff changeset	244 // and override existing break? So that a ^C takes effect...
a0774359f013 Merge from eCos master repository on 1999-11-02-17:02:15-GMT jlarmour parents: 48 diff changeset	245 if (NULL != break_buffer.targetAddr)
a0774359f013 Merge from eCos master repository on 1999-11-02-17:02:15-GMT jlarmour parents: 48 diff changeset	246 cyg_hal_gdb_remove_break( (target_register_t)break_buffer.targetAddr );
a0774359f013 Merge from eCos master repository on 1999-11-02-17:02:15-GMT jlarmour parents: 48 diff changeset	247
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	248 if (NULL == break_buffer.targetAddr) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	249 break_buffer.targetAddr = (t_inst*) pc;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	250 break_buffer.savedInstr = (t_inst)pc;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	251 (t_inst)pc = (t_inst)HAL_BREAKINST;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	252
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	253 __data_cache(CACHE_FLUSH);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	254 __instruction_cache(CACHE_FLUSH);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	255 }
101 c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	256
c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	257 CYGARC_HAL_RESTORE_GP();
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	258 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	259
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	260 int
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	261 cyg_hal_gdb_remove_break (target_register_t pc)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	262 {
48 1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 38 diff changeset	263 if ( cyg_hal_gdb_running_step )
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 38 diff changeset	264 return 0;
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 38 diff changeset	265
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	266 if ((t_inst*)pc == break_buffer.targetAddr) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	267 (t_inst)pc = break_buffer.savedInstr;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	268 break_buffer.targetAddr = NULL;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	269
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	270 __data_cache(CACHE_FLUSH);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	271 __instruction_cache(CACHE_FLUSH);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	272 return 1;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	273 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	274 return 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	275 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	276
48 1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 38 diff changeset	277 int
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 38 diff changeset	278 cyg_hal_gdb_break_is_set (void)
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 38 diff changeset	279 {
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 38 diff changeset	280 if (NULL != break_buffer.targetAddr) {
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 38 diff changeset	281 return 1;
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 38 diff changeset	282 }
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 38 diff changeset	283 return 0;
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 38 diff changeset	284 }
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 38 diff changeset	285
76 435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 70 diff changeset	286 #endif // CYGPKG_HAL_ARM
38 e7ba79f6d3a8 Merge from eCos master repository on 1999-09-23-20:10:25-BST jlarmour parents: 34 diff changeset	287
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	288 #endif // CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	289
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	290 // Use this function to disable serial interrupts whenever reply
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	291 // characters are expected from GDB. The reason we want to control
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	292 // whether the target can be interrupted or not is simply that GDB on
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	293 // the host will be sending acknowledge characters/commands while the
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	294 // stub is running - if serial interrupts were still active, the
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	295 // characters would never reach the (polling) getDebugChar.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	296 static void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	297 interruptible(int state)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	298 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	299 static int __interrupts_suspended = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	300
105 5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	301 if (state) {
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	302 __interrupts_suspended--;
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	303 if (0 >= __interrupts_suspended) {
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	304 __interrupts_suspended = 0;
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	305 #ifdef CYGSEM_HAL_VIRTUAL_VECTOR_SUPPORT // this _check_ should go away
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	306 {
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	307 hal_virtual_comm_table_t* __chan;
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	308 __chan = CYGACC_CALL_IF_DEBUG_PROCS();
107 7f461c3a372c Merge from eCos master repository on 2000-07-04-08:04:30-BST jlarmour parents: 105 diff changeset	309 CYGACC_COMM_IF_CONTROL(*__chan, __COMMCTL_IRQ_ENABLE);
105 5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	310 }
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	311 #else
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	312 if (__interruptible_control)
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	313 __interruptible_control(1);
105 5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	314 #endif
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	315 }
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	316 } else {
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	317 __interrupts_suspended++;
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	318 if (1 == __interrupts_suspended)
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	319 #ifdef CYGSEM_HAL_VIRTUAL_VECTOR_SUPPORT // this _check_ should go away
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	320 {
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	321 hal_virtual_comm_table_t* __chan;
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	322 __chan = CYGACC_CALL_IF_DEBUG_PROCS();
107 7f461c3a372c Merge from eCos master repository on 2000-07-04-08:04:30-BST jlarmour parents: 105 diff changeset	323 CYGACC_COMM_IF_CONTROL(*__chan, __COMMCTL_IRQ_DISABLE);
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	324 }
105 5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	325 #else
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	326 if (__interruptible_control)
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	327 __interruptible_control(0);
105 5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	328 #endif
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	329 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	330 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	331
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	332 //-----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	333 // eCos stub entry and exit magic.
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 #ifdef CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	336 int cyg_hal_gdb_break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	337 #endif
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	338
154 e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	339 // Called at stub kill
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	340 static void
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	341 handle_exception_exit( void )
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	342 {
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	343 int i;
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	344
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	345 for (i = 0; i < (sizeof(registers)/sizeof(registers[0])); i++)
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	346 registers[i] = orig_registers[i];
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	347 }
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	348
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	349 // Called at stub entry
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	350 static void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	351 handle_exception_cleanup( void )
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	352 {
154 e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	353 static int orig_registers_set = 0;
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	354
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	355 interruptible(0);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	356
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	357 // Expand the HAL_SavedRegisters structure into the GDB register
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	358 // array format.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	359 HAL_GET_GDB_REGISTERS(&registers[0], _hal_registers);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	360 _registers = &registers[0];
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	361
154 e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	362 if (!orig_registers_set) {
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	363 int i;
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	364 for (i = 0; i < (sizeof(registers)/sizeof(registers[0])); i++)
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	365 orig_registers[i] = registers[i];
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	366 _registers = &orig_registers[0];
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	367 if (__is_breakpoint_function ())
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	368 __skipinst ();
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	369 _registers = &registers[0];
154 e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	370 orig_registers_set = 1;
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	371 }
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	372
8 ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST jlarmour parents: 6 diff changeset	373 #ifdef HAL_STUB_PLATFORM_STUBS_FIXUP
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST jlarmour parents: 6 diff changeset	374 // Some architectures may need to fix the PC in case of a partial
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST jlarmour parents: 6 diff changeset	375 // or fully executed trap instruction. GDB only takes correct action
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST jlarmour parents: 6 diff changeset	376 // when the PC is pointing to the breakpoint instruction it set.
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST jlarmour parents: 6 diff changeset	377 //
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST jlarmour parents: 6 diff changeset	378 // Most architectures would leave PC pointing at the trap
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST jlarmour parents: 6 diff changeset	379 // instruction itself though, and so do not need to do anything
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST jlarmour parents: 6 diff changeset	380 // special.
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST jlarmour parents: 6 diff changeset	381 HAL_STUB_PLATFORM_STUBS_FIXUP();
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST jlarmour parents: 6 diff changeset	382 #endif
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST jlarmour parents: 6 diff changeset	383
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	384 #ifdef CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT
48 1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 38 diff changeset	385 // If we continued instead of stepping, when there was a break set
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 38 diff changeset	386 // ie. we were stepping within a critical region, clear the break, and
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 38 diff changeset	387 // that flag. If we stopped for some other reason, this has no effect.
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 38 diff changeset	388 if ( cyg_hal_gdb_running_step ) {
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 38 diff changeset	389 cyg_hal_gdb_running_step = 0;
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 38 diff changeset	390 cyg_hal_gdb_remove_break(get_register (PC));
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 38 diff changeset	391 }
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 38 diff changeset	392
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	393 // FIXME: (there may be a better way to do this)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	394 // If we hit a breakpoint set by the gdb interrupt stub, make it
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	395 // seem like an interrupt rather than having hit a breakpoint.
101 c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	396 cyg_hal_gdb_break = cyg_hal_gdb_remove_break(get_register (PC));
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	397 #endif
136 a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	398
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	399 #if defined(HAL_STUB_HW_WATCHPOINT) \|\| defined(HAL_STUB_HW_BREAKPOINT)
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	400 // For HW watchpoint/breakpoint support, we need to know if we
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	401 // stopped because of watchpoint or hw break. We do that here
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	402 // before GDB has a chance to remove the watchpoints and save
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	403 // the information for later use in building response packets.
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	404 _hw_stop_reason = HAL_STUB_IS_STOPPED_BY_HARDWARE(_watch_data_addr);
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	405 #endif
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	406 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	407
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	408 // Called at stub exit
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	409 static void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	410 handle_exception_init( void )
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	411 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	412 // Compact register array again.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	413 HAL_SET_GDB_REGISTERS(_hal_registers, &registers[0]);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	414
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	415 interruptible(1);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	416 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	417
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	418
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	419 //-----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	420 // Initialization.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	421
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	422 // Signal handler.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	423 int
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	424 cyg_hal_process_signal (int signal)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	425 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	426 // We don't care about the signal (atm).
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	427 return 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	428 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	429
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	430 // Install the standard set of trap handlers for the stub.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	431 void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	432 __install_traps (void)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	433 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	434 // Set signal handling vector so we can treat 'C<signum>' as 'c'.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	435 __process_signal_vec = &cyg_hal_process_signal;
154 e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	436 __process_exit_vec = &handle_exception_exit;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	437
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	438 __cleanup_vec = &handle_exception_cleanup;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	439 __init_vec = &handle_exception_init;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	440
105 5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	441 #ifndef CYGSEM_HAL_VIRTUAL_VECTOR_SUPPORT // this should go away
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	442 #ifdef CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	443 // Control of GDB interrupts.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	444 __interruptible_control = HAL_STUB_PLATFORM_INTERRUPTIBLE;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	445 #endif
105 5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	446 #endif
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	447
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	448 // Nothing further to do, handle_exception will be called when an
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	449 // exception occurs.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	450 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	451
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	452 // Initialize the hardware.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	453 void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	454 initHardware (void)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	455 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	456 static int initialized = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	457
103 95f3e12a6327 Merge from eCos master repository on 2000-06-23-16:41:10-BST jlarmour parents: 101 diff changeset	458 if (initialized)
101 c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	459 return;
103 95f3e12a6327 Merge from eCos master repository on 2000-06-23-16:41:10-BST jlarmour parents: 101 diff changeset	460 initialized = 1;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	461
101 c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	462 // Get serial port initialized.
c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	463 HAL_STUB_PLATFORM_INIT_SERIAL();
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	464
105 5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	465 #ifdef HAL_STUB_PLATFORM_INIT
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	466 // If the platform defines any initialization code, call it here.
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	467 HAL_STUB_PLATFORM_INIT();
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	468 #endif
101 c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	469
110 84e4bde58b26 Merge from eCos master repository on 2000-07-14-22:00:02-BST jlarmour parents: 107 diff changeset	470 #ifndef CYGSEM_HAL_VIRTUAL_VECTOR_SUPPORT // this should go away
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	471 #ifdef CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT
101 c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	472 // Get interrupt handler initialized.
c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	473 HAL_STUB_PLATFORM_INIT_BREAK_IRQ();
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	474 #endif
110 84e4bde58b26 Merge from eCos master repository on 2000-07-14-22:00:02-BST jlarmour parents: 107 diff changeset	475 #endif // !CYGSEM_HAL_VIRTUAL_VECTOR_SUPPORT
2 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
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	478 // Reset the board.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	479 void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	480 __reset (void)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	481 {
101 c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	482 #ifdef CYGSEM_HAL_VIRTUAL_VECTOR_SUPPORT
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	483 __call_if_reset_t *__rom_reset = CYGACC_CALL_IF_RESET_GET();
101 c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	484 if (__rom_reset)
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	485 (*__rom_reset)();
101 c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	486 #else
151 25e238959bae Merge from eCos master repository on 2001-02-12-23:44:24-GMT jlarmour parents: 143 diff changeset	487 HAL_PLATFORM_RESET();
76 435cced73e2f eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST jlarmour parents: 70 diff changeset	488 #endif
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	489 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	490
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	491 //-----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	492 // Breakpoint support.
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 #ifndef CYGPKG_HAL_ARM
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	495 // This function will generate a breakpoint exception. It is used at
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	496 // the beginning of a program to sync up with a debugger and can be
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	497 // used otherwise as a quick means to stop program execution and
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	498 // "break" into the debugger.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	499 void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	500 breakpoint()
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 HAL_BREAKPOINT(_breakinst);
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 // This function returns the opcode for a 'trap' instruction.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	506 unsigned long
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	507 __break_opcode ()
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	508 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	509 return HAL_BREAKINST;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	510 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	511 #endif
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 // Write the 'T' packet in BUFFER. SIGVAL is the signal the program received.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	515 void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	516 __build_t_packet (int sigval, char *buf)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	517 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	518 target_register_t addr;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	519 char *ptr = buf;
143 6b5f480c6929 Merge from eCos master repository on 2000-12-08-02:09:36-GMT jlarmour parents: 138 diff changeset	520 target_register_t extend_val = 0;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	521
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	522 *ptr++ = 'T';
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	523 *ptr++ = __tohex (sigval >> 4);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	524 *ptr++ = __tohex (sigval);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	525
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	526 #ifdef CYGDBG_HAL_DEBUG_GDB_THREAD_SUPPORT
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	527 // Include thread ID if thread manipulation is required.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	528 {
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	529 int id = dbg_currthread_id ();
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	530
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	531 if (id != 0) {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	532 *ptr++ = 't';
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	533 *ptr++ = 'h';
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	534 *ptr++ = 'r';
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	535 *ptr++ = 'e';
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	536 *ptr++ = 'a';
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	537 *ptr++ = 'd';
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	538 *ptr++ = ':';
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	539
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	540 #if (CYG_BYTEORDER == CYG_LSBFIRST)
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	541 // FIXME: Temporary workaround for PR 18903. Thread ID must be
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	542 // big-endian in the T packet.
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	543 {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	544 unsigned char* bep = (unsigned char*)&id;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	545 int be_id;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	546
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	547 be_id = id;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	548 *bep++ = (be_id >> 24) & 0xff ;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	549 *bep++ = (be_id >> 16) & 0xff ;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	550 *bep++ = (be_id >> 8) & 0xff ;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	551 *bep++ = (be_id & 0xff) ;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	552 }
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	553 #endif
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	554 ptr = __mem2hex((char *)&id, ptr, sizeof(id), 0);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	555 *ptr++ = ';';
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	556 }
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	557 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	558 #endif
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	559
136 a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	560 #ifdef HAL_STUB_HW_WATCHPOINT
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	561 switch(_hw_stop_reason) {
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	562 case HAL_STUB_HW_STOP_WATCH:
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	563 case HAL_STUB_HW_STOP_RWATCH:
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	564 case HAL_STUB_HW_STOP_AWATCH:
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	565 strcpy(ptr, _hw_stop_str[_hw_stop_reason]);
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	566 ptr += strlen(_hw_stop_str[_hw_stop_reason]);
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	567 *ptr++ = ':';
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	568 // Send address MSB first
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	569 ptr += __intToHex(ptr, (target_register_t)_watch_data_addr,
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	570 sizeof(_watch_data_addr) * 8);
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	571 *ptr++ = ';';
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	572 break;
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	573 default:
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	574 break;
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	575 }
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	576 #endif
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	577
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	578 *ptr++ = __tohex (PC >> 4);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	579 *ptr++ = __tohex (PC);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	580 *ptr++ = ':';
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	581 addr = get_register (PC);
112 02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	582 if (sizeof(addr) < REGSIZE(PC))
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	583 {
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	584 // GDB is expecting REGSIZE(PC) number of bytes.
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	585 // We only have sizeof(addr) number. Let's fill
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	586 // the appropriate number of bytes intelligently.
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	587 #ifdef CYGARC_SIGN_EXTEND_REGISTERS
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	588 {
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	589 unsigned long bits_in_addr = (sizeof(addr) << 3); // ie Size in bytes * 8
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	590 target_register_t sign_bit_mask = (1 << (bits_in_addr - 1));
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	591 if ((addr & sign_bit_mask) == sign_bit_mask)
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	592 extend_val = ~0;
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	593 }
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	594 #endif
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	595 }
143 6b5f480c6929 Merge from eCos master repository on 2000-12-08-02:09:36-GMT jlarmour parents: 138 diff changeset	596 #if (CYG_BYTEORDER == CYG_MSBFIRST)
6b5f480c6929 Merge from eCos master repository on 2000-12-08-02:09:36-GMT jlarmour parents: 138 diff changeset	597 ptr = __mem2hex((char *)&extend_val, ptr, REGSIZE(PC) - sizeof(addr), 0);
6b5f480c6929 Merge from eCos master repository on 2000-12-08-02:09:36-GMT jlarmour parents: 138 diff changeset	598 #endif
121 6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 115 diff changeset	599 ptr = __mem2hex((char *)&addr, ptr, sizeof(addr), 0);
143 6b5f480c6929 Merge from eCos master repository on 2000-12-08-02:09:36-GMT jlarmour parents: 138 diff changeset	600 #if (CYG_BYTEORDER == CYG_LSBFIRST)
6b5f480c6929 Merge from eCos master repository on 2000-12-08-02:09:36-GMT jlarmour parents: 138 diff changeset	601 ptr = __mem2hex((char *)&extend_val, ptr, REGSIZE(PC) - sizeof(addr), 0);
6b5f480c6929 Merge from eCos master repository on 2000-12-08-02:09:36-GMT jlarmour parents: 138 diff changeset	602 #endif
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	603 *ptr++ = ';';
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	604
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	605 *ptr++ = __tohex (SP >> 4);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	606 *ptr++ = __tohex (SP);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	607 *ptr++ = ':';
112 02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	608 addr = (target_register_t) get_register (SP);
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	609 if (sizeof(addr) < REGSIZE(SP))
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	610 {
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	611 // GDB is expecting REGSIZE(SP) number of bytes.
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	612 // We only have sizeof(addr) number. Let's fill
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	613 // the appropriate number of bytes intelligently.
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	614 target_register_t extend_val = 0;
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	615 #ifdef CYGARC_SIGN_EXTEND_REGISTERS
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	616 {
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	617 unsigned long bits_in_addr = (sizeof(addr) << 3); // ie Size in bytes * 8
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	618 target_register_t sign_bit_mask = (1 << (bits_in_addr - 1));
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	619 if ((addr & sign_bit_mask) == sign_bit_mask)
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	620 extend_val = ~0;
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	621 }
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	622 #endif
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	623 ptr = __mem2hex((char *)&extend_val, ptr, REGSIZE(SP) - sizeof(addr), 0);
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	624 }
121 6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 115 diff changeset	625 ptr = __mem2hex((char *)&addr, ptr, sizeof(addr), 0);
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	626 *ptr++ = ';';
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	627
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	628 HAL_STUB_ARCH_T_PACKET_EXTRAS(ptr);
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	629
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	630 *ptr++ = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	631 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	632
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	633
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	634 //-----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	635 // Cache functions.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	636
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	637 // Perform the specified operation on the instruction cache.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	638 // Returns 1 if the cache is enabled, 0 otherwise.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	639 int
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	640 __instruction_cache (cache_control_t request)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	641 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	642 int state = 1;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	643
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	644 switch (request) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	645 case CACHE_ENABLE:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	646 HAL_ICACHE_ENABLE();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	647 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	648 case CACHE_DISABLE:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	649 HAL_ICACHE_DISABLE();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	650 state = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	651 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	652 case CACHE_FLUSH:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	653 HAL_ICACHE_SYNC();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	654 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	655 case CACHE_NOOP:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	656 /* fall through */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	657 default:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	658 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	659 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	660
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	661 #ifdef HAL_ICACHE_IS_ENABLED
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	662 HAL_ICACHE_IS_ENABLED(state);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	663 #endif
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	664
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	665 return state;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	666 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	667
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	668 // Perform the specified operation on the data cache.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	669 // Returns 1 if the cache is enabled, 0 otherwise.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	670 int
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	671 __data_cache (cache_control_t request)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	672 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	673 int state = 1;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	674
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	675 switch (request) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	676 case CACHE_ENABLE:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	677 HAL_DCACHE_ENABLE();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	678 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	679 case CACHE_DISABLE:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	680 HAL_DCACHE_DISABLE();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	681 state = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	682 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	683 case CACHE_FLUSH:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	684 HAL_DCACHE_SYNC();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	685 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	686 case CACHE_NOOP:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	687 /* fall through */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	688 default:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	689 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	690 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	691 #ifdef HAL_DCACHE_IS_ENABLED
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	692 HAL_DCACHE_IS_ENABLED(state);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	693 #endif
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	694
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	695 return state;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	696 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	697
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	698 //-----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	699 // Memory accessor functions.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	700
130 eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 121 diff changeset	701 // The __mem_fault_handler pointer is volatile since it is only
eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 121 diff changeset	702 // set/cleared by the function below - which does not rely on any
eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 121 diff changeset	703 // other functions, so the compiler may decide to not bother updating
eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 121 diff changeset	704 // the pointer at all. If any of the memory accesses cause an
eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 121 diff changeset	705 // exception, the pointer must be set to ensure the exception handler
eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 121 diff changeset	706 // can make use of it.
eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 121 diff changeset	707
eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 121 diff changeset	708 void* volatile __mem_fault_handler = (void *)0;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	709
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	710 /* These are the "arguments" to __do_read_mem and __do_write_mem,
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	711 which are passed as globals to avoid squeezing them thru
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	712 __set_mem_fault_trap. */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	713
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	714 static volatile target_register_t memCount;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	715
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	716 static void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	717 __do_copy_mem (unsigned char* src, unsigned char* dst)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	718 {
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	719 unsigned long *long_dst;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	720 unsigned long *long_src;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	721 unsigned short *short_dst;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	722 unsigned short *short_src;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	723
163 0d2b193a635f Merge from eCos master repository on 2001-06-22-17:38:39-BST jlarmour parents: 162 diff changeset	724 // Zero memCount is not really an error, but the goto is necessary to
0d2b193a635f Merge from eCos master repository on 2001-06-22-17:38:39-BST jlarmour parents: 162 diff changeset	725 // keep some compilers from reordering stuff across the 'err' label.
0d2b193a635f Merge from eCos master repository on 2001-06-22-17:38:39-BST jlarmour parents: 162 diff changeset	726 if (memCount == 0) goto err;
0d2b193a635f Merge from eCos master repository on 2001-06-22-17:38:39-BST jlarmour parents: 162 diff changeset	727
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	728 __mem_fault = 1; /* Defaults to 'fail'. Is cleared */
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	729 /* when the copy loop completes. */
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	730 __mem_fault_handler = &&err;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	731
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	732 // See if it's safe to do multi-byte, aligned operations
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	733 while (memCount) {
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	734 if ((memCount >= sizeof(long)) &&
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	735 (((target_register_t)dst & (sizeof(long)-1)) == 0) &&
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	736 (((target_register_t)src & (sizeof(long)-1)) == 0)) {
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	737
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	738 long_dst = (unsigned long *)dst;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	739 long_src = (unsigned long *)src;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	740
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	741 long_dst++ = long_src++;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	742 memCount -= sizeof(long);
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	743
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	744 dst = (unsigned char *)long_dst;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	745 src = (unsigned char *)long_src;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	746 } else if ((memCount >= sizeof(short)) &&
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	747 (((target_register_t)dst & (sizeof(short)-1)) == 0) &&
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	748 (((target_register_t)src & (sizeof(short)-1)) == 0)) {
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	749
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	750 short_dst = (unsigned short *)dst;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	751 short_src = (unsigned short *)src;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	752
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	753 short_dst++ = short_src++;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	754 memCount -= sizeof(short);
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	755
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	756 dst = (unsigned char *)short_dst;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	757 src = (unsigned char *)short_src;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	758 } else {
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	759 dst++ = src++;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	760 memCount--;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	761 }
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	762 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	763
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	764 __mem_fault = 0;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	765
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	766 err:
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	767 __mem_fault_handler = (void *)0;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	768 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	769
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	770 /*
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	771 * __read_mem_safe:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	772 * Get contents of target memory, abort on error.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	773 */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	774
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	775 int
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	776 __read_mem_safe (void dst, void src, int count)
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	777 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	778 memCount = count;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	779 __do_copy_mem((unsigned char) src, (unsigned char) dst);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	780 return count - memCount; // return number of bytes successfully read
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	781 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	782
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	783 /*
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	784 * __write_mem_safe:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	785 * Set contents of target memory, abort on error.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	786 */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	787
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	788 int
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	789 __write_mem_safe (void src, void dst, int count)
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	790 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	791 memCount = count;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	792 __do_copy_mem((unsigned char) src, (unsigned char) dst);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	793 return count - memCount; // return number of bytes successfully written
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	794 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	795
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	796 #ifdef TARGET_HAS_HARVARD_MEMORY
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	797 static void
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	798 __do_copy_from_progmem (unsigned char* src, unsigned char* dst)
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	799 {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	800 unsigned long *long_dst;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	801 unsigned long *long_src;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	802 unsigned short *short_dst;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	803 unsigned short *short_src;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	804
163 0d2b193a635f Merge from eCos master repository on 2001-06-22-17:38:39-BST jlarmour parents: 162 diff changeset	805 // Zero memCount is not really an error, but the goto is necessary to
0d2b193a635f Merge from eCos master repository on 2001-06-22-17:38:39-BST jlarmour parents: 162 diff changeset	806 // keep some compilers from reordering stuff across the 'err' label.
0d2b193a635f Merge from eCos master repository on 2001-06-22-17:38:39-BST jlarmour parents: 162 diff changeset	807 if (memCount == 0) goto err;
0d2b193a635f Merge from eCos master repository on 2001-06-22-17:38:39-BST jlarmour parents: 162 diff changeset	808
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	809 __mem_fault = 1; /* Defaults to 'fail'. Is cleared */
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	810 /* when the copy loop completes. */
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	811 __mem_fault_handler = &&err;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	812
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	813 // See if it's safe to do multi-byte, aligned operations
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	814 while (memCount) {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	815 if ((memCount >= sizeof(long)) &&
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	816 (((target_register_t)dst & (sizeof(long)-1)) == 0) &&
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	817 (((target_register_t)src & (sizeof(long)-1)) == 0)) {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	818
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	819 long_dst = (unsigned long *)dst;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	820 long_src = (unsigned long *)src;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	821
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	822 *long_dst++ = __read_prog_uint32(long_src++);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	823 memCount -= sizeof(long);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	824
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	825 dst = (unsigned char *)long_dst;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	826 src = (unsigned char *)long_src;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	827 } else if ((memCount >= sizeof(short)) &&
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	828 (((target_register_t)dst & (sizeof(short)-1)) == 0) &&
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	829 (((target_register_t)src & (sizeof(short)-1)) == 0)) {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	830
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	831 short_dst = (unsigned short *)dst;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	832 short_src = (unsigned short *)src;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	833
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	834 *short_dst++ = __read_prog_uint16(short_src++);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	835 memCount -= sizeof(short);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	836
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	837 dst = (unsigned char *)short_dst;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	838 src = (unsigned char *)short_src;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	839 } else {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	840 *dst++ = __read_prog_uint8(src++);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	841 memCount--;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	842 }
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	843 }
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	844
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	845 __mem_fault = 0;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	846
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	847 err:
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	848 __mem_fault_handler = (void *)0;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	849 }
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	850
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	851 static void
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	852 __do_copy_to_progmem (unsigned char* src, unsigned char* dst)
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	853 {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	854 unsigned long *long_dst;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	855 unsigned long *long_src;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	856 unsigned short *short_dst;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	857 unsigned short *short_src;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	858
163 0d2b193a635f Merge from eCos master repository on 2001-06-22-17:38:39-BST jlarmour parents: 162 diff changeset	859 // Zero memCount is not really an error, but the goto is necessary to
0d2b193a635f Merge from eCos master repository on 2001-06-22-17:38:39-BST jlarmour parents: 162 diff changeset	860 // keep some compilers from reordering stuff across the 'err' label.
0d2b193a635f Merge from eCos master repository on 2001-06-22-17:38:39-BST jlarmour parents: 162 diff changeset	861 if (memCount == 0) goto err;
0d2b193a635f Merge from eCos master repository on 2001-06-22-17:38:39-BST jlarmour parents: 162 diff changeset	862
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	863 __mem_fault = 1; /* Defaults to 'fail'. Is cleared */
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	864 /* when the copy loop completes. */
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	865 __mem_fault_handler = &&err;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	866
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	867 // See if it's safe to do multi-byte, aligned operations
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	868 while (memCount) {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	869 if ((memCount >= sizeof(long)) &&
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	870 (((target_register_t)dst & (sizeof(long)-1)) == 0) &&
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	871 (((target_register_t)src & (sizeof(long)-1)) == 0)) {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	872
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	873 long_dst = (unsigned long *)dst;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	874 long_src = (unsigned long *)src;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	875
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	876 __write_prog_uint32(long_dst++, *long_src++);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	877 memCount -= sizeof(long);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	878
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	879 dst = (unsigned char *)long_dst;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	880 src = (unsigned char *)long_src;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	881 } else if ((memCount >= sizeof(short)) &&
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	882 (((target_register_t)dst & (sizeof(short)-1)) == 0) &&
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	883 (((target_register_t)src & (sizeof(short)-1)) == 0)) {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	884
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	885 short_dst = (unsigned short *)dst;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	886 short_src = (unsigned short *)src;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	887
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	888 __write_prog_uint16(short_dst++, *short_src++);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	889 memCount -= sizeof(short);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	890
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	891 dst = (unsigned char *)short_dst;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	892 src = (unsigned char *)short_src;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	893 } else {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	894 __write_prog_uint8(dst++, *src++);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	895 memCount--;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	896 }
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	897 }
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	898
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	899 __mem_fault = 0;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	900
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	901 err:
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	902 __mem_fault_handler = (void *)0;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	903 }
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	904
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	905 /*
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	906 * __read_progmem_safe:
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	907 * Get contents of target memory, abort on error.
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	908 */
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	909
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	910 int
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	911 __read_progmem_safe (void dst, void src, int count)
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	912 {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	913 memCount = count;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	914 __do_copy_from_progmem((unsigned char) src, (unsigned char) dst);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	915 return count - memCount; // return number of bytes successfully read
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	916 }
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	917
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	918 /*
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	919 * __write_progmem_safe:
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	920 * Set contents of target memory, abort on error.
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	921 */
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	922
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	923 int
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	924 __write_progmem_safe (void src, void dst, int count)
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	925 {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	926 memCount = count;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	927 __do_copy_to_progmem((unsigned char) src, (unsigned char) dst);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	928 return count - memCount; // return number of bytes successfully written
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	929 }
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	930 #endif
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	931
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	932 //-----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	933 // Target extras?!
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	934 int
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	935 __process_target_query(char * pkt, char * out, int maxOut)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	936 { return 0 ; }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	937 int
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	938 __process_target_set(char * pkt, char * out, int maxout)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	939 { return 0 ; }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	940 int
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	941 __process_target_packet(char * pkt, char * out, int maxout)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	942 { return 0 ; }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	943
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	944 // GDB string output, making sure interrupts are disabled.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	945 // This function gets used by some diag output functions.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	946 void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	947 hal_output_gdb_string(target_register_t str, int string_len)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	948 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	949 unsigned long __state;
8 ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST jlarmour parents: 6 diff changeset	950 HAL_DISABLE_INTERRUPTS(__state);
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	951 __output_gdb_string(str, string_len);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	952 HAL_RESTORE_INTERRUPTS(__state);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	953 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	954
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	955 #endif // CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS

Mercurial > ecos

annotate packages/hal/common/current/src/hal_stub.c @ 163:0d2b193a635f