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

annotate packages/hal/common/current/src/generic-stub.c @ 196:9b55e9c69693

Merge from eCos master repository on 2001-11-23-15:32:03-GMT

author	jlarmour
date	Fri, 23 Nov 2001 17:12:52 +0000
parents	678094f34118
children	ea3f0bd33a73

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

Mercurial > ecos

annotate packages/hal/common/current/src/generic-stub.c @ 196:9b55e9c69693