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

annotate packages/hal/common/current/src/generic-stub.c @ 145:2e9a636d9de9 ecos-sw-2000-12-21

Merge from eCos master repository on 2000-12-21-14:18:40-GMT

author	jlarmour
date	Fri, 22 Dec 2000 02:37:28 +0000
parents	289bf90c6a9b
children	25e238959bae

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

Mercurial > ecos

annotate packages/hal/common/current/src/generic-stub.c @ 145:2e9a636d9de9 ecos-sw-2000-12-21