flash_v2: packages/hal/common/current/src/hal

annotate packages/hal/common/current/src/hal_stub.c @ 156:b939e9cada46

Merge from eCos master repository on 2001-03-29-21:44:39-BST

author	jlarmour
date	Fri, 06 Apr 2001 17:20:13 +0000
parents	e2d866e32dac
children	2395031e7a66

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;
8 ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST jlarmour parents: 6 diff changeset	436 // Set exit vector to reset vector. This will allow automatic reset on
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST jlarmour parents: 6 diff changeset	437 // some platforms.
154 e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	438 __process_exit_vec = &handle_exception_exit;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	439
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	440 __cleanup_vec = &handle_exception_cleanup;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	441 __init_vec = &handle_exception_init;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	442
105 5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	443 #ifndef CYGSEM_HAL_VIRTUAL_VECTOR_SUPPORT // this should go away
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	444 #ifdef CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	445 // Control of GDB interrupts.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	446 __interruptible_control = HAL_STUB_PLATFORM_INTERRUPTIBLE;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	447 #endif
105 5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	448 #endif
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	449
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	450 // Nothing further to do, handle_exception will be called when an
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	451 // exception occurs.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	452 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	453
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	454 // Initialize the hardware.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	455 void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	456 initHardware (void)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	457 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	458 static int initialized = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	459
103 95f3e12a6327 Merge from eCos master repository on 2000-06-23-16:41:10-BST jlarmour parents: 101 diff changeset	460 if (initialized)
101 c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	461 return;
103 95f3e12a6327 Merge from eCos master repository on 2000-06-23-16:41:10-BST jlarmour parents: 101 diff changeset	462 initialized = 1;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	463
101 c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	464 // Get serial port initialized.
c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	465 HAL_STUB_PLATFORM_INIT_SERIAL();
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	466
105 5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	467 #ifdef HAL_STUB_PLATFORM_INIT
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	468 // 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	469 HAL_STUB_PLATFORM_INIT();
5a0cc6c243a9 Merge from eCos master repository on 2000-06-30-08:18:49-BST jlarmour parents: 103 diff changeset	470 #endif
101 c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	471
110 84e4bde58b26 Merge from eCos master repository on 2000-07-14-22:00:02-BST jlarmour parents: 107 diff changeset	472 #ifndef CYGSEM_HAL_VIRTUAL_VECTOR_SUPPORT // this should go away
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	473 #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	474 // Get interrupt handler initialized.
c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	475 HAL_STUB_PLATFORM_INIT_BREAK_IRQ();
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	476 #endif
110 84e4bde58b26 Merge from eCos master repository on 2000-07-14-22:00:02-BST jlarmour parents: 107 diff changeset	477 #endif // !CYGSEM_HAL_VIRTUAL_VECTOR_SUPPORT
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	478 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	479
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	480 // Reset the board.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	481 void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	482 __reset (void)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	483 {
101 c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	484 #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	485 __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	486 if (__rom_reset)
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	487 (*__rom_reset)();
101 c37d3a9e1b28 Merge from eCos master repository on 2000-06-16-07:47:03-BST jlarmour parents: 76 diff changeset	488 #else
151 25e238959bae Merge from eCos master repository on 2001-02-12-23:44:24-GMT jlarmour parents: 143 diff changeset	489 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	490 #endif
2 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
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 // Breakpoint support.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	495
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	496 #ifndef CYGPKG_HAL_ARM
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	497 // This function will generate a breakpoint exception. It is used at
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	498 // 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	499 // used otherwise as a quick means to stop program execution and
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	500 // "break" into the debugger.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	501 void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	502 breakpoint()
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 HAL_BREAKPOINT(_breakinst);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	505 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	506
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	507 // This function returns the opcode for a 'trap' instruction.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	508 unsigned long
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	509 __break_opcode ()
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 return HAL_BREAKINST;
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 #endif
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	514
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	515 //-----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	516 // 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	517 void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	518 __build_t_packet (int sigval, char *buf)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	519 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	520 target_register_t addr;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	521 char *ptr = buf;
143 6b5f480c6929 Merge from eCos master repository on 2000-12-08-02:09:36-GMT jlarmour parents: 138 diff changeset	522 target_register_t extend_val = 0;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	523
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	524 *ptr++ = 'T';
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	525 *ptr++ = __tohex (sigval >> 4);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	526 *ptr++ = __tohex (sigval);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	527
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	528 #ifdef CYGDBG_HAL_DEBUG_GDB_THREAD_SUPPORT
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	529 // Include thread ID if thread manipulation is required.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	530 {
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	531 int id = dbg_currthread_id ();
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	532
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	533 if (id != 0) {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	534 *ptr++ = 't';
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	535 *ptr++ = 'h';
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	536 *ptr++ = 'r';
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	537 *ptr++ = 'e';
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	538 *ptr++ = 'a';
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	539 *ptr++ = 'd';
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	540 *ptr++ = ':';
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	541
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	542 #if (CYG_BYTEORDER == CYG_LSBFIRST)
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	543 // 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	544 // 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	545 {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	546 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	547 int be_id;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	548
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	549 be_id = id;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	550 *bep++ = (be_id >> 24) & 0xff ;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	551 *bep++ = (be_id >> 16) & 0xff ;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	552 *bep++ = (be_id >> 8) & 0xff ;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	553 *bep++ = (be_id & 0xff) ;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	554 }
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	555 #endif
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	556 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	557 *ptr++ = ';';
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	558 }
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	559 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	560 #endif
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	561
136 a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	562 #ifdef HAL_STUB_HW_WATCHPOINT
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	563 switch(_hw_stop_reason) {
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_WATCH:
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	565 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	566 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	567 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	568 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	569 *ptr++ = ':';
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	570 // Send address MSB first
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	571 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	572 sizeof(_watch_data_addr) * 8);
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	573 *ptr++ = ';';
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 default:
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	576 break;
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	577 }
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	578 #endif
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 130 diff changeset	579
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	580 *ptr++ = __tohex (PC >> 4);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	581 *ptr++ = __tohex (PC);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	582 *ptr++ = ':';
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	583 addr = get_register (PC);
112 02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	584 if (sizeof(addr) < REGSIZE(PC))
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	585 {
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	586 // 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	587 // 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	588 // 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	589 #ifdef CYGARC_SIGN_EXTEND_REGISTERS
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	590 {
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	591 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	592 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	593 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	594 extend_val = ~0;
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	595 }
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	596 #endif
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	597 }
143 6b5f480c6929 Merge from eCos master repository on 2000-12-08-02:09:36-GMT jlarmour parents: 138 diff changeset	598 #if (CYG_BYTEORDER == CYG_MSBFIRST)
6b5f480c6929 Merge from eCos master repository on 2000-12-08-02:09:36-GMT jlarmour parents: 138 diff changeset	599 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	600 #endif
121 6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 115 diff changeset	601 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	602 #if (CYG_BYTEORDER == CYG_LSBFIRST)
6b5f480c6929 Merge from eCos master repository on 2000-12-08-02:09:36-GMT jlarmour parents: 138 diff changeset	603 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	604 #endif
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	605 *ptr++ = ';';
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	606
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	607 *ptr++ = __tohex (SP >> 4);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	608 *ptr++ = __tohex (SP);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	609 *ptr++ = ':';
112 02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	610 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	611 if (sizeof(addr) < REGSIZE(SP))
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	612 {
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	613 // 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	614 // 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	615 // 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	616 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	617 #ifdef CYGARC_SIGN_EXTEND_REGISTERS
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	618 {
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	619 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	620 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	621 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	622 extend_val = ~0;
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	623 }
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	624 #endif
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 110 diff changeset	625 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	626 }
121 6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 115 diff changeset	627 ptr = __mem2hex((char *)&addr, ptr, sizeof(addr), 0);
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	628 *ptr++ = ';';
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	629
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	630 HAL_STUB_ARCH_T_PACKET_EXTRAS(ptr);
2 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 *ptr++ = 0;
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
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 // Cache functions.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	638
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	639 // Perform the specified operation on the instruction cache.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	640 // Returns 1 if the cache is enabled, 0 otherwise.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	641 int
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	642 __instruction_cache (cache_control_t request)
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 int state = 1;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	645
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	646 switch (request) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	647 case CACHE_ENABLE:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	648 HAL_ICACHE_ENABLE();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	649 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	650 case CACHE_DISABLE:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	651 HAL_ICACHE_DISABLE();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	652 state = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	653 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	654 case CACHE_FLUSH:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	655 HAL_ICACHE_SYNC();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	656 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	657 case CACHE_NOOP:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	658 /* fall through */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	659 default:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	660 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	661 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	662
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	663 #ifdef HAL_ICACHE_IS_ENABLED
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	664 HAL_ICACHE_IS_ENABLED(state);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	665 #endif
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 return state;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	668 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	669
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	670 // Perform the specified operation on the data cache.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	671 // Returns 1 if the cache is enabled, 0 otherwise.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	672 int
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	673 __data_cache (cache_control_t request)
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 int state = 1;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	676
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	677 switch (request) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	678 case CACHE_ENABLE:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	679 HAL_DCACHE_ENABLE();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	680 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	681 case CACHE_DISABLE:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	682 HAL_DCACHE_DISABLE();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	683 state = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	684 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	685 case CACHE_FLUSH:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	686 HAL_DCACHE_SYNC();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	687 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	688 case CACHE_NOOP:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	689 /* fall through */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	690 default:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	691 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	692 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	693 #ifdef HAL_DCACHE_IS_ENABLED
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	694 HAL_DCACHE_IS_ENABLED(state);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	695 #endif
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 return state;
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
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	700 //-----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	701 // Memory accessor functions.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	702
130 eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 121 diff changeset	703 // 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	704 // 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	705 // 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	706 // 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	707 // 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	708 // can make use of it.
eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 121 diff changeset	709
eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 121 diff changeset	710 void* volatile __mem_fault_handler = (void *)0;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	711
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	712 /* 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	713 which are passed as globals to avoid squeezing them thru
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	714 __set_mem_fault_trap. */
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 volatile target_register_t memCount;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	717
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	718 static void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	719 __do_copy_mem (unsigned char* src, unsigned char* dst)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	720 {
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	721 unsigned long *long_dst;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	722 unsigned long *long_src;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	723 unsigned short *short_dst;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	724 unsigned short *short_src;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	725
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	726 __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	727 /* when the copy loop completes. */
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	728 __mem_fault_handler = &&err;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	729
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	730 // 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	731 while (memCount) {
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	732 if ((memCount >= sizeof(long)) &&
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	733 (((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	734 (((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	735
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	736 long_dst = (unsigned long *)dst;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	737 long_src = (unsigned long *)src;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	738
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	739 long_dst++ = long_src++;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	740 memCount -= sizeof(long);
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	741
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	742 dst = (unsigned char *)long_dst;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	743 src = (unsigned char *)long_src;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	744 } else if ((memCount >= sizeof(short)) &&
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	745 (((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	746 (((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	747
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	748 short_dst = (unsigned short *)dst;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	749 short_src = (unsigned short *)src;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	750
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	751 short_dst++ = short_src++;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	752 memCount -= sizeof(short);
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	753
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	754 dst = (unsigned char *)short_dst;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	755 src = (unsigned char *)short_src;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	756 } else {
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	757 dst++ = src++;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	758 memCount--;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	759 }
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	760 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	761
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	762 __mem_fault = 0;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	763
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	764 err:
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	765 __mem_fault_handler = (void *)0;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	766 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	767
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 * __read_mem_safe:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	770 * Get contents of target memory, abort on error.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	771 */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	772
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	773 int
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	774 __read_mem_safe (void dst, void src, int count)
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	775 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	776 memCount = count;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	777 __do_copy_mem((unsigned char) src, (unsigned char) dst);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	778 return count - memCount; // return number of bytes successfully read
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	779 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	780
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 * __write_mem_safe:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	783 * Set contents of target memory, abort on error.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	784 */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	785
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	786 int
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 30 diff changeset	787 __write_mem_safe (void src, void dst, int count)
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	788 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	789 memCount = count;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	790 __do_copy_mem((unsigned char) src, (unsigned char) dst);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	791 return count - memCount; // return number of bytes successfully written
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	792 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	793
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	794 #ifdef TARGET_HAS_HARVARD_MEMORY
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	795 static void
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	796 __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	797 {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	798 unsigned long *long_dst;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	799 unsigned long *long_src;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	800 unsigned short *short_dst;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	801 unsigned short *short_src;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	802
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	803 __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	804 /* when the copy loop completes. */
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	805 __mem_fault_handler = &&err;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	806
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	807 // 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	808 while (memCount) {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	809 if ((memCount >= sizeof(long)) &&
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	810 (((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	811 (((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	812
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	813 long_dst = (unsigned long *)dst;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	814 long_src = (unsigned long *)src;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	815
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	816 *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	817 memCount -= sizeof(long);
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 dst = (unsigned char *)long_dst;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	820 src = (unsigned char *)long_src;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	821 } else if ((memCount >= sizeof(short)) &&
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	822 (((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	823 (((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	824
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	825 short_dst = (unsigned short *)dst;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	826 short_src = (unsigned short *)src;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	827
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	828 *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	829 memCount -= sizeof(short);
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 dst = (unsigned char *)short_dst;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	832 src = (unsigned char *)short_src;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	833 } else {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	834 *dst++ = __read_prog_uint8(src++);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	835 memCount--;
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 }
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	838
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	839 __mem_fault = 0;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	840
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	841 err:
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	842 __mem_fault_handler = (void *)0;
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 static void
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	846 __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	847 {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	848 unsigned long *long_dst;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	849 unsigned long *long_src;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	850 unsigned short *short_dst;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	851 unsigned short *short_src;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	852
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	853 __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	854 /* when the copy loop completes. */
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	855 __mem_fault_handler = &&err;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	856
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	857 // 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	858 while (memCount) {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	859 if ((memCount >= sizeof(long)) &&
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	860 (((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	861 (((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	862
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	863 long_dst = (unsigned long *)dst;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	864 long_src = (unsigned long *)src;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	865
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	866 __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	867 memCount -= sizeof(long);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	868
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	869 dst = (unsigned char *)long_dst;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	870 src = (unsigned char *)long_src;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	871 } else if ((memCount >= sizeof(short)) &&
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	872 (((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	873 (((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	874
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	875 short_dst = (unsigned short *)dst;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	876 short_src = (unsigned short *)src;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	877
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	878 __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	879 memCount -= sizeof(short);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	880
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	881 dst = (unsigned char *)short_dst;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	882 src = (unsigned char *)short_src;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	883 } else {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	884 __write_prog_uint8(dst++, *src++);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	885 memCount--;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	886 }
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
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	889 __mem_fault = 0;
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 err:
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	892 __mem_fault_handler = (void *)0;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	893 }
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	894
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	895 /*
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	896 * __read_progmem_safe:
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	897 * 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	898 */
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	899
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	900 int
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	901 __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	902 {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	903 memCount = count;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	904 __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	905 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	906 }
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	907
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 * __write_progmem_safe:
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	910 * 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	911 */
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 int
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	914 __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	915 {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	916 memCount = count;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	917 __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	918 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	919 }
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	920 #endif
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	921
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	922 //-----------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	923 // Target extras?!
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	924 int
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	925 __process_target_query(char * pkt, char * out, int maxOut)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	926 { return 0 ; }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	927 int
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	928 __process_target_set(char * pkt, char * out, int maxout)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	929 { return 0 ; }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	930 int
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	931 __process_target_packet(char * pkt, char * out, int maxout)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	932 { return 0 ; }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	933
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	934 // GDB string output, making sure interrupts are disabled.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	935 // This function gets used by some diag output functions.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	936 void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	937 hal_output_gdb_string(target_register_t str, int string_len)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	938 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	939 unsigned long __state;
8 ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST jlarmour parents: 6 diff changeset	940 HAL_DISABLE_INTERRUPTS(__state);
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	941 __output_gdb_string(str, string_len);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	942 HAL_RESTORE_INTERRUPTS(__state);
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
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	945 #endif // CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS

Mercurial > flash_v2

annotate packages/hal/common/current/src/hal_stub.c @ 156:b939e9cada46