ecos: packages/hal/common/current/src/generic-stub.c annotate

annotate packages/hal/common/current/src/generic-stub.c @ 163:0d2b193a635f

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

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

rev	line source
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1 #include "board.h"
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	2
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	3 #ifdef CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	4
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	5 /* Eventually, this should default to ON */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	6 #if USE_GDBSTUB_PROTOTYPES
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	7 #include "stub-tservice.h"
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	8 #include "generic-stub.h"
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	9 #else
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	10 // Function declarations (prevents compiler warnings)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	11 int stubhex (unsigned char ch);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	12 static void getpacket (char *buffer);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	13 static void unlock_thread_scheduler (void);
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	14 static uint32 crc32 (target_addr_t mem, int len, uint32 crc);
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	15 #endif
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	16
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	17 #include "thread-pkts.h"
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	18 /* Defines function macros if thread support is not selected in board.h */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	19
145 2e9a636d9de9 Merge from eCos master repository on 2000-12-21-14:18:40-GMT jlarmour parents: 138 diff changeset	20 #ifdef __ECOS__
2e9a636d9de9 Merge from eCos master repository on 2000-12-21-14:18:40-GMT jlarmour parents: 138 diff changeset	21 char GDB_stubs_version[] CYGBLD_ATTRIB_WEAK =
2e9a636d9de9 Merge from eCos master repository on 2000-12-21-14:18:40-GMT jlarmour parents: 138 diff changeset	22 "eCos GDB stubs - built " __DATE__ " / " __TIME__;
2e9a636d9de9 Merge from eCos master repository on 2000-12-21-14:18:40-GMT jlarmour parents: 138 diff changeset	23 #endif
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	24
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	25 /****************************************************************************
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	26
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	27 THIS SOFTWARE IS NOT COPYRIGHTED
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	28
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	29 HP offers the following for use in the public domain. HP makes no
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	30 warranty with regard to the software or it's performance and the
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	31 user accepts the software "AS IS" with all faults.
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	32
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	33 HP DISCLAIMS ANY WARRANTIES, EXPRESS OR IMPLIED, WITH REGARD
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	34 TO THIS SOFTWARE INCLUDING BUT NOT LIMITED TO THE WARRANTIES
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	35 OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	36
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	37 ****************************************************************************/
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	38
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	39 /****************************************************************************
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	40 * Header: remcom.c,v 1.34 91/03/09 12:29:49 glenne Exp $
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	41 *
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	42 * Module name: remcom.c $
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	43 * Revision: 1.34 $
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	44 * Date: 91/03/09 12:29:49 $
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	45 * Contributor: Lake Stevens Instrument Division$
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	46 *
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	47 * Description: low level support for gdb debugger. $
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	48 *
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	49 * Considerations: only works on target hardware $
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	50 *
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	51 * Written by: Glenn Engel $
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	52 * ModuleState: Experimental $
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	53 *
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	54 * NOTES: See Below $
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	55 *
64 c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 48 diff changeset	56 * Modified for SPARC by Stu Grossman, Red Hat.
c38311975d4f Merge from eCos master repository on 2000-01-28-04:28:11-GMT jlarmour parents: 48 diff changeset	57 * Modified for generic CygMON stub support by Bob Manson, Red Hat.
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	58 *
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	59 * To enable debugger support, two things need to happen. One, a
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	60 * call to set_debug_traps () is necessary in order to allow any breakpoints
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	61 * or error conditions to be properly intercepted and reported to gdb.
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	62 * Two, a breakpoint needs to be generated to begin communication. This
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	63 * is most easily accomplished by a call to breakpoint (). Breakpoint ()
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	64 * simulates a breakpoint by executing a trap #1.
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	65 *
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	66 *************
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	67 *
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	68 * The following gdb commands are supported:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	69 *
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	70 * command function Return value
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	71 *
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	72 * g return the value of the CPU registers hex data or ENN
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	73 * G set the value of the CPU registers OK or ENN
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	74 *
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	75 * mAA..AA,LLLL Read LLLL bytes at address AA..AA hex data or ENN
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	76 * MAA..AA,LLLL: Write LLLL bytes at address AA.AA OK or ENN
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	77 *
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	78 * c Resume at current address SNN ( signal NN)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	79 * cAA..AA Continue at address AA..AA SNN
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	80 *
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	81 * s Step one instruction SNN
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	82 * sAA..AA Step one instruction from AA..AA SNN
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	83 *
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	84 * k kill
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	85 *
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	86 * ? What was the last sigval ? SNN (signal NN)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	87 *
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	88 * bBB..BB Set baud rate to BB..BB OK or BNN, then sets
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	89 * baud rate
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	90 *
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	91 * All commands and responses are sent with a packet which includes a
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	92 * checksum. A packet consists of
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	93 *
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	94 * $<packet info>#<checksum>.
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	95 *
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	96 * where
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	97 * <packet info> :: <characters representing the command or response>
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	98 * <checksum> :: < two hex digits computed as modulo 256 sum of <packetinfo>>
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	99 *
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	100 * When a packet is received, it is first acknowledged with either '+' or '-'.
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	101 * '+' indicates a successful transfer. '-' indicates a failed transfer.
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	102 *
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	103 * Example:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	104 *
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	105 * Host: Reply:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	106 * $m0,10#2a +$00010203040506070809101112131415#42
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	107 *
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	108 ****************************************************************************/
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	109
48 1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	110 #ifdef __ECOS__
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	111
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	112 // We cannot share memcpy and memset with the rest of the system since
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	113 // the user may want to step through it.
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	114 static inline void*
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	115 memcpy(void* dest, void* src, int size)
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	116 {
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	117 unsigned char* __d = (unsigned char*) dest;
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	118 unsigned char* __s = (unsigned char*) src;
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	119
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	120 while(size--)
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	121 __d++ = __s++;
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	122
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	123 return dest;
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	124 }
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	125
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	126 static inline void*
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	127 memset(void* s, int c, int size)
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	128 {
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	129 unsigned char* __s = (unsigned char*) s;
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	130 unsigned char __c = (unsigned char) c;
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	131
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	132 while(size--)
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	133 *__s++ = __c;
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	134
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	135 return s;
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	136 }
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	137
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	138 #else
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	139 #include <string.h>
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	140 #include <signal.h>
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	141 #endif // __ECOS__
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	142
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	143 /************************************************************************/
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	144 /* BUFMAX defines the maximum number of characters in inbound/outbound buffers*/
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	145 /* at least NUMREGBYTES2 are needed for register packets /
163 0d2b193a635f Merge from eCos master repository on 2001-06-22-17:38:39-BST jlarmour parents: 162 diff changeset	146 #ifdef __ECOS__
0d2b193a635f Merge from eCos master repository on 2001-06-22-17:38:39-BST jlarmour parents: 162 diff changeset	147 #ifdef NUMREGBYTES
0d2b193a635f Merge from eCos master repository on 2001-06-22-17:38:39-BST jlarmour parents: 162 diff changeset	148 #define BUFMAX (32 + (NUMREGBYTES*2))
0d2b193a635f Merge from eCos master repository on 2001-06-22-17:38:39-BST jlarmour parents: 162 diff changeset	149 #else
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	150 #define BUFMAX 2048
163 0d2b193a635f Merge from eCos master repository on 2001-06-22-17:38:39-BST jlarmour parents: 162 diff changeset	151 #endif
0d2b193a635f Merge from eCos master repository on 2001-06-22-17:38:39-BST jlarmour parents: 162 diff changeset	152 #else
0d2b193a635f Merge from eCos master repository on 2001-06-22-17:38:39-BST jlarmour parents: 162 diff changeset	153 #define BUFMAX 2048
0d2b193a635f Merge from eCos master repository on 2001-06-22-17:38:39-BST jlarmour parents: 162 diff changeset	154 #endif
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	155
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	156 static int initialized = 0; /* !0 means we've been initialized */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	157
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	158 static int process_exception (int sigval);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	159 static void do_nothing (void); /* and do it gracefully */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	160 static int syscall_do_nothing (int);
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	161
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	162 void __free_program_args (void);
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	163
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	164 volatile __PFI __process_exception_vec = process_exception;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	165 volatile __PFV __process_exit_vec = do_nothing;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	166 volatile __PFI __process_syscall_vec = syscall_do_nothing;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	167 volatile __PFI __process_signal_vec = NULL;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	168 volatile __PFV __init_vec = NULL;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	169 volatile __PFV __cleanup_vec = NULL;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	170
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	171 static char *__add_program_arg (int argnum, uint32 arglen);
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	172
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	173 static const char hexchars[] = "0123456789abcdef";
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	174
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	175 static void process_query (char *pkt);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	176 static void process_set (char *pkt);
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	177
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	178 char
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	179 __tohex (int c)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	180 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	181 return hexchars [c & 15];
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	182 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	183
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	184 #define __tohex(c) hexchars[(c) & 15]
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	185
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	186 #ifndef NUMREGS_GDB
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	187 #define NUMREGS_GDB NUMREGS
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	188 #endif
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	189
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	190 /* One pushback character. */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	191 int ungot_char = -1;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	192
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	193 static int
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	194 readDebugChar (void)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	195 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	196 if (ungot_char > 0)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	197 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	198 int result = ungot_char;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	199 ungot_char = -1;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	200 return result;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	201 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	202 else
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	203 return getDebugChar ();
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	204 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	205
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	206 /* Convert ch from a hex digit to an int. */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	207
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	208 int
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	209 stubhex (ch)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	210 unsigned char ch;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	211 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	212 if (ch >= 'a' && ch <= 'f')
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	213 return ch-'a'+10;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	214 if (ch >= '0' && ch <= '9')
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	215 return ch-'0';
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	216 if (ch >= 'A' && ch <= 'F')
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	217 return ch-'A'+10;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	218 return -1;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	219 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	220
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	221 static void
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	222 getpacket (buffer)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	223 char *buffer;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	224 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	225 struct gdb_packet packet;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	226
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	227 packet.state = 0;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	228 packet.contents = buffer;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	229 while (__add_char_to_packet (readDebugChar () & 0xff, &packet) != 1)
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	230 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	231 /* Empty */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	232 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	233 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	234
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	235 int
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	236 __add_char_to_packet (ch, packet)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	237 unsigned int ch;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	238 struct gdb_packet *packet;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	239 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	240 if (packet->state == 0)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	241 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	242 if (ch == '$')
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	243 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	244 packet->state = 1;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	245 packet->length = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	246 packet->checksum = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	247 packet->xmitcsum = -1;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	248 }
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	249 return 0;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	250 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	251
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	252 if (packet->state == 1)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	253 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	254 if (ch == '#')
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	255 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	256 packet->contents[packet->length] = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	257 packet->state = 2;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	258 }
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	259 else
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	260 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	261 if (packet->length == BUFMAX) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	262 packet->state = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	263 return -1;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	264 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	265 packet->checksum += ch;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	266 packet->contents[packet->length++] = ch;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	267 }
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	268 return 0;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	269 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	270
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	271 if (packet->state == 2)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	272 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	273 packet->xmitcsum = stubhex (ch) << 4;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	274 packet->state = 3;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	275 return 0;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	276 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	277
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	278 if (packet->state == 3)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	279 {
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	280 packet->xmitcsum \|= stubhex (ch);
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	281 if ((packet->checksum & 255) != packet->xmitcsum)
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	282 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	283 putDebugChar ('-'); /* failed checksum */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	284 packet->state = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	285 return -1;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	286 }
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	287 else
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	288 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	289 putDebugChar ('+'); /* successful transfer */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	290 /* if a sequence char is present, reply the sequence ID */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	291 if (packet->contents[2] == ':')
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	292 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	293 uint32 count = packet->length;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	294 uint32 i;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	295 putDebugChar (packet->contents[0]);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	296 putDebugChar (packet->contents[1]);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	297 /* remove sequence chars from buffer */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	298 for (i=3; i <= count; i++)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	299 packet->contents[i-3] = packet->contents[i];
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	300 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	301 return 1;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	302 }
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	303 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	304 /* We should never get here. */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	305 packet->state = 0;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	306 return -1;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	307 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	308
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	309 /* send the packet in buffer. */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	310
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	311 void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	312 __putpacket (buffer)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	313 char *buffer;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	314 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	315 unsigned char checksum;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	316 uint32 count;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	317 unsigned char ch;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	318
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	319 /* $<packet info>#<checksum>. */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	320 do
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	321 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	322 putDebugChar ('$');
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	323 checksum = 0;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	324 count = 0;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	325
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	326 while ((ch = buffer[count]))
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	327 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	328 putDebugChar (ch);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	329 checksum += ch;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	330 count += 1;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	331 }
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	332
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	333 putDebugChar ('#');
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	334 putDebugChar (hexchars[(checksum >> 4) & 0xf]);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	335 putDebugChar (hexchars[checksum & 0xf]);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	336
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	337 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	338 while ((readDebugChar () & 0x7f) != '+');
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	339 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	340
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	341 static char remcomInBuffer[BUFMAX];
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	342 static char remcomOutBuffer[BUFMAX];
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	343
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	344 /* Indicate to caller of mem2hex or hex2mem that there has been an
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	345 error. */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	346 volatile int __mem_fault = 0;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	347
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	348
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	349 #ifndef TARGET_HAS_OWN_MEM_FUNCS
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	350 /*
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	351 * _target_readmem_hook / _target_writemem_hook:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	352 * Allow target to get involved in reading/writing memory.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	353 *
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	354 * If these hooks are defined by the target, they will be
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	355 * called for each user program memory access. Otherwise, the stub
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	356 * will simply dereference a pointer to access user program memory.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	357 */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	358
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	359 unsigned char (_target_readmem_hook) (unsigned char addr);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	360 void (_target_writemem_hook) (unsigned char addr,
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	361 unsigned char value);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	362
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	363 static unsigned char
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	364 get_target_byte (volatile unsigned char *address)
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	365 {
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	366 if (_target_readmem_hook) /* target needs to control memory access */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	367 return _target_readmem_hook ((unsigned char *) address);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	368 else
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	369 return *address;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	370 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	371
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	372 static void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	373 put_target_byte (volatile unsigned char *address, unsigned char value)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	374 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	375 if (_target_writemem_hook) /* target needs to control memory access */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	376 _target_writemem_hook ((unsigned char *) address, value);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	377 else
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	378 *address = value;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	379 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	380
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	381 /* These are the "arguments" to __do_read_mem and __do_write_mem,
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	382 which are passed as globals to avoid squeezing them thru
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	383 __set_mem_fault_trap. */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	384
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	385 static volatile target_register_t memCount;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	386 static volatile unsigned char memSrc, memDst;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	387
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	388 /*
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	389 * __do_read_mem:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	390 * Copy from target memory to trusted memory.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	391 */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	392
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	393 static void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	394 __do_read_mem (void)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	395 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	396 __mem_fault = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	397 while (memCount)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	398 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	399 unsigned char ch = get_target_byte (memSrc++);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	400
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	401 if (__mem_fault)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	402 return;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	403 *memDst++ = ch;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	404 memCount--;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	405 }
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	406 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	407
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	408 /*
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	409 * __do_write_mem:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	410 * Copy from trusted memory to target memory.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	411 */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	412
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	413 static void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	414 __do_write_mem (void)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	415 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	416 __mem_fault = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	417 while (memCount)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	418 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	419 unsigned char ch = *memSrc++;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	420
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	421 put_target_byte (memDst++, ch);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	422 if (__mem_fault)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	423 return;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	424 memCount--;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	425 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	426 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	427
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	428 /*
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	429 * __read_mem_safe:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	430 * Get contents of target memory, abort on error.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	431 */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	432
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	433 int
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	434 __read_mem_safe (void *dst, target_register_t src, int count)
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	435 {
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	436 memCount = count;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	437 memSrc = (unsigned char *) src;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	438 memDst = (unsigned char *) dst;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	439 __set_mem_fault_trap (__do_read_mem);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	440 return count - memCount; /* return number of bytes successfully read */
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	441 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	442
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	443 /*
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	444 * __write_mem_safe:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	445 * Set contents of target memory, abort on error.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	446 */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	447
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	448 int
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	449 __write_mem_safe (unsigned char *src, target_register_t dst, int count)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	450 {
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	451 memCount = count;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	452 memSrc = (unsigned char *) src;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	453 memDst = (unsigned char *) dst;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	454 __set_mem_fault_trap (__do_write_mem);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	455 return count - memCount; /* return number of bytes successfully read */
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	456 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	457
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	458 #endif /* TARGET_HAS_OWN_MEM_FUNCS */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	459
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	460 /* These are the "arguments" to __mem2hex_helper and __hex2mem_helper,
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	461 which are passed as globals to avoid squeezing them thru
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	462 __set_mem_fault_trap. */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	463
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	464 static int hexMemCount;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	465 static char hexMemSrc, hexMemDst;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	466 static int may_fault_mode;
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	467 #ifdef TARGET_HAS_HARVARD_MEMORY
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	468 static int progMem;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	469 #endif
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	470
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	471 /* Hamburger helper? */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	472 static void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	473 __mem2hex_helper (void)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	474 {
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	475 union {
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	476 unsigned long long_val;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	477 unsigned char bytes[sizeof(long)];
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	478 } val;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	479 int len, i;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	480 unsigned char ch;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	481 __mem_fault = 0;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	482 while (hexMemCount > 0) {
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	483 if (may_fault_mode) {
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	484 if ((hexMemCount >= sizeof(long)) &&
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	485 (((target_register_t)hexMemSrc & (sizeof(long)-1)) == 0)) {
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	486 // Should be safe to access via a long
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	487 len = sizeof(long);
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	488 } else if ((hexMemCount >= sizeof(short)) &&
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	489 (((target_register_t)hexMemSrc & (sizeof(short)-1)) == 0)) {
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	490 // Should be safe to access via a short
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	491 len = sizeof(short);
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	492 } else {
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	493 len = 1;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	494 }
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	495 #ifdef TARGET_HAS_HARVARD_MEMORY
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	496 if (progMem)
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	497 __read_progmem_safe(&val.bytes[0], hexMemSrc, len);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	498 else
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	499 #endif
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	500 __read_mem_safe(&val.bytes[0], hexMemSrc, len);
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	501 } else {
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	502 len = 1;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	503 val.bytes[0] = *hexMemSrc;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	504 }
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	505 if (__mem_fault)
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	506 return;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	507
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	508 for (i = 0; i < len; i++) {
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	509 ch = val.bytes[i];
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	510 *(hexMemDst++) = hexchars[(ch >> 4) & 0xf];
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	511 if (__mem_fault)
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	512 return;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	513 *(hexMemDst++) = hexchars[ch & 0xf];
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	514 if (__mem_fault)
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	515 return;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	516 }
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	517 hexMemCount -= len;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	518 hexMemSrc += len;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	519 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	520 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	521
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	522 /* Convert the memory pointed to by MEM into HEX, placing result in BUF.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	523 * Return a pointer to the last char put in buf (NUL). In case of a memory
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	524 * fault, return 0.
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	525 * If MAY_FAULT is non-zero, then we will handle memory faults by returning
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	526 * a 0 (and assume that MEM is a pointer into the user program), else we
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	527 * treat a fault like any other fault in the stub (and assume that MEM is
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	528 * a pointer into the stub's memory).
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	529 */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	530
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	531 char *
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	532 __mem2hex (mem, buf, count, may_fault)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	533 char *mem;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	534 char *buf;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	535 int count;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	536 int may_fault;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	537 {
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	538 hexMemDst = (unsigned char *) buf;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	539 hexMemSrc = (unsigned char *) mem;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	540 hexMemCount = count;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	541 may_fault_mode = may_fault;
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	542 #ifdef TARGET_HAS_HARVARD_MEMORY
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	543 progMem = 0;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	544 #endif
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	545
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	546 if (may_fault)
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	547 {
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	548 if (__set_mem_fault_trap (__mem2hex_helper))
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	549 return 0;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	550 }
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	551 else
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	552 __mem2hex_helper ();
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	553
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	554 *hexMemDst = 0;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	555
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	556 return (char *) hexMemDst;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	557 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	558
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	559 /* Convert the target memory identified by MEM into HEX, placing result in BUF.
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	560 * Return a pointer to the last char put in buf (NUL). In case of a memory
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	561 * fault, return 0.
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	562 */
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	563
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	564 static char *
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	565 __mem2hex_safe (target_addr_t mem, char *buf, int count)
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	566 {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	567 hexMemDst = (unsigned char *) buf;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	568 hexMemSrc = (unsigned char *) TARGET_ADDR_TO_PTR(mem);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	569 hexMemCount = count;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	570 may_fault_mode = 1;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	571 #ifdef TARGET_HAS_HARVARD_MEMORY
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	572 progMem = TARGET_ADDR_IS_PROGMEM(mem);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	573 #endif
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	574
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	575 if (__set_mem_fault_trap (__mem2hex_helper))
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	576 return 0;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	577
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	578 *hexMemDst = 0;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	579
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	580 return (char *) hexMemDst;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	581 }
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	582
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	583
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	584
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	585 static void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	586 __hex2mem_helper (void)
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	587 {
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	588 union {
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	589 unsigned long long_val;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	590 unsigned char bytes[sizeof(long)];
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	591 } val;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	592 int len, i;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	593 unsigned char ch = '\0';
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	594
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	595 __mem_fault = 0;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	596 while (hexMemCount > 0 && *hexMemSrc) {
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	597 if (may_fault_mode) {
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	598 if ((hexMemCount >= sizeof(long)) &&
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	599 (((target_register_t)hexMemDst & (sizeof(long)-1)) == 0)) {
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	600 len = sizeof(long);
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	601 } else if ((hexMemCount >= sizeof(short)) &&
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	602 (((target_register_t)hexMemDst & (sizeof(short)-1)) == 0)) {
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	603 len = sizeof(short);
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	604 } else {
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	605 len = 1;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	606 }
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	607 } else {
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	608 len = 1;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	609 }
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	610
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	611 for (i = 0; i < len; i++) {
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	612 // Check for short data?
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	613 ch = stubhex (*(hexMemSrc++)) << 4;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	614 if (__mem_fault)
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	615 return;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	616 ch \|= stubhex (*(hexMemSrc++));
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	617 if (__mem_fault)
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	618 return;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	619 val.bytes[i] = ch;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	620 }
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	621
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	622 if (may_fault_mode) {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	623 #ifdef TARGET_HAS_HARVARD_MEMORY
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	624 if (progMem)
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	625 __write_progmem_safe (&val.bytes[0], hexMemDst, len);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	626 else
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	627 #endif
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	628 __write_mem_safe (&val.bytes[0], hexMemDst, len);
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	629 } else
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	630 *hexMemDst = ch;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	631
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	632 if (__mem_fault)
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	633 return;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	634 hexMemCount -= len;
29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	635 hexMemDst += len;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	636 }
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	637 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	638
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	639 /* Convert COUNT bytes of the hex array pointed to by BUF into binary
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	640 to be placed in MEM. Return a pointer to the character AFTER the
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	641 last byte written.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	642
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	643 If MAY_FAULT is set, we will return a non-zero value if a memory
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	644 fault occurs (and we assume that MEM is a pointer into the user
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	645 program). Otherwise, we will take a trap just like any other memory
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	646 fault (and assume that MEM points into the stub's memory). */
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	647
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	648 char *
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	649 __hex2mem (buf, mem, count, may_fault)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	650 char *buf;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	651 char *mem;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	652 int count;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	653 int may_fault;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	654 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	655 hexMemSrc = (unsigned char *) buf;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	656 hexMemDst = (unsigned char *) mem;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	657 hexMemCount = count;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	658 may_fault_mode = may_fault;
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	659 #ifdef TARGET_HAS_HARVARD_MEMORY
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	660 progMem = 0;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	661 #endif
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	662
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	663 if (may_fault)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	664 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	665 if (__set_mem_fault_trap (__hex2mem_helper))
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	666 return 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	667 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	668 else
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	669 __hex2mem_helper ();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	670
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	671 return (char *) hexMemDst;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	672 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	673
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	674 /* Convert COUNT bytes of the hex array pointed to by BUF into binary
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	675 to be placed in target MEM. Return a pointer to the character AFTER
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	676 the last byte written.
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	677 */
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	678 char *
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	679 __hex2mem_safe (char *buf, target_addr_t mem, int count)
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	680 {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	681 hexMemSrc = (unsigned char *) buf;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	682 hexMemDst = (unsigned char *) TARGET_ADDR_TO_PTR(mem);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	683 hexMemCount = count;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	684 may_fault_mode = 1;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	685 #ifdef TARGET_HAS_HARVARD_MEMORY
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	686 progMem = TARGET_ADDR_IS_PROGMEM(mem);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	687 #endif
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	688
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	689 if (__set_mem_fault_trap (__hex2mem_helper))
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	690 return 0;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	691
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	692 return (char *) hexMemDst;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	693 }
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	694
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	695
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	696 void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	697 set_debug_traps (void)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	698 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	699 __install_traps ();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	700 initialized = 1; /* FIXME: Change this to dbg_stub_initialized */
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	701 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	702
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	703 /*
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	704 * While we find nice hex chars, build an int.
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	705 * Return number of chars processed.
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	706 */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	707
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	708 unsigned int
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	709 __hexToInt (char *ptr, target_register_t intValue)
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	710 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	711 int numChars = 0;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	712 int hexValue;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	713
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	714 *intValue = 0;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	715
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	716 while (**ptr)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	717 {
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	718 hexValue = stubhex (**ptr);
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	719 if (hexValue < 0)
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	720 break;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	721
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	722 intValue = (intValue << 4) \| hexValue;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	723 numChars ++;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	724
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	725 (*ptr)++;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	726 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	727
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	728 return (numChars);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	729 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	730
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	731 /*
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	732 * While we find nice hex chars, build a target memory address.
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	733 * Return number of chars processed.
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	734 */
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	735
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	736 unsigned int
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	737 __hexToAddr (char *ptr, target_addr_t val)
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	738 {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	739 int numChars = 0;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	740 int hexValue;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	741
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	742 *val = 0;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	743
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	744 while (**ptr)
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	745 {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	746 hexValue = stubhex (**ptr);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	747 if (hexValue < 0)
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	748 break;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	749
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	750 val = (val << 4) \| hexValue;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	751 numChars ++;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	752
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	753 (*ptr)++;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	754 }
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	755
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	756 return (numChars);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	757 }
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	758
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	759
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	760 /*
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	761 * Complement of __hexToInt: take an int of size "numBits",
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	762 * convert it to a hex string. Return length of (unterminated) output.
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	763 */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	764
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	765 unsigned int
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	766 __intToHex (char *ptr, target_register_t intValue, int numBits)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	767 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	768 int numChars = 0;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	769
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	770 if (intValue == 0)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	771 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	772 *(ptr++) = '0';
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	773 *(ptr++) = '0';
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	774 return 2;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	775 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	776
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	777 numBits = (numBits + 7) / 8;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	778 while (numBits)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	779 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	780 int v = (intValue >> ((numBits - 1) * 8));
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	781 if (v \|\| (numBits == 1))
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	782 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	783 v = v & 255;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	784 *(ptr++) = __tohex ((v / 16) & 15);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	785 *(ptr++) = __tohex (v & 15);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	786 numChars += 2;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	787 }
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	788 numBits--;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	789 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	790
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	791 return (numChars);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	792 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	793
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	794 #if DEBUG_THREADS
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	795 /*
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	796 * Kernel Thread Control
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	797 *
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	798 * If the current thread is set to other than zero (or minus one),
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	799 * then ask the kernel to lock it's scheduler so that only that thread
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	800 * can run.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	801 */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	802
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	803 static unsigned char did_lock_scheduler = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	804 static unsigned char did_disable_interrupts = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	805
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	806 /* Pointer to "kernel call" for scheduler control */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	807 static int (*schedlock_fn) (int, int, long) = stub_lock_scheduler;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	808
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	809 /* Pointer to target stub call for disabling interrupts.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	810 Target stub will initialize this if it can. */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	811 int (__disable_interrupts_hook) (int); / don't initialize here! */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	812 #endif
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	813
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	814 static void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	815 lock_thread_scheduler (int kind) /* "step" or "continue" */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	816 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	817 #if DEBUG_THREADS
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	818 int ret = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	819
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	820 /* GDB will signal its desire to run a single thread
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	821 by setting _gdb_cont_thread to non-zero / non-negative. */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	822 if (_gdb_cont_thread <= 0)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	823 return;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	824
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	825 if (schedlock_fn) /* kernel call */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	826 ret = (*schedlock_fn) (1, kind, _gdb_cont_thread);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	827
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	828 if (ret == 1)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	829 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	830 did_lock_scheduler = 1;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	831 return;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	832 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	833
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	834 if (schedlock_fn == 0 \|\| /* no kernel scheduler call */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	835 ret == -1) /* kernel asks stub to handle it */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	836 if (__disable_interrupts_hook) /* target stub has capability */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	837 if ((*__disable_interrupts_hook) (1))
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	838 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	839 did_disable_interrupts = 1;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	840 return;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	841 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	842 #endif /* DEBUG_THREADS */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	843 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	844
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	845 static void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	846 unlock_thread_scheduler ()
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	847 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	848 #if DEBUG_THREADS
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	849 if (did_lock_scheduler)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	850 if (schedlock_fn) /* kernel call */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	851 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	852 (*schedlock_fn) (0, 0, _gdb_cont_thread);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	853 /* I could check the return value, but
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	854 what would I do if it failed??? */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	855 did_lock_scheduler = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	856 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	857 if (did_disable_interrupts)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	858 if (__disable_interrupts_hook) /* target stub call */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	859 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	860 (*__disable_interrupts_hook) (0);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	861 /* Again, I could check the return value, but
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	862 what would I do if it failed??? */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	863 did_disable_interrupts = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	864 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	865 #endif /* DEBUG_THREADS */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	866 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	867
112 02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	868 #ifdef CYGPKG_CYGMON
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: 112 diff changeset	869 int processing_breakpoint_function = 0;
112 02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	870 #endif
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	871
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	872 void
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	873 __handle_exception (void)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	874 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	875 int sigval;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	876
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	877 #ifdef TARGET_HAS_NEXT_STEP
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	878 if (! __next_step_done ())
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	879 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	880 __clear_breakpoints ();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	881 __install_breakpoints ();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	882 __single_step ();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	883 return;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	884 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	885 #endif
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	886
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	887 #ifdef __ECOS__
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	888 // We need to unpack the registers before they are accessed.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	889 if (__cleanup_vec != NULL)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	890 __cleanup_vec ();
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	891
136 a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 132 diff changeset	892 #if defined(CYGSEM_REDBOOT_BSP_SYSCALLS)
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 132 diff changeset	893 // Temporary support for gnupro bsp SWIs
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 132 diff changeset	894 if (__is_bsp_syscall())
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 132 diff changeset	895 {
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 132 diff changeset	896 if (hal_syscall_handler() == 0)
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 132 diff changeset	897 {
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 132 diff changeset	898 if (__init_vec != NULL)
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 132 diff changeset	899 __init_vec ();
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 132 diff changeset	900 return;
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 132 diff changeset	901 }
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 132 diff changeset	902 }
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 132 diff changeset	903 #endif
a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 132 diff changeset	904
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	905 #ifdef CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	906 // Special case for GDB BREAKs. This flag is set by cyg_stub_cleanup.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	907 if (cyg_hal_gdb_break) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	908 cyg_hal_gdb_break = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	909 sigval = SIGINT;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	910 } else
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	911 #endif
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	912 sigval = __computeSignal (__get_trap_number ());
136 a9ac27ec7abc Merge from eCos master repository on 2000-11-17-18:24:25-GMT jlarmour parents: 132 diff changeset	913
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	914 #else // __ECOS__
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	915 /* reply to host that an exception has occurred */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	916 sigval = __computeSignal (__get_trap_number ());
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	917 #endif // __ECOS__
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	918
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	919 if (__is_breakpoint_function ())
112 02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	920 {
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	921 #ifdef CYGPKG_CYGMON
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	922 processing_breakpoint_function = 1;
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	923 #endif
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	924 __skipinst ();
112 02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	925 } else {
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	926 #ifdef CYGPKG_CYGMON
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	927 processing_breakpoint_function = 0;
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	928 #endif
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	929 }
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	930
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	931 #ifndef __ECOS__
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	932 if (__cleanup_vec != NULL)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	933 __cleanup_vec ();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	934 #endif // !__ECOS__
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	935
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	936 __clear_breakpoints ();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	937
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	938 /* Undo effect of previous single step. */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	939 unlock_thread_scheduler ();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	940 __clear_single_step ();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	941
48 1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	942 #ifdef __ECOS__
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	943 /* Need to flush the data and instruction cache here, as we may have
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	944 removed a breakpoint in __single_step - and we may be sharing
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	945 some code with the application! */
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	946
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	947 __data_cache (CACHE_FLUSH) ;
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	948 __instruction_cache (CACHE_FLUSH) ;
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	949 #endif
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	950
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	951 #ifdef SIGSYSCALL
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	952 if (sigval == SIGSYSCALL)
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	953 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	954 int val;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	955 /* Do the skipinst FIRST. */
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	956 #ifndef SYSCALL_PC_AFTER_INST
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	957 __skipinst ();
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	958 #endif
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	959 val = __process_syscall_vec (__get_syscall_num ());
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	960 if (val < 0)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	961 sigval = -val;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	962 else
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	963 sigval = 0;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	964 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	965
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	966 #endif
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	967
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	968 /* Indirect function call to stub, cygmon monitor or other */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	969 if (sigval != 0)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	970 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	971 while (__process_exception_vec (sigval))
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	972 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	973 /* Empty! */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	974 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	975 }
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	976
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	977 __install_breakpoints ();
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	978
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	979 if (__init_vec != NULL)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	980 __init_vec ();
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	981 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	982
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	983 /*
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	984 * _get_trace_register_hook:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	985 * This function pointer will be non-zero if the trace component
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	986 * wants to intercept requests for register values.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	987 *
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	988 * FIXME: evidently I need a new hook for large registers...
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	989 */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	990
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	991 int (_get_trace_register_hook) (regnames_t, target_register_t );
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	992
46 797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	993 void
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	994 stub_format_registers(char *ptr)
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	995 {
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	996 int regnum;
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	997
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	998 for (regnum = 0; regnum < NUMREGS_GDB; regnum++) {
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	999 /* We need to compensate for the value offset within the
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1000 register. */
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1001 char dummyDat[32];
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1002 target_register_t addr;
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1003 char *vptr;
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1004 int reg_valid = 1;
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1005
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1006 #ifdef TARGET_HAS_LARGE_REGISTERS
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1007 if (sizeof (target_register_t) < REGSIZE (regnum)) {
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1008 get_register_as_bytes (regnum, dummyDat);
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1009 vptr = dummyDat;
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1010 } else
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1011 #endif
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1012 {
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1013 if (_get_trace_register_hook)
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1014 reg_valid = _get_trace_register_hook (regnum, &addr);
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1015 else
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: 112 diff changeset	1016 {
46 797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1017 addr = get_register (regnum);
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: 112 diff changeset	1018 #ifdef CYGHWR_REGISTER_VALIDITY_CHECKING
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: 112 diff changeset	1019 reg_valid = get_register_valid (regnum);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: 112 diff changeset	1020 #endif
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: 112 diff changeset	1021 }
46 797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1022 vptr = ((char *) &addr);
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1023 if (sizeof (addr) > REGSIZE(regnum)) {
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1024 /* May need to cope with endian-ness */
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1025
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1026 #if !defined(__LITTLE_ENDIAN__) && !defined(_LITTLE_ENDIAN)
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1027 vptr += sizeof (addr) - REGSIZE (regnum);
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1028 #endif
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1029 } else if (sizeof (addr) < REGSIZE (regnum)) {
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1030 int off = REGSIZE (regnum) - sizeof (addr);
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1031 int x;
112 02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	1032 char extend_val = 0;
46 797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1033
121 6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 115 diff changeset	1034 #ifdef CYGARC_SIGN_EXTEND_REGISTERS
112 02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	1035 {
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	1036 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: 78 diff changeset	1037 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: 78 diff changeset	1038 if ((addr & sign_bit_mask) == sign_bit_mask)
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	1039 extend_val = ~0;
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	1040 }
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	1041 #endif
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	1042
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	1043 #if defined(__LITTLE_ENDIAN__) \|\| defined(_LITTLE_ENDIAN)
46 797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1044 for (x = 0; x < off; x++)
112 02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	1045 dummyDat[x + sizeof(addr)] = extend_val;
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	1046 memcpy (dummyDat, &addr, sizeof (addr));
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	1047 #else
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	1048 for (x = 0; x < off; x++)
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	1049 dummyDat[x] = extend_val;
46 797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1050 memcpy (dummyDat + off, &addr, sizeof (addr));
112 02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	1051 #endif
46 797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1052 vptr = dummyDat;
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1053 }
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1054 }
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1055 if (reg_valid) { /* we have a valid reg value */
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1056 ptr = __mem2hex (vptr, ptr, REGSIZE (regnum), 0);
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1057 } else {
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1058 /* Trace component returned a failure code.
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1059 This means that the register value is not available.
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1060 We'll fill it with 'x's, and GDB will understand. */
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1061 memset (ptr, 'x', 2 * REGSIZE (regnum));
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1062 ptr += 2 * REGSIZE (regnum);
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1063 }
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1064 }
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1065 }
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1066
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1067 void
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1068 stub_update_registers(char in_ptr, char out_ptr)
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1069 {
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1070 char *ptr = &in_ptr[1];
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1071 int x;
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1072 int sr = 0, er = NUMREGS_GDB;
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1073
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1074 if (*in_ptr == 'P') {
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1075 target_register_t regno;
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1076
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1077 if (__hexToInt (&ptr, &regno) && (*ptr++ == '=')) {
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1078
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1079 sr = regno;
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1080 er = regno + 1;
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1081 } else {
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1082 strcpy (out_ptr, "P01");
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1083 return;
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1084 }
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1085 }
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1086
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1087 for (x = sr; x < er; x++) {
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1088 target_register_t value = 0;
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1089 char *vptr;
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1090
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1091 #ifdef TARGET_HAS_LARGE_REGISTERS
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1092 if (sizeof (target_register_t) < REGSIZE (x)) {
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1093 char dummyDat [32];
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1094
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1095 __hex2mem (ptr, dummyDat, REGSIZE (x), 0);
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1096 put_register_as_bytes (x, dummyDat);
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1097 } else
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1098 #endif
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1099 {
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1100 vptr = ((char *) &value);
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1101 #if !defined(__LITTLE_ENDIAN__) && !defined(_LITTLE_ENDIAN)
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1102 vptr += sizeof (value) - REGSIZE (x);
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1103 #endif
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1104 __hex2mem (ptr, vptr, REGSIZE (x), 0);
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1105 put_register (x, value);
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1106 }
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1107 ptr += REGSIZE (x) * 2;
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1108 }
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1109
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1110 strcpy (out_ptr, "OK");
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1111 }
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1112
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1113 int
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1114 __process_packet (char *packet)
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1115 {
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1116 int is_binary = 0;
132 0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1117 #if defined(CYGNUM_HAL_BREAKPOINT_LIST_SIZE)
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1118 int is_Z = 0;
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1119 #endif
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1120
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1121 remcomOutBuffer[0] = 0;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1122 switch (packet[0])
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1123 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1124 case '?':
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1125 {
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1126 int sigval = __computeSignal (__get_trap_number ());
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1127 remcomOutBuffer[0] = 'S';
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1128 remcomOutBuffer[1] = hexchars[(sigval >> 4) & 0xf];
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1129 remcomOutBuffer[2] = hexchars[sigval & 0xf];
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1130 remcomOutBuffer[3] = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1131 break;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1132 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1133
38 e7ba79f6d3a8 Merge from eCos master repository on 1999-09-23-20:10:25-BST jlarmour parents: 34 diff changeset	1134 #ifdef __ECOS__
e7ba79f6d3a8 Merge from eCos master repository on 1999-09-23-20:10:25-BST jlarmour parents: 34 diff changeset	1135 #if !defined(CYG_HAL_STARTUP_RAM) // Only for ROM based stubs
132 0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1136 #if 0 // Disable to avoid conflict with stub-breakpoint z/Z-packets
78 59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 64 diff changeset	1137 case 'z':
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 64 diff changeset	1138 /* report IO buffer sizes so download can achieve optimal
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 64 diff changeset	1139 download speed */
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 64 diff changeset	1140 {
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 64 diff changeset	1141 int i;
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 64 diff changeset	1142 i = __intToHex (remcomOutBuffer, BUFMAX, 32);
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 64 diff changeset	1143 remcomOutBuffer[i] = 0;
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 64 diff changeset	1144 break;
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 64 diff changeset	1145 }
132 0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1146 #endif
78 59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 64 diff changeset	1147 case 'd':
59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 64 diff changeset	1148 /* toggle debug flag */
145 2e9a636d9de9 Merge from eCos master repository on 2000-12-21-14:18:40-GMT jlarmour parents: 138 diff changeset	1149 strcpy(remcomOutBuffer, GDB_stubs_version);
78 59d97b6ba612 Merge from eCos master repository on 2000-03-28-19:50:47-BST jlarmour parents: 64 diff changeset	1150 break;
38 e7ba79f6d3a8 Merge from eCos master repository on 1999-09-23-20:10:25-BST jlarmour parents: 34 diff changeset	1151 #endif
e7ba79f6d3a8 Merge from eCos master repository on 1999-09-23-20:10:25-BST jlarmour parents: 34 diff changeset	1152 #endif // __ECOS__
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1153
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1154 case 'q':
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1155 /* general query packet */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1156 process_query (&packet[1]);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1157 break;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1158
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1159 case 'Q':
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1160 /* general set packet */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1161 process_set (&packet[1]);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1162 break;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1163
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1164 case 'g': /* return the value of the CPU registers */
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1165 {
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1166 char *ptr = remcomOutBuffer;
46 797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1167 stub_format_registers(ptr);
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1168 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1169 }
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1170
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1171 case 'A': /* set program arguments */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1172 {
163 0d2b193a635f Merge from eCos master repository on 2001-06-22-17:38:39-BST jlarmour parents: 162 diff changeset	1173 #ifdef CYGSEM_ECOS_SUPPORTS_PROGRAM_ARGS
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1174 if (packet[1] == '\0')
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1175 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1176 __free_program_args ();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1177 strcpy (remcomOutBuffer, "OK");
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1178 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1179 else
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1180 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1181 target_register_t arglen, argnum;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1182 char *ptr = &packet[1];
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1183
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1184 while (1)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1185 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1186 if (__hexToInt (&ptr, &arglen)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1187 && (*ptr++ == ',')
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1188 && __hexToInt (&ptr, &argnum)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1189 && (*ptr++ == ','))
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1190 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1191 if (arglen > 0)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1192 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1193 char *s = __add_program_arg (argnum, arglen);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1194 if (s != NULL)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1195 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1196 __hex2mem (ptr, s, arglen, 0);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1197 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1198 ptr += arglen * 2;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1199 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1200
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1201 if (*ptr == ',')
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1202 ptr++;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1203 else
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1204 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1205 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1206 else
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1207 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1208 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1209 if (*ptr == '\0')
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1210 strcpy (remcomOutBuffer, "OK");
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1211 else
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1212 strcpy (remcomOutBuffer, "E01");
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1213 }
163 0d2b193a635f Merge from eCos master repository on 2001-06-22-17:38:39-BST jlarmour parents: 162 diff changeset	1214 #else
0d2b193a635f Merge from eCos master repository on 2001-06-22-17:38:39-BST jlarmour parents: 162 diff changeset	1215 strcpy (remcomOutBuffer, "E01");
0d2b193a635f Merge from eCos master repository on 2001-06-22-17:38:39-BST jlarmour parents: 162 diff changeset	1216 #endif
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1217 }
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1218 break;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1219
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1220 case 'P':
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1221 case 'G': /* set the value of the CPU registers - return OK */
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1222 {
46 797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1223 char *in_ptr = &packet[0];
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1224 char *out_ptr = remcomOutBuffer;
797268ecc331 Merge from eCos master repository on 1999-10-19-18:55:31-BST jlarmour parents: 38 diff changeset	1225 stub_update_registers(in_ptr, out_ptr);
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1226 break;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1227 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1228
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1229 case 'm': /* mAA..AA,LLLL Read LLLL bytes at address AA..AA */
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1230 /* Try to read %x,%x. */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1231 {
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1232 target_register_t length;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1233 char *ptr = &packet[1];
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1234 target_addr_t addr;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1235
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1236 if (__hexToAddr (&ptr, &addr)
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1237 && *ptr++ == ','
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1238 && __hexToInt (&ptr, &length))
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1239 {
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1240 if (__mem2hex_safe (addr, remcomOutBuffer, length))
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1241 break;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1242
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1243 strcpy (remcomOutBuffer, "E03");
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1244 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1245 else
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1246 strcpy (remcomOutBuffer, "E01");
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1247 break;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1248 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1249
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1250 case 'X':
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1251 /* XAA..AA,LLLL: Write LLLL escaped binary bytes at address AA.AA */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1252 is_binary = 1;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1253 /* fall through */
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1254 case 'M': /* MAA..AA,LLLL: Write LLLL bytes at address AA.AA return OK */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1255 /* Try to read '%x,%x:'. */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1256 {
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1257 target_register_t length;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1258 char *ptr = &packet[1], buf[128];
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1259 int i;
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1260 target_addr_t addr;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1261
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1262 if (__hexToAddr (&ptr, &addr)
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1263 && *ptr++ == ','
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1264 && __hexToInt (&ptr, &length)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1265 && *ptr++ == ':')
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1266 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1267 if (is_binary)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1268 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1269 while (length > 0)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1270 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1271 for (i = 0; i < sizeof(buf) && i < length; i++)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1272 if ((buf[i] = *ptr++) == 0x7d)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1273 buf[i] = 0x20 \| (*ptr++ & 0xff);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1274
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1275 #ifdef TARGET_HAS_HARVARD_MEMORY
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1276 if (TARGET_ADDR_IS_PROGMEM(addr)) {
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1277 if (__write_progmem_safe (buf, (void *)TARGET_ADDR_TO_PTR(addr), i) != i)
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1278 break;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1279 } else
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1280 #endif
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1281 if (__write_mem_safe (buf, (void *)TARGET_ADDR_TO_PTR(addr), i) != i)
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1282 break;
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1283
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1284
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1285 length -= i;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1286 addr += i;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1287 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1288 if (length <= 0)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1289 strcpy (remcomOutBuffer, "OK");
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1290 else
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1291 strcpy (remcomOutBuffer, "E03");
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1292 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1293 else
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1294 {
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1295 if (__hex2mem_safe (ptr, addr, length) != NULL)
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1296 strcpy (remcomOutBuffer, "OK");
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1297 else
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1298 strcpy (remcomOutBuffer, "E03");
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1299 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1300 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1301 else
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1302 strcpy (remcomOutBuffer, "E02");
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1303 break;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1304 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1305
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1306 case 'S':
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1307 case 's': /* sAA..AA Step from address AA..AA (optional) */
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1308 case 'C':
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1309 case 'c': /* cAA..AA Continue at address AA..AA (optional) */
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1310 /* try to read optional parameter, pc unchanged if no parm */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1311
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1312 {
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1313 char *ptr = &packet[1];
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1314 target_addr_t addr;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1315 target_register_t sigval = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1316
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1317 if (packet[0] == 'C' \|\| packet[0] == 'S')
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1318 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1319 __hexToInt (&ptr, &sigval);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1320 if (*ptr == ';')
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1321 ptr++;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1322 }
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1323
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1324 if (__hexToAddr (&ptr, &addr))
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1325 set_pc ((target_register_t)TARGET_ADDR_TO_PTR(addr));
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1326
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1327 /* Need to flush the instruction cache here, as we may have
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1328 deposited a breakpoint, and the icache probably has no way of
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1329 knowing that a data ref to some location may have changed
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1330 something that is in the instruction cache. */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1331
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1332 #ifdef __ECOS__
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1333 __data_cache (CACHE_FLUSH) ;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1334 #endif
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1335 __instruction_cache (CACHE_FLUSH) ;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1336
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1337 /* If we have a function to handle signals, call it. */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1338 if (sigval != 0 && __process_signal_vec != NULL)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1339 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1340 /* If 0 is returned, we either ignored the signal or invoked a user
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1341 handler. Otherwise, the user program should die. */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1342 if (! __process_signal_vec (sigval))
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1343 sigval = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1344 }
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1345
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1346 if (sigval != 0)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1347 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1348 sigval = SIGKILL; /* Always nuke the program */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1349 __kill_program (sigval);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1350 return 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1351 }
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1352
48 1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	1353 #ifdef __ECOS__
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	1354 // CASE 102327 - watchpoints fight with output, so do not step
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	1355 // through $O packet output routines.
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	1356 #ifdef CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	1357 if ( cyg_hal_gdb_break_is_set() ) {
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	1358 packet[0] = 'c'; // Force it to be a "continue" instead of step.
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	1359 cyg_hal_gdb_running_step = 1; // And tell the hal_stub...
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	1360 }
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	1361 #endif
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	1362 #endif
1370c5e55234 Merge from eCos master repository on 1999-10-25-21:18:27-BST jlarmour parents: 46 diff changeset	1363
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1364 /* Set machine state to force a single step. */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1365 if (packet[0] == 's' \|\| packet[0] == 'S')
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1366 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1367 lock_thread_scheduler (0); /* 0 == single-step */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1368 #ifdef __ECOS__
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1369 // PR 19845 workaround:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1370 // Make sure the single-step magic affects the correct registers.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1371 _registers = &registers[0];
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1372 #endif
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1373 __single_step ();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1374 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1375 else
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1376 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1377 lock_thread_scheduler (1); /* 1 == continue */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1378 }
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1379
28 18ee5a9c102e Merge from eCos master repository on 1999-08-09-17:04:48-BST jlarmour parents: 2 diff changeset	1380 #ifdef __ECOS__
18ee5a9c102e Merge from eCos master repository on 1999-08-09-17:04:48-BST jlarmour parents: 2 diff changeset	1381 /* Need to flush the data and instruction cache here, as we may have
18ee5a9c102e Merge from eCos master repository on 1999-08-09-17:04:48-BST jlarmour parents: 2 diff changeset	1382 deposited a breakpoint in __single_step. */
18ee5a9c102e Merge from eCos master repository on 1999-08-09-17:04:48-BST jlarmour parents: 2 diff changeset	1383
18ee5a9c102e Merge from eCos master repository on 1999-08-09-17:04:48-BST jlarmour parents: 2 diff changeset	1384 __data_cache (CACHE_FLUSH) ;
18ee5a9c102e Merge from eCos master repository on 1999-08-09-17:04:48-BST jlarmour parents: 2 diff changeset	1385 __instruction_cache (CACHE_FLUSH) ;
138 289bf90c6a9b Merge from eCos master repository on 2000-11-24-06:43:05-GMT jlarmour parents: 136 diff changeset	1386 hal_flush_output();
28 18ee5a9c102e Merge from eCos master repository on 1999-08-09-17:04:48-BST jlarmour parents: 2 diff changeset	1387 #endif
18ee5a9c102e Merge from eCos master repository on 1999-08-09-17:04:48-BST jlarmour parents: 2 diff changeset	1388
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1389 return -1;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1390 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1391
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1392 /* kill the program */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1393 case 'k' :
138 289bf90c6a9b Merge from eCos master repository on 2000-11-24-06:43:05-GMT jlarmour parents: 136 diff changeset	1394 #ifdef __ECOS__
289bf90c6a9b Merge from eCos master repository on 2000-11-24-06:43:05-GMT jlarmour parents: 136 diff changeset	1395 hal_flush_output();
289bf90c6a9b Merge from eCos master repository on 2000-11-24-06:43:05-GMT jlarmour parents: 136 diff changeset	1396 #endif
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1397 __process_exit_vec ();
154 e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	1398 return -1;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1399
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1400 case 'r': /* Reset */
154 e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	1401 #ifdef __ECOS__
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	1402 __putpacket (remcomOutBuffer);
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	1403 hal_flush_output();
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 151 diff changeset	1404 #endif
162 2395031e7a66 Merge from eCos master repository on 2001-06-15-06:43:03-BST jlarmour parents: 156 diff changeset	1405 /* With the next 'k' packet, reset the board */
2395031e7a66 Merge from eCos master repository on 2001-06-15-06:43:03-BST jlarmour parents: 156 diff changeset	1406 __process_exit_vec = &__reset;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1407 break;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1408
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1409 case 'H':
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1410 STUB_PKT_CHANGETHREAD (packet+1, remcomOutBuffer, 300) ;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1411 break ;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1412 case 'T' :
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1413 STUB_PKT_THREAD_ALIVE (packet+1, remcomOutBuffer, 300) ;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1414 break ;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1415 case 'B':
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1416 /* breakpoint */
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1417 {
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1418 target_register_t addr;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1419 char mode;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1420 char *ptr = &packet[1];
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1421 if (__hexToInt (&ptr, &addr) && *(ptr++) == ',')
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1422 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1423 mode = *(ptr++);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1424 if (mode == 'C')
151 25e238959bae Merge from eCos master repository on 2001-02-12-23:44:24-GMT jlarmour parents: 145 diff changeset	1425 __remove_breakpoint (addr,0);
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1426 else
151 25e238959bae Merge from eCos master repository on 2001-02-12-23:44:24-GMT jlarmour parents: 145 diff changeset	1427 __set_breakpoint (addr,0);
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1428 strcpy (remcomOutBuffer, "OK");
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1429 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1430 else
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1431 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1432 strcpy (remcomOutBuffer, "E01");
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1433 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1434 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1435 }
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1436
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1437 case 'b': /* bBB... Set baud rate to BB... */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1438 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1439 target_register_t baudrate;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1440
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1441 char *ptr = &packet[1];
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1442 if (!__hexToInt (&ptr, &baudrate))
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1443 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1444 strcpy (remcomOutBuffer, "B01");
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1445 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1446 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1447
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1448 __putpacket ("OK"); /* Ack before changing speed */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1449 __set_baud_rate (baudrate);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1450 break;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1451 }
132 0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1452
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1453 #if defined(CYGNUM_HAL_BREAKPOINT_LIST_SIZE) && (CYGNUM_HAL_BREAKPOINT_LIST_SIZE > 0)
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1454 case 'Z':
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1455 is_Z = 1;
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1456 case 'z':
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1457 {
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1458 char *ptr = &packet[1];
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1459 target_register_t ztype, addr, length;
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1460 int err;
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1461 target_addr_t taddr;
132 0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1462
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1463 if (__hexToInt (&ptr, &ztype) && *(ptr++) == ',')
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1464 {
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1465 if (__hexToAddr (&ptr, &taddr))
132 0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1466 {
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1467 if (*(ptr++) == ',')
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1468 {
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1469 /* When there is a comma, there must be a length */
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1470 if (!__hexToInt (&ptr, &length))
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1471 {
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1472 strcpy (remcomOutBuffer, "E02");
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1473 break;
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1474 }
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1475 }
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1476 else
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1477 length = 0;
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1478
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1479 addr = (target_register_t)TARGET_ADDR_TO_PTR(taddr);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1480
132 0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1481 switch (ztype)
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1482 {
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1483 case 0:
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1484 /* sw breakpoint */
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1485 if (is_Z)
151 25e238959bae Merge from eCos master repository on 2001-02-12-23:44:24-GMT jlarmour parents: 145 diff changeset	1486 err = __set_breakpoint(addr,length);
132 0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1487 else
151 25e238959bae Merge from eCos master repository on 2001-02-12-23:44:24-GMT jlarmour parents: 145 diff changeset	1488 err = __remove_breakpoint(addr,length);
132 0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1489 if (!err)
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1490 strcpy (remcomOutBuffer, "OK");
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1491 else
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1492 strcpy (remcomOutBuffer, "E02");
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1493 break;
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1494 #ifdef HAL_STUB_HW_BREAKPOINT
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1495 case 1:
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1496 /* hw breakpoint */
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1497 if (!HAL_STUB_HW_BREAKPOINT(is_Z, (void *)addr, length))
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1498 strcpy (remcomOutBuffer, "OK");
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1499 else
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1500 strcpy (remcomOutBuffer, "E02");
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1501 break;
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1502 #endif
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1503 #ifdef HAL_STUB_HW_WATCHPOINT
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1504 case 2:
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1505 case 3:
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1506 case 4:
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1507 {
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1508 /* hw watchpoint */
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1509 if (!HAL_STUB_HW_WATCHPOINT(is_Z, (void *)addr, length, ztype))
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1510 strcpy (remcomOutBuffer, "OK");
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1511 else
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1512 strcpy (remcomOutBuffer, "E02");
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1513 }
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1514 break;
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1515 #endif
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1516 }
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1517 }
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1518 }
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1519 break;
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1520 }
0ae0bc38e387 Merge from eCos master repository on 2000-10-31-00:30:36-GMT jlarmour parents: 130 diff changeset	1521 #endif // Z packet support
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1522 default:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1523 __process_target_packet (packet, remcomOutBuffer, 300);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1524 break;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1525 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1526
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1527 /* reply to the request */
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1528 __putpacket (remcomOutBuffer);
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1529 return 0;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1530 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1531
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1532 static void
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1533 send_t_packet (int sigval)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1534 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1535 __build_t_packet (sigval, remcomOutBuffer);
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1536 __putpacket (remcomOutBuffer);
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1537 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1538
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1539 /*
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1540 * This function does all command procesing for interfacing to gdb.
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1541 */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1542
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1543 static int
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1544 process_exception (int sigval)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1545 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1546 int status;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1547
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1548 /* Nasty. */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1549 if (ungot_char < 0)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1550 send_t_packet (sigval);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1551
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1552 do {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1553 getpacket (remcomInBuffer);
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1554 status = __process_packet (remcomInBuffer);
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1555 } while (status == 0);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1556
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1557 if (status < 0)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1558 return 0;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1559 else
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1560 return 1;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1561 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1562
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1563 void
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1564 __send_exit_status (int status)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1565 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1566 remcomOutBuffer[0] = 'W';
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1567 remcomOutBuffer[1] = hexchars[(status >> 4) & 0xf];
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1568 remcomOutBuffer[2] = hexchars[status & 0xf];
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1569 remcomOutBuffer[3] = 0;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1570 __putpacket (remcomOutBuffer);
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1571 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1572
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1573 /* Read up to MAXLEN bytes from the remote GDB client, and store in DEST
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1574 (which is a pointer in the user program). BLOCK indicates what mode
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1575 is being used; if it is set, we will wait for MAXLEN bytes to be
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1576 entered. Otherwise, the function will return immediately with whatever
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1577 bytes are waiting to be read.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1578
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1579 The value returned is the number of bytes read. A -1 indicates that an
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1580 error of some sort occurred. */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1581
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1582 int
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1583 __get_gdb_input (target_register_t dest, int maxlen, int block)
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1584 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1585 char buf[4];
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1586 int len, i;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1587 char d;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1588
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1589 buf[0] = 'I';
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1590 buf[1] = '0';
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1591 buf[2] = block ? '0' : '1';
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1592 buf[3] = 0;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1593 __putpacket (buf);
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1594 getpacket (remcomInBuffer);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1595 if (remcomInBuffer[0] != 'I')
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1596 return -1;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1597 len = stubhex (remcomInBuffer[1]) * 16 + stubhex (remcomInBuffer[2]);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1598 for (i = 0; i < len; i++)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1599 {
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1600 d = stubhex (remcomInBuffer[3 + i * 2]) * 16;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1601 d \|= stubhex (remcomInBuffer[3 + i * 2 + 1]);
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	1602 __write_mem_safe (&d, (void *)(dest + i), 1);
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1603 }
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1604 /* Write the trailing \0. */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1605 d = '\0';
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	1606 __write_mem_safe (&d, (void *)(dest + i), 1);
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1607 return len;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1608 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1609
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1610 void
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1611 __output_hex_value (target_register_t i)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1612 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1613 char buf[32], *ptr=buf+31;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1614 unsigned int x;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1615
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1616 *ptr = 0;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1617 for (x = 0; x < (sizeof (i) * 2); x++)
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1618 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1619 *(--ptr) = hexchars[i & 15];
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1620 i = i >> 4;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1621 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1622 while (*ptr)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1623 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1624 putDebugChar (*(ptr++));
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1625 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1626 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1627
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1628 /* Write the C-style string pointed to by STR to the GDB comm port. */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1629 void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1630 __putDebugStr (char *str)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1631 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1632 while (*str)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1633 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1634 putDebugChar (*str);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1635 str++;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1636 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1637 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1638
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1639 /* Send STRING_LEN bytes of STR to GDB, using 'O' packets.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1640 STR is assumed to be in the program being debugged. */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1641
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1642 int
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1643 __output_gdb_string (target_register_t str, int string_len)
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1644 {
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1645 /* We will arbitrarily limit output packets to less than 400 bytes. */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1646 static char buf[400];
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1647 int x;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1648 int len;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1649
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1650 if (string_len == 0)
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1651 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1652 /* We can't do strlen on a user pointer. */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1653 return -1;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1654 }
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1655
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1656 len = string_len;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1657 while (len > 0)
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1658 {
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1659 int packetlen = ((len < 175) ? len : 175);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1660 buf[0] = 'O';
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1661 for (x = 0; x < packetlen; x++)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1662 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1663 char c;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1664
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	1665 __read_mem_safe (&c, (void *)(str + x), 1);
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1666 buf[x*2+1] = hexchars[(c >> 4) & 0xf];
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1667 buf[x*2+2] = hexchars[c % 16];
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1668 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1669 str += x;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1670 len -= x;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1671 buf[x*2+1] = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1672 __putpacket (buf);
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1673 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1674 return string_len;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1675 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1676
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1677 static void
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1678 do_nothing (void)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1679 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1680 /* mmmm */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1681 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1682
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1683 static int
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1684 syscall_do_nothing (int junk)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1685 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1686 return 0;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1687 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1688
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1689 /* Start the stub running. */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1690 void
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1691 __switch_to_stub (void)
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1692 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1693 __process_exception_vec = process_exception;
112 02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	1694 #ifdef CYGPKG_CYGMON
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	1695 // Cygmon will have consumed the '$' character for this packet.
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	1696 // Let's put one in the unget buffer.
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	1697 // Actually, Cygmon does an unget, but since it uses different
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	1698 // unget handling, we need to do this here.
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	1699 ungetDebugChar('$');
02ea4320376c Merge from eCos master repository on 2000-07-21-21:01:39-BST jlarmour parents: 78 diff changeset	1700 #endif
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1701 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1702
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1703 #if ! defined(BOARD_SPECIFIC_STUB_INIT)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1704 void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1705 initialize_stub (void)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1706 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1707 set_debug_traps ();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1708 /* FIXME: This function should be renamed to specifically init the
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1709 hardware required by debug operations. If initHardware is implemented at
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1710 all, it should be called before main ().
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1711 */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1712 initHardware () ;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1713 /* This acks any stale packets , NOT an effective solution */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1714 putDebugChar ('+');
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1715 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1716 #endif
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1717
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1718 void
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1719 ungetDebugChar (int c)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1720 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1721 ungot_char = c;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1722 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1723
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1724 void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1725 __kill_program (int sigval)
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1726 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1727 remcomOutBuffer[0] = 'X';
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1728 remcomOutBuffer[1] = hexchars[(sigval >> 4) & 15];
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1729 remcomOutBuffer[2] = hexchars[sigval & 15];
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1730 remcomOutBuffer[3] = 0;
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1731 __putpacket (remcomOutBuffer);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1732 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1733
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1734 #define MAX_ARG_COUNT 20
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1735 #define MAX_ARGDATA 128
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1736
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1737 static char *program_argv [MAX_ARG_COUNT];
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1738 static int program_argc;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1739 static int last_program_arg;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1740 static char program_argstr [MAX_ARGDATA], *argptr;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1741 static int args_initted = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1742
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1743 void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1744 __free_program_args (void)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1745 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1746 last_program_arg = -1;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1747 program_argc = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1748 program_argv [0] = NULL;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1749 argptr = program_argstr;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1750 args_initted = 1;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1751 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1752
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1753 static char *
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1754 __add_program_arg (int argc, uint32 len)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1755 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1756 char *res;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1757
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1758 if (! args_initted)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1759 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1760 __free_program_args ();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1761 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1762
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1763 if ((argc >= (MAX_ARG_COUNT - 1))
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1764 \|\| ((argptr - program_argstr + len) > MAX_ARGDATA))
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1765 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1766 return NULL;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1767 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1768
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1769 if (argc != last_program_arg)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1770 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1771 if (argc >= program_argc)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1772 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1773 program_argc = argc + 1;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1774 program_argv [program_argc] = NULL;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1775 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1776 program_argv [argc] = argptr;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1777 last_program_arg = argc;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1778 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1779
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1780 res = argptr;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1781 argptr += len;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1782
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1783 return res;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1784 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1785
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1786 void
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1787 __set_program_args (int argc, char **argv)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1788 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1789 int x;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1790
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1791 __free_program_args ();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1792 if (argc)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1793 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1794 for (x = 0; x < argc; x++)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1795 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1796 uint32 len = strlen (argv[x])+1;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1797 char *s = __add_program_arg (x, len);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1798
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1799 if (s == NULL)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1800 return;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1801
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1802 memcpy (s, argv[x], len);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1803 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1804 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1805 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1806
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1807 char **
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1808 __get_program_args (target_register_t argcPtr)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1809 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1810 if (!args_initted)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1811 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1812 __free_program_args ();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1813 }
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	1814 __write_mem_safe ((char ) &program_argc, (void )argcPtr, sizeof (program_argc));
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1815 return program_argv;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1816 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1817
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1818 /* Table used by the crc32 function to calcuate the checksum. */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1819 static uint32 crc32_table[256];
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1820 static int tableInit = 0;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1821
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1822 /*
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1823 Calculate a CRC-32 using LEN bytes of PTR. CRC is the initial CRC
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1824 value.
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1825 PTR is assumed to be a pointer in the user program. */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1826
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1827 static uint32
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1828 crc32 (target_addr_t mem, int len, uint32 crc)
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1829 {
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1830 unsigned char ptr = (unsigned char )TARGET_ADDR_TO_PTR(mem);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1831 #ifdef TARGET_HAS_HARVARD_MEMORY
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1832 int is_progmem = TARGET_ADDR_IS_PROGMEM(mem);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1833 #endif
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1834
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1835 if (! tableInit)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1836 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1837 /* Initialize the CRC table and the decoding table. */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1838 uint32 i, j;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1839 uint32 c;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1840
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1841 tableInit = 1;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1842 for (i = 0; i < 256; i++)
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1843 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1844 for (c = i << 24, j = 8; j > 0; --j)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1845 c = c & 0x80000000 ? (c << 1) ^ 0x04c11db7 : (c << 1);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1846 crc32_table[i] = c;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1847 }
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1848 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1849
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1850 __mem_fault = 0;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1851 while (len--)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1852 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1853 unsigned char ch;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1854
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1855 #ifdef TARGET_HAS_HARVARD_MEMORY
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1856 if (is_progmem)
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1857 __read_progmem_safe (&ch, (void *)ptr, 1);
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1858 else
b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1859 #endif
34 29bc183297e1 Merge from eCos master repository on 1999-09-02-16:26:10-BST jlarmour parents: 28 diff changeset	1860 __read_mem_safe (&ch, (void *)ptr, 1);
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1861 if (__mem_fault)
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1862 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1863 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1864 }
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1865 crc = (crc << 8) ^ crc32_table[((crc >> 24) ^ ch) & 255];
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1866 ptr++;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1867 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1868 return crc;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1869 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1870
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1871 /* Handle the 'q' request */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1872
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1873 static void
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1874 process_query (char *pkt)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1875 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1876 remcomOutBuffer[0] = '\0';
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1877 #ifdef __ECOS__
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1878 if ('C' == pkt[0] &&
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1879 'R' == pkt[1] &&
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1880 'C' == pkt[2] &&
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1881 ':' == pkt[3])
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1882 #else // __ECOS__
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1883 if (strncmp (pkt, "CRC:", 4) == 0)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1884 #endif // __ECOS__
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1885 {
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1886 target_addr_t startmem;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1887 target_register_t length;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1888 uint32 our_crc;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1889
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1890 pkt += 4;
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1891 if (__hexToAddr (&pkt, &startmem)
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1892 && *(pkt++) == ','
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1893 && __hexToInt (&pkt, &length))
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1894 {
156 b939e9cada46 Merge from eCos master repository on 2001-03-29-21:44:39-BST jlarmour parents: 154 diff changeset	1895 our_crc = crc32 (startmem, length, 0xffffffff);
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1896 if (__mem_fault)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1897 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1898 strcpy (remcomOutBuffer, "E01");
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1899 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1900 else
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1901 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1902 int numb = __intToHex (remcomOutBuffer + 1, our_crc, 32);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1903 remcomOutBuffer[0] = 'C';
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1904 remcomOutBuffer[numb + 1] = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1905 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1906 }
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1907 return;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1908 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1909 else
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1910 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1911 char ch ;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1912 char * subpkt ;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1913 ch = *pkt ;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1914 subpkt = pkt + 1 ;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1915 switch (ch)
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1916 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1917 case 'L' : /* threadlistquery */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1918 STUB_PKT_GETTHREADLIST (subpkt, remcomOutBuffer, 300);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1919 break ;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1920 case 'P' : /* Thread or process information request */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1921 STUB_PKT_GETTHREADINFO (subpkt, remcomOutBuffer, 300);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1922 break ;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1923 case 'C' : /* current thread query */
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1924 STUB_PKT_CURRTHREAD(subpkt, remcomOutBuffer, sizeof(remcomOutBuffer));
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1925 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1926 default:
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1927 __process_target_query (pkt, remcomOutBuffer, 300);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1928 break ;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1929 }
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1930 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1931 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1932
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1933 /* Handle the 'Q' request */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1934
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1935 static void
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1936 process_set (char *pkt)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1937 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1938 char ch ;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1939 ch = *pkt ;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1940
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1941 switch (ch)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1942 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1943 case 'p' : /* Set current process or thread */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1944 /* reserve the packet id even if support is not present */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1945 /* Dont strip the 'p' off the header, there are several variations of
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	1946 this packet */
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1947 STUB_PKT_CHANGETHREAD (pkt, remcomOutBuffer, 300) ;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1948 break ;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1949 default:
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1950 __process_target_set (pkt, remcomOutBuffer, 300);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1951 break ;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1952 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1953 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	1954 #endif // CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS

Mercurial > ecos

annotate packages/hal/common/current/src/generic-stub.c @ 163:0d2b193a635f