04c12f60f9
2002-03-06 Fred Fish <fnf@redhat.com> * gdb.base/funcargs.c: Remove extraneous ';' character. * gdb.trace/gdb_c_test.c: Remove extraneous ';' character.
3792 lines
106 KiB
C
3792 lines
106 KiB
C
/*
|
|
******************************************************************************
|
|
******************************************************************************
|
|
*
|
|
* COPYRIGHT (C) by EMC Corporation, 1997 All rights reserved.
|
|
* $Id$
|
|
* DESCRIPTION: This module has been provided for the purpose of testing GDB.
|
|
*
|
|
* NOTES:
|
|
*
|
|
******************************************************************************
|
|
*****************************************************************************/
|
|
|
|
/*=============================================================================
|
|
* INCLUDE FILES
|
|
*===========================================================================*/
|
|
|
|
|
|
#ifdef DO_IT_BY_THE_BOOK
|
|
|
|
|
|
#include "symtypes_defs.h"
|
|
#include "printp.h"
|
|
|
|
#include "adbg_expression.h"
|
|
#include "common_hw_ds.h"
|
|
#include "common_hw_defs.h"
|
|
#include "evnttrac.h"
|
|
#include "sym_scratch_ds.h"
|
|
#include "symglob_ds.h"
|
|
#include "sym_protglob_ds.h"
|
|
|
|
#include "ether.h"
|
|
|
|
#include <ctype.h>
|
|
|
|
|
|
#else
|
|
|
|
#include "adbg_dtc.h"
|
|
|
|
#define YES 1
|
|
#define NO 0
|
|
|
|
#define TRUE 1
|
|
#define FALSE 0
|
|
|
|
#define ENABLED 1
|
|
#define DISABLED 0
|
|
|
|
#define CONTROL_C 3 /* ASCII 'ETX' */
|
|
|
|
|
|
/*
|
|
* Faked after ctype.h
|
|
*/
|
|
|
|
#define isxdigit(X) (((X) >= '0' && (X) <= '9') || \
|
|
((X) >= 'A' && (X) <= 'F') || \
|
|
((X) >= 'a' && (X) <= 'f'))
|
|
/*
|
|
* Borrowed from string.h
|
|
*/
|
|
|
|
extern unsigned int strlen ( const char * );
|
|
|
|
/*
|
|
* Extracted from symtypes.h:
|
|
*/
|
|
|
|
typedef char BOOL; /* 8 Bits */
|
|
typedef unsigned char UCHAR; /* 8 Bits */
|
|
typedef unsigned short USHORT; /* 16 Bits */
|
|
typedef unsigned long ULONG; /* 32 Bits */
|
|
|
|
/*
|
|
* for struct t_expr_tag and
|
|
* decl of build_and_add_expression
|
|
*/
|
|
#include "adbg_expression.h"
|
|
#define NULL 0
|
|
|
|
/*
|
|
* Extracted from printp.h:
|
|
*/
|
|
|
|
extern void printp ( const char * fptr, ... );
|
|
extern void sprintp ( const char * fptr, ... );
|
|
|
|
/*
|
|
* Extracted from ether.h:
|
|
*/
|
|
|
|
extern long eth_to_gdb ( UCHAR *buf, long length );
|
|
|
|
|
|
/*
|
|
* Derived from hwequs.s:
|
|
*/
|
|
|
|
#define CS_CODE_START 0x100000
|
|
#define CS_CODE_SIZE 0x200000
|
|
#define LAST_CS_WORD (CS_CODE_START + CS_CODE_SIZE - 2)
|
|
|
|
#define sh_genstat1 (*((volatile ULONG *) 0xFFFFFE54))
|
|
|
|
#define rs232_mode1 0 /* rs-232 mode 1 reg. */
|
|
#define rs232_mode2 rs232_mode1 /* rs-232 mode 2 reg. */
|
|
#define rs232_stat 4 /* rs-232 status reg. */
|
|
#define rs232_clk rs232_stat /* rs-232 clock select reg. */
|
|
#define rs232_cmd 8 /* rs-232 command reg */
|
|
#define rs232_transmit 12 /* rs-232 transmit reg. */
|
|
#define rs232_receive rs232_transmit /* rs-232 transmit reg. */
|
|
#define rs232_aux 16 /* rs-232 aux control reg. */
|
|
#define rs232_isr 20 /* rs-232 interrupt status reg. */
|
|
#define rs232_imr rs232_isr /* rs-232 interrupt mask reg. */
|
|
#define rs232_tc_high 24 /* rs-232 timer/counter high reg. */
|
|
#define rs232_tc_low 28 /* rs-232 timer/counter low reg. */
|
|
|
|
|
|
#endif
|
|
|
|
|
|
/*============================================================================
|
|
* MODULE DEFINES
|
|
*===========================================================================*/
|
|
|
|
#define P_RST_LAN_UART_REG ((volatile UCHAR *) 0xFFFFFE45)
|
|
#define M_RST_LAN_UART 0x80 /* Bit 7 */
|
|
|
|
#define P_LAN0TR_REG P_RST_LAN_UART_REG
|
|
#define M_LAN0TR 0x20 /* Bit 5 */
|
|
|
|
#define M_SH_GENCON_LAN0TR 0x00200000 /* Bit 21 */
|
|
|
|
#define MAX_RS232_CHARS 512
|
|
|
|
#define LAN_Q_MOD(X) ((X) % MAX_RS232_CHARS)
|
|
|
|
/*---------------------------------------*
|
|
* LAN UART Registers *
|
|
*---------------------------------------*/
|
|
|
|
#define LAN_UART_BASE ((ULONG) 0xfffffc22)
|
|
|
|
/* Write-Read */
|
|
|
|
#define P_LAN_MR1 ((volatile UCHAR *) (LAN_UART_BASE + ((ULONG) rs232_mode1 )))
|
|
#define P_LAN_MR2 ((volatile UCHAR *) (LAN_UART_BASE + ((ULONG) rs232_mode2 )))
|
|
|
|
/* Write-Only */
|
|
|
|
#define P_LAN_ACR ((volatile UCHAR *) (LAN_UART_BASE + ((ULONG) rs232_aux )))
|
|
#define P_LAN_CR ((volatile UCHAR *) (LAN_UART_BASE + ((ULONG) rs232_cmd )))
|
|
#define P_LAN_CSR ((volatile UCHAR *) (LAN_UART_BASE + ((ULONG) rs232_clk )))
|
|
#define P_LAN_CTLR ((volatile UCHAR *) (LAN_UART_BASE + ((ULONG) rs232_tc_low )))
|
|
#define P_LAN_CTUR ((volatile UCHAR *) (LAN_UART_BASE + ((ULONG) rs232_tc_high )))
|
|
#define P_LAN_IMR ((volatile UCHAR *) (LAN_UART_BASE + ((ULONG) rs232_imr )))
|
|
|
|
/* Read-Only */
|
|
|
|
#define P_LAN_SR ((volatile UCHAR *) (LAN_UART_BASE + ((ULONG) rs232_stat )))
|
|
#define P_LAN_ISR ((volatile UCHAR *) (LAN_UART_BASE + ((ULONG) rs232_isr )))
|
|
#define P_LAN_XMT ((volatile UCHAR *) (LAN_UART_BASE + ((ULONG) rs232_transmit)))
|
|
#define P_LAN_RCV ((volatile UCHAR *) (LAN_UART_BASE + ((ULONG) rs232_receive )))
|
|
|
|
/*
|
|
* Bit Values for Write-Read and Write-Only Registers
|
|
*/
|
|
|
|
#define DEFAULT_LAN_MR1 ((UCHAR) 0x13)
|
|
#define DEFAULT_LAN_MR2 ((UCHAR) 0x07)
|
|
#define DEFAULT_LAN_CSR ((UCHAR) 0xcc)
|
|
#define DEFAULT_LAN_ACR ((UCHAR) 0x38)
|
|
#define DEFAULT_LAN_CTUR ((UCHAR) 0xff)
|
|
#define DEFAULT_LAN_CTLR ((UCHAR) 0xff)
|
|
|
|
#define LAN_ACR_SELECT_BRG_0 DEFAULT_LAN_ACR
|
|
#define LAN_ACR_SELECT_BRG_1 (DEFAULT_LAN_ACR | 0x80)
|
|
|
|
#define UART_CR_RESET_MR_PTR ((UCHAR) 0x10) /* Reset MR pointer (points to MR1). */
|
|
#define UART_CR_RESET_RVCR ((UCHAR) 0x20) /* Reset receiver (disabled). */
|
|
#define UART_CR_RESET_XMTR ((UCHAR) 0x30) /* Reset transmitter (disabled). */
|
|
#define UART_CR_RESET_ERROR_STATUS ((UCHAR) 0x40) /* Reset error status. */
|
|
#define UART_CR_RESET_BRK_CHG_INT ((UCHAR) 0x50) /* Reset break change interrupt. */
|
|
#define UART_CR_START_CNTR_TIMER ((UCHAR) 0x80) /* Start counter/timer. */
|
|
#define UART_CR_STOP_CNTR ((UCHAR) 0x90) /* Stop counter. */
|
|
|
|
#define UART_CR_DISABLE_XMTR ((UCHAR) 0x08) /* Disable transmitter. */
|
|
#define UART_CR_ENABLE_XMTR ((UCHAR) 0x04) /* Enable transmitter. */
|
|
#define UART_CR_DISABLE_RCVR ((UCHAR) 0x02) /* Disable receiver. */
|
|
#define UART_CR_ENABLE_RCVR ((UCHAR) 0x01) /* Enable receiver. */
|
|
|
|
#define UART_CSR_BR_4800 ((UCHAR) 0x99) /* With either BRG Set selected (via ACR). */
|
|
#define UART_CSR_BR_9600 ((UCHAR) 0xbb) /* With either BRG Set selected (via ACR). */
|
|
#define UART_CSR_BR_19200 ((UCHAR) 0xcc) /* With BRG Set '1' selected (via ACR). */
|
|
#define UART_CSR_BR_38400 ((UCHAR) 0xcc) /* With BRG Set '0' selected (via ACR). */
|
|
|
|
#define UART_IMR_RxRDY ((UCHAR) 0x04) /* Enable 'RxRDY' interrupt. */
|
|
#define UART_IMR_TxEMT ((UCHAR) 0x02) /* Enable 'TxEMT' interrupt. */
|
|
#define UART_IMR_TxRDY ((UCHAR) 0x01) /* Enable 'TxRDY' interrupt. */
|
|
|
|
/*
|
|
* Bit Masks for Read-Only Registers
|
|
*/
|
|
|
|
#define M_UART_SR_RCVD_BRK 0x80 /* Bit 7 */
|
|
#define M_UART_SR_FE 0x40 /* Bit 6 */
|
|
#define M_UART_SR_PE 0x20 /* Bit 5 */
|
|
#define M_UART_SR_OE 0x10 /* Bit 4 */
|
|
#define M_UART_SR_TxEMT 0x08 /* Bit 3 */
|
|
#define M_UART_SR_TxRDY 0x04 /* Bit 2 */
|
|
#define M_UART_SR_FFULL 0x02 /* Bit 1 */
|
|
#define M_UART_SR_RxRDY 0x01 /* Bit 0 */
|
|
|
|
#define M_UART_ISR_RxRDY 0x04 /* Bit 2 */
|
|
#define M_UART_ISR_TxEMT 0x02 /* Bit 1 */
|
|
#define M_UART_ISR_TxRDY 0x01 /* Bit 0 */
|
|
|
|
/*---------------------------------------*
|
|
* Support for 'Utility 83'. *
|
|
*---------------------------------------*/
|
|
|
|
#define LAN_UTIL_CODE 0x83
|
|
|
|
#define LAN_INIT ((ULONG) (('I' << 24) | ('N' << 16) | ('I' << 8) | 'T'))
|
|
#define LAN_BAUD ((ULONG) (('B' << 24) | ('A' << 16) | ('U' << 8) | 'D'))
|
|
#define LAN_INTR ((ULONG) (('I' << 24) | ('N' << 16) | ('T' << 8) | 'R'))
|
|
#define LAN_XMT ((ULONG) (('X' << 16) | ('M' << 8) | 'T'))
|
|
#define LAN_ECHO ((ULONG) (('E' << 24) | ('C' << 16) | ('H' << 8) | 'O'))
|
|
#define LAN_STAT ((ULONG) (('S' << 24) | ('T' << 16) | ('A' << 8) | 'T'))
|
|
#define LAN_IN ((ULONG) (('I' << 8) | 'N'))
|
|
#define LAN_OUT ((ULONG) (('O' << 16) | ('U' << 8) | 'T'))
|
|
|
|
#define LAN_PUTC ((ULONG) (('P' << 24) | ('U' << 16) | ('T' << 8) | 'C'))
|
|
#define LAN_WPM ((ULONG) (('W' << 16) | ('P' << 8) | 'M'))
|
|
|
|
#define STATUS(X) ( ( ( X ) == 0 ) ? "disabled" : "enabled" )
|
|
|
|
#define XMT_VIA_BP_ENABLED() ( *P_LAN0TR_REG & M_LAN0TR ? 1 : 0 )
|
|
|
|
#define TRAP_1_INST 0x4E41
|
|
|
|
/*
|
|
* Bit #13 of shared genstat 1 indicates
|
|
* which processor we are as follows.
|
|
*
|
|
* 0 => X (side A)
|
|
* 1 => Y (side B)
|
|
*/
|
|
|
|
#define M_PROC_ID 0x00002000
|
|
|
|
#define IS_SIDE_A() ( ( (sh_genstat1) & M_PROC_ID ) == 0 )
|
|
#define IS_SIDE_B() ( (sh_genstat1) & M_PROC_ID )
|
|
|
|
|
|
#ifdef STANDALONE /* Compile this module stand-alone for debugging */
|
|
#define LAN_PUT_CHAR(X) printf("%c", X)
|
|
#else
|
|
#define LAN_PUT_CHAR(X) while ( lan_put_char( X ) )
|
|
#endif
|
|
|
|
|
|
|
|
|
|
#define VIA_RS232 0
|
|
#define VIA_ETHERNET 1
|
|
|
|
#define MAX_IO_BUF_SIZE 400
|
|
|
|
#define MAX_BYTE_CODES 200 /* maximum length for bytecode string */
|
|
|
|
|
|
static ULONG gdb_host_comm;
|
|
|
|
static ULONG gdb_cat_ack;
|
|
|
|
static char eth_outbuffer[ MAX_IO_BUF_SIZE + 1 ];
|
|
|
|
|
|
#ifdef STANDALONE
|
|
|
|
#define ACK_PKT() LAN_PUT_CHAR( '+' )
|
|
#define NACK_PKT() LAN_PUT_CHAR( '-' )
|
|
|
|
#else
|
|
|
|
#define ACK_PKT() { \
|
|
if ( VIA_ETHERNET == gdb_host_comm ) \
|
|
{ \
|
|
gdb_cat_ack = YES; \
|
|
} \
|
|
else \
|
|
{ \
|
|
LAN_PUT_CHAR( '+' ); \
|
|
} \
|
|
}
|
|
|
|
|
|
|
|
#define NACK_PKT() { \
|
|
if ( VIA_ETHERNET == gdb_host_comm ) \
|
|
{ \
|
|
eth_outbuffer[ 0 ] = '-'; \
|
|
eth_to_gdb( (UCHAR *) eth_outbuffer, 1 ); \
|
|
} \
|
|
else \
|
|
{ \
|
|
LAN_PUT_CHAR( '-' ); \
|
|
} \
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
/*============================================================================
|
|
* MODULE TYPEDEFS
|
|
*===========================================================================*/
|
|
|
|
typedef struct rs232_queue {
|
|
|
|
long head_index;
|
|
|
|
long tail_index;
|
|
|
|
ULONG overflows;
|
|
|
|
long gdb_packet_start;
|
|
long gdb_packet_end;
|
|
long gdb_packet_csum1;
|
|
long gdb_packet_csum2;
|
|
|
|
UCHAR buf[ MAX_RS232_CHARS ];
|
|
|
|
} T_RS232_QUEUE;
|
|
|
|
|
|
|
|
|
|
/*=============================================================================
|
|
* EXTERNAL GLOBAL VARIABLES
|
|
*===========================================================================*/
|
|
|
|
extern volatile UCHAR sss_trace_flag;
|
|
|
|
|
|
/*=============================================================================
|
|
* STATIC MODULE DECLARATIONS
|
|
*===========================================================================*/
|
|
|
|
static T_RS232_QUEUE lan_input_queue,
|
|
lan_output_queue;
|
|
|
|
static BOOL test_echo;
|
|
|
|
#if 0
|
|
/* The stub no longer seems to use this. */
|
|
static BOOL write_access_enabled;
|
|
#endif
|
|
|
|
static int baud_rate_idx;
|
|
|
|
static ULONG tx_by_intr,
|
|
tx_by_poll;
|
|
|
|
static UCHAR lan_shadow_imr;
|
|
|
|
|
|
/*=============================================================================
|
|
* EXTERNAL FUNCTION PROTOTYPES
|
|
*===========================================================================*/
|
|
|
|
extern long write_to_protected_mem( void *address, unsigned short value );
|
|
|
|
|
|
/*=============================================================================
|
|
* MODULE GLOBAL FUNCTIONS PROTOTYPES
|
|
*===========================================================================*/
|
|
|
|
ULONG gdb_c_test( ULONG *parm );
|
|
|
|
|
|
void lan_init( void );
|
|
|
|
void lan_isr( void );
|
|
|
|
long lan_get_char( void );
|
|
|
|
long lan_put_char( UCHAR c );
|
|
|
|
ULONG lan_util( ULONG *parm );
|
|
|
|
|
|
/*=============================================================================
|
|
* MODULE LOCAL FUNCTION PROTOTYPES
|
|
*===========================================================================*/
|
|
|
|
static void lan_reset( void );
|
|
|
|
static void lan_configure( void );
|
|
|
|
static void lan_init_queue( T_RS232_QUEUE *p_queue );
|
|
|
|
static void lan_add_to_queue( long c, T_RS232_QUEUE *p_queue );
|
|
|
|
static UCHAR lan_next_queue_char( T_RS232_QUEUE *p_queue );
|
|
|
|
static void lan_util_menu( void );
|
|
|
|
static long get_gdb_input( long c, T_RS232_QUEUE *p_input_q );
|
|
|
|
|
|
/*=============================================================================
|
|
* GDB STUB FUNCTION PROTOTYPES
|
|
*===========================================================================*/
|
|
|
|
void gdb_trap_1_handler( void );
|
|
void gdb_trace_handler ( void );
|
|
|
|
void gdb_get_eth_input( unsigned char *buf, long length );
|
|
|
|
static void getpacket ( void );
|
|
static void putpacket ( char * );
|
|
static void discard_packet ( void );
|
|
|
|
#ifdef STANDALONE /* Compile this module stand-alone for debugging */
|
|
#include <stdio.h>
|
|
#define printp printf /* easier than declaring a local varargs stub func. */
|
|
#endif /* STANDALONE */
|
|
|
|
|
|
/*=============================================================================
|
|
* MODULE BODY
|
|
*===========================================================================*/
|
|
|
|
/* ------------------- Things that belong in a header file --------------- */
|
|
extern char *memset (char *, int, int);
|
|
|
|
/*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*
|
|
* *
|
|
* Global Module Functions *
|
|
* *
|
|
*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
|
|
|
|
|
|
static char gdb_char_test;
|
|
static short gdb_short_test;
|
|
static long gdb_long_test;
|
|
static char gdb_arr_test[25];
|
|
static struct GDB_STRUCT_TEST
|
|
{
|
|
char c;
|
|
short s;
|
|
long l;
|
|
int bfield : 11; /* collect bitfield */
|
|
char arr[25];
|
|
struct GDB_STRUCT_TEST *next;
|
|
} gdb_struct1_test, gdb_struct2_test, *gdb_structp_test, **gdb_structpp_test;
|
|
|
|
static union GDB_UNION_TEST
|
|
{
|
|
char c;
|
|
short s;
|
|
long l;
|
|
int bfield : 11; /* collect bitfield */
|
|
char arr[4];
|
|
union GDB_UNION_TEST *next;
|
|
} gdb_union1_test;
|
|
|
|
void gdb_recursion_test (int, int, int, int, int, int, int);
|
|
|
|
void gdb_recursion_test (int depth,
|
|
int q1,
|
|
int q2,
|
|
int q3,
|
|
int q4,
|
|
int q5,
|
|
int q6)
|
|
{ /* gdb_recursion_test line 0 */
|
|
int q = q1; /* gdbtestline 1 */
|
|
|
|
q1 = q2; /* gdbtestline 2 */
|
|
q2 = q3; /* gdbtestline 3 */
|
|
q3 = q4; /* gdbtestline 4 */
|
|
q4 = q5; /* gdbtestline 5 */
|
|
q5 = q6; /* gdbtestline 6 */
|
|
q6 = q; /* gdbtestline 7 */
|
|
if (depth--) /* gdbtestline 8 */
|
|
gdb_recursion_test (depth, q1, q2, q3, q4, q5, q6); /* gdbtestline 9 */
|
|
}
|
|
|
|
|
|
ULONG gdb_c_test( ULONG *parm )
|
|
|
|
{
|
|
char *p = "gdb_c_test";
|
|
char *ridiculously_long_variable_name_with_equally_long_string_assignment;
|
|
register long local_reg = 7;
|
|
static unsigned long local_static, local_static_sizeof;
|
|
long local_long;
|
|
unsigned long *stack_ptr;
|
|
unsigned long end_of_stack;
|
|
|
|
ridiculously_long_variable_name_with_equally_long_string_assignment =
|
|
"ridiculously long variable name with equally long string assignment";
|
|
local_static = 9;
|
|
local_static_sizeof = sizeof (struct GDB_STRUCT_TEST);
|
|
local_long = local_reg + 1;
|
|
stack_ptr = (unsigned long *) &local_long;
|
|
end_of_stack =
|
|
(unsigned long) &stack_ptr + sizeof(stack_ptr) + sizeof(end_of_stack) - 1;
|
|
|
|
printp ("\n$Id$\n");
|
|
|
|
printp( "%s: arguments = %X, %X, %X, %X, %X, %X\n",
|
|
p, parm[ 1 ], parm[ 2 ], parm[ 3 ], parm[ 4 ], parm[ 5 ], parm[ 6 ] );
|
|
|
|
gdb_char_test = gdb_struct1_test.c = (char) ((long) parm[1] & 0xff);
|
|
gdb_short_test = gdb_struct1_test.s = (short) ((long) parm[2] & 0xffff);
|
|
gdb_long_test = gdb_struct1_test.l = (long) ((long) parm[3] & 0xffffffff);
|
|
gdb_union1_test.l = (long) parm[4];
|
|
gdb_arr_test[0] = gdb_struct1_test.arr[0] = (char) ((long) parm[1] & 0xff);
|
|
gdb_arr_test[1] = gdb_struct1_test.arr[1] = (char) ((long) parm[2] & 0xff);
|
|
gdb_arr_test[2] = gdb_struct1_test.arr[2] = (char) ((long) parm[3] & 0xff);
|
|
gdb_arr_test[3] = gdb_struct1_test.arr[3] = (char) ((long) parm[4] & 0xff);
|
|
gdb_arr_test[4] = gdb_struct1_test.arr[4] = (char) ((long) parm[5] & 0xff);
|
|
gdb_arr_test[5] = gdb_struct1_test.arr[5] = (char) ((long) parm[6] & 0xff);
|
|
gdb_struct1_test.bfield = 144;
|
|
gdb_struct1_test.next = &gdb_struct2_test;
|
|
gdb_structp_test = &gdb_struct1_test;
|
|
gdb_structpp_test = &gdb_structp_test;
|
|
|
|
gdb_recursion_test (3, (long) parm[1], (long) parm[2], (long) parm[3],
|
|
(long) parm[4], (long) parm[5], (long) parm[6]);
|
|
|
|
gdb_char_test = gdb_short_test = gdb_long_test = 0;
|
|
gdb_structp_test = (void *) 0;
|
|
gdb_structpp_test = (void *) 0;
|
|
memset ((char *) &gdb_struct1_test, 0, sizeof (gdb_struct1_test));
|
|
memset ((char *) &gdb_struct2_test, 0, sizeof (gdb_struct2_test));
|
|
local_static_sizeof = 0;
|
|
local_static = 0;
|
|
return ( (ULONG) 0 );
|
|
}
|
|
|
|
|
|
/*-----------------------------------------------------------------------------
|
|
*
|
|
* FUNCTION NAME: lan_init
|
|
*
|
|
*
|
|
* DESCRIPTION:
|
|
*
|
|
*
|
|
* RETURN VALUE:
|
|
*
|
|
*
|
|
* USED GLOBAL VARIABLES:
|
|
*
|
|
*
|
|
* AFFECTED GLOBAL VARIABLES/SIDE EFFECTS:
|
|
*
|
|
*
|
|
* NOTES:
|
|
*
|
|
*
|
|
*
|
|
*---------------------------------------------------------------------------*/
|
|
|
|
void lan_init( void )
|
|
|
|
{
|
|
|
|
if ( IS_SIDE_A( ) )
|
|
{
|
|
|
|
lan_reset( );
|
|
|
|
lan_init_queue( &lan_input_queue );
|
|
|
|
lan_init_queue( &lan_output_queue );
|
|
|
|
lan_configure( );
|
|
}
|
|
|
|
return;
|
|
}
|
|
/* end of 'lan_init'
|
|
*===========================================================================*/
|
|
|
|
|
|
/*-----------------------------------------------------------------------------
|
|
*
|
|
* FUNCTION NAME: lan_isr
|
|
*
|
|
*
|
|
* DESCRIPTION:
|
|
*
|
|
*
|
|
* RETURN VALUE: None.
|
|
*
|
|
*
|
|
* USED GLOBAL VARIABLES:
|
|
*
|
|
*
|
|
* AFFECTED GLOBAL VARIABLES/SIDE EFFECTS:
|
|
*
|
|
*
|
|
* NOTES:
|
|
*
|
|
*
|
|
*---------------------------------------------------------------------------*/
|
|
|
|
void lan_isr( void )
|
|
|
|
{
|
|
UCHAR c;
|
|
|
|
|
|
lan_shadow_imr = 0; /* Disable all UART interrupts. */
|
|
*P_LAN_IMR = lan_shadow_imr;
|
|
|
|
|
|
if ( *P_LAN_ISR & M_UART_ISR_RxRDY )
|
|
{
|
|
|
|
gdb_host_comm = VIA_RS232;
|
|
|
|
c = *P_LAN_RCV;
|
|
|
|
if ( test_echo )
|
|
{
|
|
/* ????? */
|
|
}
|
|
|
|
if ( c == CONTROL_C )
|
|
{
|
|
/* can't stop the target, but we can tell gdb to stop waiting... */
|
|
discard_packet( );
|
|
putpacket( "S03" ); /* send back SIGINT to the debugger */
|
|
}
|
|
|
|
else
|
|
{
|
|
lan_add_to_queue( (long) c, &lan_input_queue );
|
|
get_gdb_input( (long) c, &lan_input_queue );
|
|
}
|
|
|
|
}
|
|
|
|
if ( XMT_VIA_BP_ENABLED( ) )
|
|
{
|
|
|
|
c = 0;
|
|
|
|
while ( (*P_LAN_ISR & M_UART_ISR_TxRDY) && (c = lan_next_queue_char( &lan_output_queue )) )
|
|
{
|
|
*P_LAN_XMT = c;
|
|
++tx_by_intr;
|
|
}
|
|
|
|
if ( c )
|
|
{
|
|
lan_shadow_imr |= UART_IMR_TxRDY; /* (Re-)Enable 'TxRDY' interrupt from UART. */
|
|
}
|
|
|
|
}
|
|
|
|
|
|
lan_shadow_imr |= UART_IMR_RxRDY; /* Re-Enable 'RxRDY' interrupt from UART. */
|
|
*P_LAN_IMR = lan_shadow_imr;
|
|
|
|
|
|
|
|
return;
|
|
}
|
|
/* end of 'lan_isr'
|
|
*===========================================================================*/
|
|
|
|
|
|
/*-----------------------------------------------------------------------------
|
|
*
|
|
* FUNCTION NAME: lan_get_char
|
|
*
|
|
*
|
|
* DESCRIPTION: Fetches a character from the UART.
|
|
*
|
|
*
|
|
* RETURN VALUE: 0 on success, -1 on failure.
|
|
*
|
|
*
|
|
* USED GLOBAL VARIABLES:
|
|
*
|
|
*
|
|
* AFFECTED GLOBAL VARIABLES/SIDE EFFECTS:
|
|
*
|
|
*
|
|
* NOTES:
|
|
*
|
|
*
|
|
*---------------------------------------------------------------------------*/
|
|
|
|
long lan_get_char( void )
|
|
|
|
{
|
|
long status = -2; /* AGD: nothing found in rcv buffer */
|
|
|
|
if ( *P_LAN_SR & M_UART_SR_RxRDY )
|
|
{
|
|
char c = (char) *P_LAN_RCV;
|
|
|
|
if ( test_echo )
|
|
{
|
|
LAN_PUT_CHAR ( c );
|
|
}
|
|
|
|
if ( c == CONTROL_C )
|
|
{
|
|
/* can't stop the target, but we can tell gdb to stop waiting... */
|
|
discard_packet( );
|
|
putpacket( "S03" ); /* send back SIGINT to the debugger */
|
|
status = 0; /* success */
|
|
}
|
|
|
|
else
|
|
{
|
|
lan_add_to_queue( (long) c, &lan_input_queue );
|
|
status = get_gdb_input( (long) c, &lan_input_queue );
|
|
}
|
|
|
|
}
|
|
|
|
return( status );
|
|
}
|
|
/* end of 'lan_get_char'
|
|
*===========================================================================*/
|
|
|
|
|
|
/*-----------------------------------------------------------------------------
|
|
*
|
|
* FUNCTION NAME: lan_put_char
|
|
*
|
|
* DESCRIPTION: Puts a character out via the UART.
|
|
*
|
|
* RETURN VALUE: 0 on success, -1 on failure.
|
|
*
|
|
* USED GLOBAL VARIABLES: none.
|
|
*
|
|
* AFFECTED GLOBAL VARIABLES/SIDE EFFECTS:
|
|
*
|
|
* NOTES: !!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
|
|
* !! !!
|
|
* !! If 'XMT_VIA_BP_ENABLED()' is FALSE then output is THROWN AWAY. !!
|
|
* !! This prevents anyone infinite-looping on this function. !!
|
|
* !! !!
|
|
* !!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
|
|
*
|
|
*---------------------------------------------------------------------------*/
|
|
|
|
long lan_put_char( UCHAR c )
|
|
|
|
{
|
|
long status = -1;
|
|
|
|
if ( XMT_VIA_BP_ENABLED( ) )
|
|
{
|
|
|
|
if ( *P_LAN_SR & M_UART_SR_TxRDY )
|
|
{
|
|
lan_add_to_queue( (long) c, &lan_output_queue );
|
|
|
|
c = lan_next_queue_char( &lan_output_queue );
|
|
|
|
*P_LAN_XMT = c;
|
|
++tx_by_poll;
|
|
status = 0;
|
|
}
|
|
#if 0
|
|
else
|
|
{
|
|
status = 0;
|
|
lan_shadow_imr |= UART_IMR_TxRDY; /* Enable 'TxRDY' interrupt from UART. */
|
|
*P_LAN_IMR = lan_shadow_imr;
|
|
}
|
|
#endif
|
|
}
|
|
|
|
else
|
|
{
|
|
status = 0; /* You lose: input character goes to the bit bucket. */
|
|
}
|
|
|
|
return( status );
|
|
}
|
|
/* end of 'lan_put_char'
|
|
*===========================================================================*/
|
|
|
|
|
|
/*-----------------------------------------------------------------------------
|
|
*
|
|
* FUNCTION NAME: lan_util
|
|
*
|
|
* DESCRIPTION:
|
|
*
|
|
* RETURN VALUE:
|
|
*
|
|
* USED GLOBAL VARIABLES:
|
|
*
|
|
* AFFECTED GLOBAL VARIABLES/SIDE EFFECTS:
|
|
*
|
|
* NOTES:
|
|
*
|
|
*---------------------------------------------------------------------------*/
|
|
|
|
ULONG lan_util( ULONG *parm )
|
|
|
|
{
|
|
|
|
|
|
static const struct {
|
|
|
|
ULONG rate_code;
|
|
UCHAR acr_setting;
|
|
UCHAR csr_setting;
|
|
|
|
} baud_rate_setting [] = {
|
|
|
|
{ 0x38400, LAN_ACR_SELECT_BRG_0, UART_CSR_BR_38400 },
|
|
{ 0x19200, LAN_ACR_SELECT_BRG_1, UART_CSR_BR_19200 },
|
|
{ 0x9600, LAN_ACR_SELECT_BRG_0, UART_CSR_BR_9600 },
|
|
{ 0x4800, LAN_ACR_SELECT_BRG_0, UART_CSR_BR_4800 }
|
|
};
|
|
|
|
|
|
#define BOGUS_P1 0xE1
|
|
#define BOGUS_P2 0xE2
|
|
|
|
ULONG not_done_code;
|
|
|
|
|
|
ULONG opcode;
|
|
ULONG parm_1;
|
|
ULONG parm_2;
|
|
|
|
int i;
|
|
UCHAR c;
|
|
|
|
|
|
not_done_code = 0;
|
|
|
|
opcode = parm[ 1 ];
|
|
parm_1 = parm[ 2 ];
|
|
parm_2 = parm[ 3 ];
|
|
|
|
|
|
switch ( opcode )
|
|
{
|
|
|
|
case LAN_INIT:
|
|
{
|
|
|
|
lan_init( );
|
|
printp( "\n\n Interface (Re)Initialized ...\n\n" );
|
|
|
|
break;
|
|
}
|
|
|
|
|
|
case LAN_BAUD:
|
|
{
|
|
|
|
for ( i = 0; i < (int)(sizeof(baud_rate_setting) / sizeof(baud_rate_setting[0])); i ++ )
|
|
{
|
|
if ( baud_rate_setting[i].rate_code == parm_1 )
|
|
{
|
|
baud_rate_idx = i;
|
|
*P_LAN_ACR = baud_rate_setting[i].acr_setting;
|
|
*P_LAN_CSR = baud_rate_setting[i].csr_setting;
|
|
printp ( "Baud rate set to %X!\n", baud_rate_setting[i].rate_code );
|
|
return( not_done_code );
|
|
}
|
|
}
|
|
|
|
printp( "\n\n *** SYNTAX Error - Invalid baudrate (P2)\n\n" );
|
|
not_done_code = BOGUS_P2;
|
|
|
|
break;
|
|
}
|
|
|
|
|
|
case LAN_INTR:
|
|
{
|
|
|
|
switch ( parm_1 )
|
|
{
|
|
|
|
case 0x0D: /* Disable 'RxRDY' Interrupts */
|
|
{
|
|
lan_shadow_imr &= ~UART_IMR_RxRDY;
|
|
*P_LAN_IMR = lan_shadow_imr;
|
|
printp( "\n\n Receive Ready Interrupts DISABLED ...\n\n" );
|
|
break;
|
|
}
|
|
|
|
case 0x0E: /* Enable 'RxRDY' Interrupts */
|
|
{
|
|
lan_shadow_imr |= UART_IMR_RxRDY;
|
|
*P_LAN_IMR = lan_shadow_imr;
|
|
printp( "\n\n Receive Ready Interrupts ENABLED ...\n\n" );
|
|
break;
|
|
}
|
|
|
|
default:
|
|
{
|
|
printp( "\n\n *** SYNTAX Error - Invalid P2 (use D or E)\n\n" );
|
|
not_done_code = BOGUS_P2;
|
|
}
|
|
}
|
|
|
|
break;
|
|
}
|
|
|
|
|
|
case LAN_XMT:
|
|
{
|
|
|
|
switch ( parm_1 )
|
|
{
|
|
|
|
case 0x0E: /* Enable Transmission-via-Backplane */
|
|
{
|
|
if ( !(*P_LAN0TR_REG & M_LAN0TR) )
|
|
{
|
|
*P_LAN0TR_REG |= M_LAN0TR; /* 0 -> 1 */
|
|
}
|
|
|
|
printp( "\n\n Transmit-via-Backplane ENABLED ...\n\n" );
|
|
break;
|
|
}
|
|
|
|
case 0x0D: /* Disable Transmission-via-Backplane */
|
|
{
|
|
if ( *P_LAN0TR_REG & M_LAN0TR )
|
|
{
|
|
*P_LAN0TR_REG &= ~M_LAN0TR; /* 1 -> 0 */
|
|
}
|
|
|
|
printp( "\n\n Transmit-via-Backplane DISABLED ...\n\n" );
|
|
break;
|
|
}
|
|
|
|
default:
|
|
{
|
|
printp( "\n\n *** SYNTAX Error - Invalid P2 (use D or E)\n\n" );
|
|
not_done_code = BOGUS_P2;
|
|
lan_util_menu( );
|
|
}
|
|
}
|
|
|
|
break;
|
|
}
|
|
|
|
|
|
case LAN_STAT:
|
|
{
|
|
|
|
printp( "\n -- Status --\n\n" );
|
|
|
|
printp( " Baud Rate: %X *\n", baud_rate_setting[ baud_rate_idx ].rate_code );
|
|
printp( " Xmt-via-BP: %s *\n", STATUS( XMT_VIA_BP_ENABLED( ) ) );
|
|
printp( " RxRdy Intr: %s *\n", STATUS( (lan_shadow_imr & M_UART_ISR_RxRDY) ) );
|
|
/*** printp( " TxRdy Intr: %s\n", STATUS( (lan_shadow_imr & M_UART_ISR_TxRDY) ) ); ***/
|
|
printp( " Echo: %s *\n\n", STATUS( test_echo ) );
|
|
|
|
printp( " IMR: %02X\n", (ULONG) lan_shadow_imr );
|
|
printp( " ISR: %02X\n", (ULONG) *P_LAN_ISR );
|
|
printp( " SR: %02X\n\n", (ULONG) *P_LAN_SR );
|
|
|
|
printp( " Input Overflows: %d\n\n", lan_input_queue.overflows );
|
|
|
|
printp( " Tx by Intr: %d\n", tx_by_intr );
|
|
printp( " Tx by Poll: %d\n\n", tx_by_poll );
|
|
|
|
printp( " * Can be set or toggled via Utility %2X.\n\n", (ULONG) LAN_UTIL_CODE );
|
|
|
|
break;
|
|
}
|
|
|
|
|
|
case LAN_IN:
|
|
{
|
|
|
|
switch ( parm_1 )
|
|
{
|
|
|
|
case 0x0C: /* Clear and Reset Queue */
|
|
{
|
|
lan_init_queue( &lan_input_queue );
|
|
printp( "\n\n Queue CLEARED/RESET ...\n\n" );
|
|
break;
|
|
}
|
|
|
|
case 0x0D: /* Display Queue */
|
|
{
|
|
printp( "\n -- Input Queue --\n" );
|
|
printp( "\n Head Index: %8X Tail Index: %8X\n\n ",
|
|
(ULONG) lan_input_queue.head_index, (ULONG) lan_input_queue.tail_index );
|
|
|
|
for ( i = 0; i < MAX_RS232_CHARS; ++i )
|
|
{
|
|
printp( " %02X", (ULONG) lan_input_queue.buf[ i ] );
|
|
|
|
if ( 15 == (i % 16) )
|
|
{
|
|
int j;
|
|
|
|
printp ( " " );
|
|
for ( j = i - 15; j <= i; j++ )
|
|
{
|
|
if ( lan_input_queue.buf[ j ] >= ' ' &&
|
|
lan_input_queue.buf[ j ] < 127 )
|
|
printp ( "%c", lan_input_queue.buf[ j ] );
|
|
else
|
|
printp ( "." );
|
|
}
|
|
printp( "\n " );
|
|
}
|
|
|
|
else if ( 7 == (i % 8) )
|
|
{
|
|
printp( " " );
|
|
}
|
|
|
|
}
|
|
|
|
printp( "\n" );
|
|
|
|
break;
|
|
}
|
|
|
|
case 0x0F: /* Fetch next character in Queue */
|
|
{
|
|
c = lan_next_queue_char( &lan_input_queue );
|
|
|
|
if ( c )
|
|
{
|
|
printp( "\n\n Next Character: " );
|
|
if ( 0x21 <= c && c <= 0x7F )
|
|
{
|
|
printp( "%c\n\n", (ULONG) c );
|
|
}
|
|
|
|
else if ( 0x20 == ((UCHAR) c) )
|
|
{
|
|
printp( "<space>\n\n" );
|
|
}
|
|
|
|
else
|
|
{
|
|
printp( "%02X\n\n", (ULONG) c );
|
|
}
|
|
}
|
|
|
|
else
|
|
{
|
|
printp( "\n\n Input Queue EMPTY ...\n\n" );
|
|
}
|
|
|
|
break;
|
|
}
|
|
|
|
default:
|
|
{
|
|
printp( "\n\n *** SYNTAX Error - Invalid P2 ...\n\n" );
|
|
not_done_code = BOGUS_P2;
|
|
break;
|
|
}
|
|
}
|
|
|
|
break;
|
|
}
|
|
|
|
|
|
case LAN_OUT:
|
|
{
|
|
|
|
switch ( parm_1 )
|
|
{
|
|
|
|
case 0x0C: /* Clear and Reset Queue */
|
|
{
|
|
lan_init_queue( &lan_output_queue );
|
|
printp( "\n\n Queue CLEARED/RESET ...\n\n" );
|
|
break;
|
|
}
|
|
|
|
case 0x0D: /* Display Queue */
|
|
{
|
|
printp( "\n -- Output Queue --\n" );
|
|
printp( "\n Head Index: %8X Tail Index: %8X\n\n ",
|
|
(ULONG) lan_output_queue.head_index, (ULONG) lan_output_queue.tail_index );
|
|
|
|
for ( i = 0; i < MAX_RS232_CHARS; ++i )
|
|
{
|
|
printp( " %02X", (ULONG) lan_output_queue.buf[ i ] );
|
|
|
|
if ( 15 == (i % 16) )
|
|
{
|
|
int j;
|
|
|
|
printp ( " " );
|
|
for ( j = i - 15; j <= i; j++ )
|
|
{
|
|
if ( lan_output_queue.buf[ j ] >= ' ' &&
|
|
lan_output_queue.buf[ j ] < 127 )
|
|
printp ( "%c", lan_output_queue.buf[ j ] );
|
|
else
|
|
printp ( "." );
|
|
}
|
|
printp( "\n " );
|
|
}
|
|
|
|
else if ( 7 == (i % 8) )
|
|
{
|
|
printp( " " );
|
|
}
|
|
|
|
}
|
|
|
|
printp( "\n" );
|
|
|
|
break;
|
|
}
|
|
|
|
case 0x0F: /* Fetch next character in Queue */
|
|
{
|
|
c = lan_next_queue_char( &lan_output_queue );
|
|
|
|
if ( c )
|
|
{
|
|
printp( "\n\n Next Character: " );
|
|
if ( 0x21 <= c && c <= 0x7F )
|
|
{
|
|
printp( "%c\n\n", (ULONG) c );
|
|
}
|
|
|
|
else if ( 0x20 == c )
|
|
{
|
|
printp( "<space>\n\n" );
|
|
}
|
|
|
|
else
|
|
{
|
|
printp( "%02X\n\n", (ULONG) c );
|
|
}
|
|
}
|
|
|
|
else
|
|
{
|
|
printp( "\n\n Input Queue EMPTY ...\n\n" );
|
|
}
|
|
|
|
break;
|
|
}
|
|
|
|
default:
|
|
{
|
|
printp( "\n\n *** SYNTAX Error - Invalid P2 ...\n\n" );
|
|
not_done_code = BOGUS_P2;
|
|
break;
|
|
}
|
|
}
|
|
|
|
break;
|
|
}
|
|
|
|
|
|
case LAN_ECHO:
|
|
{
|
|
|
|
switch ( parm_1 )
|
|
{
|
|
|
|
case 0x0E:
|
|
{
|
|
test_echo = ENABLED;
|
|
printp( "\n\n Test echo ENABLED ...\n\n" );
|
|
break;
|
|
}
|
|
|
|
case 0x0D:
|
|
{
|
|
test_echo = DISABLED;
|
|
printp( "\n\n Test echo DISABLED ...\n\n" );
|
|
break;
|
|
}
|
|
|
|
default:
|
|
{
|
|
printp( "\n\n *** SYNTAX Error - Invalid P2 ...\n\n" );
|
|
not_done_code = BOGUS_P2;
|
|
break;
|
|
}
|
|
}
|
|
|
|
break;
|
|
}
|
|
|
|
|
|
case LAN_PUTC:
|
|
{
|
|
|
|
if ( 0x20 < parm_1 && parm_1 < 0x7F )
|
|
{
|
|
if ( lan_put_char( (UCHAR) parm_1 ) )
|
|
{
|
|
printp( "\n\n *** 'lan_put_char' Error ...\n" );
|
|
}
|
|
|
|
else
|
|
{
|
|
printp( "\n\n O.K. ...\n" );
|
|
}
|
|
|
|
}
|
|
|
|
else
|
|
{
|
|
printp( "\n\n *** Error - character must be in the 0x21-0x7E range ...\n" );
|
|
not_done_code = BOGUS_P2;
|
|
}
|
|
|
|
break;
|
|
}
|
|
|
|
/***
|
|
case LAN_WPM:
|
|
{
|
|
|
|
if ( write_to_protected_mem( (void *) parm_1, (unsigned short) parm_2 ) )
|
|
{
|
|
printp( "\n Write to protected memory FAILED ...\n" );
|
|
}
|
|
|
|
break;
|
|
}
|
|
***/
|
|
|
|
case 0: /* no argument -- print menu */
|
|
{
|
|
lan_util_menu( );
|
|
break;
|
|
}
|
|
|
|
|
|
default:
|
|
{
|
|
parm_2 = 0; /* to supress compiler warning with 'LAN_WPM' case disabled */
|
|
|
|
printp( "\n\n *** SYNTAX Error - Invalid P1 ...\n\n" );
|
|
not_done_code = BOGUS_P1;
|
|
break;
|
|
}
|
|
|
|
|
|
} /* End of 'switch ( opcode )'. */
|
|
|
|
|
|
return( not_done_code );
|
|
}
|
|
/* end of 'lan_util'
|
|
*===========================================================================*/
|
|
|
|
|
|
/*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*
|
|
* *
|
|
* Local Module Functions *
|
|
* *
|
|
*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
|
|
|
|
/*-----------------------------------------------------------------------------
|
|
*
|
|
* FUNCTION NAME: lan_reset
|
|
*
|
|
* DESCRIPTION: Resets the LAN UART by strobing the 'RST_LAN_UART' bit in the
|
|
* Shared Control 1 area.
|
|
*
|
|
* 1 _| ______
|
|
* | | |
|
|
* Bit | | |
|
|
* | | |
|
|
* 0 _|______| |______
|
|
* |---------------------> t
|
|
*
|
|
* RETURN VALUE: None.
|
|
*
|
|
* USED GLOBAL VARIABLES:
|
|
*
|
|
* AFFECTED GLOBAL VARIABLES/SIDE EFFECTS:
|
|
*
|
|
* NOTES: H/W configuration requires that a byte in the shared
|
|
* control 1 area must be read before being written.
|
|
*
|
|
*---------------------------------------------------------------------------*/
|
|
|
|
static void lan_reset( void )
|
|
|
|
{
|
|
|
|
while ( *P_RST_LAN_UART_REG & M_RST_LAN_UART )
|
|
{
|
|
*P_RST_LAN_UART_REG &= ~M_RST_LAN_UART; /* 0 */
|
|
}
|
|
|
|
while ( !(*P_RST_LAN_UART_REG & M_RST_LAN_UART) )
|
|
{
|
|
*P_RST_LAN_UART_REG |= M_RST_LAN_UART; /* 1 */
|
|
}
|
|
|
|
while ( *P_RST_LAN_UART_REG & M_RST_LAN_UART )
|
|
{
|
|
*P_RST_LAN_UART_REG &= ~M_RST_LAN_UART; /* 0 */
|
|
}
|
|
|
|
}
|
|
/* end of 'lan_reset'
|
|
*===========================================================================*/
|
|
|
|
|
|
/*-----------------------------------------------------------------------------
|
|
*
|
|
* FUNCTION NAME: lan_configure
|
|
*
|
|
*
|
|
* DESCRIPTION:
|
|
*
|
|
*
|
|
* RETURN VALUE:
|
|
*
|
|
*
|
|
* USED GLOBAL VARIABLES:
|
|
*
|
|
*
|
|
* AFFECTED GLOBAL VARIABLES/SIDE EFFECTS:
|
|
*
|
|
*
|
|
* NOTES:
|
|
*
|
|
*
|
|
*
|
|
*---------------------------------------------------------------------------*/
|
|
|
|
static void lan_configure( void )
|
|
|
|
{
|
|
|
|
*P_LAN_CR = UART_CR_RESET_MR_PTR; /* Points to MR1. */
|
|
*P_LAN_CR = UART_CR_RESET_RVCR; /* Receiver disabled. */
|
|
*P_LAN_CR = UART_CR_RESET_XMTR; /* Transmitter disabled. */
|
|
*P_LAN_CR = UART_CR_RESET_ERROR_STATUS;
|
|
*P_LAN_CR = UART_CR_RESET_BRK_CHG_INT;
|
|
|
|
*P_LAN_MR1 = DEFAULT_LAN_MR1;
|
|
*P_LAN_MR2 = DEFAULT_LAN_MR2;
|
|
|
|
*P_LAN_ACR = DEFAULT_LAN_ACR;
|
|
|
|
*P_LAN_CSR = UART_CSR_BR_9600;
|
|
baud_rate_idx = 2;
|
|
|
|
*P_LAN_CTUR = DEFAULT_LAN_CTUR;
|
|
*P_LAN_CTLR = DEFAULT_LAN_CTLR;
|
|
|
|
*P_LAN_CR = (UART_CR_START_CNTR_TIMER | UART_CR_ENABLE_XMTR | UART_CR_ENABLE_RCVR);
|
|
|
|
lan_shadow_imr = UART_IMR_RxRDY; /* Enable only 'RxRDY' interrupt from UART. */
|
|
*P_LAN_IMR = lan_shadow_imr;
|
|
|
|
tx_by_intr = 0;
|
|
tx_by_poll = 0;
|
|
|
|
return;
|
|
}
|
|
/* end of 'lan_configure'
|
|
*===========================================================================*/
|
|
|
|
|
|
/*-----------------------------------------------------------------------------
|
|
*
|
|
* FUNCTION NAME: lan_init_queue
|
|
*
|
|
* DESCRIPTION:
|
|
*
|
|
* RETURN VALUE: None.
|
|
*
|
|
* USED GLOBAL VARIABLES:
|
|
*
|
|
* AFFECTED GLOBAL VARIABLES/SIDE EFFECTS:
|
|
*
|
|
* NOTES:
|
|
*
|
|
*---------------------------------------------------------------------------*/
|
|
|
|
static void lan_init_queue( T_RS232_QUEUE *p_queue )
|
|
|
|
{
|
|
long i;
|
|
|
|
/*
|
|
* We set "head" equal to "tail" implying the queue is empty,
|
|
* BUT the "head" and "tail" should each point to valid queue
|
|
* positions.
|
|
*/
|
|
|
|
p_queue->head_index = 0;
|
|
p_queue->tail_index = 0;
|
|
|
|
p_queue->overflows = 0;
|
|
|
|
p_queue->gdb_packet_start = -1;
|
|
p_queue->gdb_packet_end = -1;
|
|
|
|
p_queue->gdb_packet_csum1 = -1;
|
|
p_queue->gdb_packet_csum2 = -1;
|
|
|
|
for ( i = 0; i < MAX_RS232_CHARS; ++i )
|
|
{
|
|
p_queue->buf[ i ] = 0;
|
|
}
|
|
|
|
return;
|
|
}
|
|
/* end of 'lan_init_queue'
|
|
*===========================================================================*/
|
|
|
|
|
|
/*-----------------------------------------------------------------------------
|
|
*
|
|
* FUNCTION NAME: lan_add_to_queue
|
|
*
|
|
*
|
|
* DESCRIPTION: Adds the specified character to the tail of the
|
|
* specified queue. Observes "oldest thrown on floor"
|
|
* rule (i.e. the queue is allowed to "wrap" and the
|
|
* input character is unconditionally placed at the
|
|
* tail of the queue.
|
|
*
|
|
*
|
|
* RETURN VALUE: None.
|
|
*
|
|
*
|
|
* USED GLOBAL VARIABLES:
|
|
*
|
|
*
|
|
* AFFECTED GLOBAL VARIABLES/SIDE EFFECTS:
|
|
*
|
|
*
|
|
* NOTES:
|
|
*
|
|
*
|
|
*---------------------------------------------------------------------------*/
|
|
|
|
static void lan_add_to_queue( long c, T_RS232_QUEUE *p_queue )
|
|
|
|
{
|
|
|
|
if ( p_queue ) /* Sanity check. */
|
|
{
|
|
|
|
if ( c & 0x000000FF ) /* We don't allow NULL characters to be added to a queue. */
|
|
{
|
|
/* Insert the new character at the tail of the queue. */
|
|
|
|
p_queue->buf[ p_queue->tail_index ] = (UCHAR) (c & 0x000000FF);
|
|
|
|
/* Increment the tail index. */
|
|
|
|
if ( MAX_RS232_CHARS <= ++(p_queue->tail_index) )
|
|
{
|
|
p_queue->tail_index = 0;
|
|
}
|
|
|
|
/* Check for wrapping (i.e. overflow). */
|
|
|
|
if ( p_queue->head_index == p_queue->tail_index )
|
|
{
|
|
/* If the tail has caught up to the head record the overflow . . . */
|
|
|
|
++(p_queue->overflows);
|
|
|
|
/* . . . then increment the head index. */
|
|
|
|
if ( MAX_RS232_CHARS <= ++(p_queue->head_index) )
|
|
{
|
|
p_queue->head_index = 0;
|
|
}
|
|
|
|
}
|
|
|
|
} /* End of 'if ( c & 0x000000FF )'. */
|
|
|
|
} /* End of 'if ( p_queue )'. */
|
|
|
|
|
|
return;
|
|
}
|
|
/* end of 'lan_add_to_queue'
|
|
*===========================================================================*/
|
|
|
|
|
|
/*-----------------------------------------------------------------------------
|
|
*
|
|
* FUNCTION NAME: lan_next_queue_char
|
|
*
|
|
* DESCRIPTION:
|
|
*
|
|
* RETURN VALUE:
|
|
*
|
|
* USED GLOBAL VARIABLES:
|
|
*
|
|
* AFFECTED GLOBAL VARIABLES/SIDE EFFECTS:
|
|
*
|
|
* NOTES:
|
|
*
|
|
*---------------------------------------------------------------------------*/
|
|
|
|
static UCHAR lan_next_queue_char( T_RS232_QUEUE *p_queue )
|
|
|
|
{
|
|
UCHAR c;
|
|
|
|
|
|
c = 0;
|
|
|
|
if ( p_queue )
|
|
{
|
|
|
|
if ( p_queue->head_index != p_queue->tail_index )
|
|
{
|
|
/* Return the 'oldest' character in the queue. */
|
|
|
|
c = p_queue->buf[ p_queue->head_index ];
|
|
|
|
/* Increment the head index. */
|
|
|
|
if ( MAX_RS232_CHARS <= ++(p_queue->head_index) )
|
|
{
|
|
p_queue->head_index = 0;
|
|
}
|
|
|
|
}
|
|
|
|
} /* End of 'if ( p_queue )'. */
|
|
|
|
|
|
return( c );
|
|
}
|
|
|
|
/* end of 'lan_next_queue_char'
|
|
*===========================================================================*/
|
|
|
|
|
|
/*-----------------------------------------------------------------------------
|
|
*
|
|
* FUNCTION NAME: lan_util_menu
|
|
*
|
|
* DESCRIPTION: Prints out a brief help on the LAN UART control utility.
|
|
*
|
|
* RETURN VALUE: None.
|
|
*
|
|
* USED GLOBAL VARIABLES: None.
|
|
*
|
|
* AFFECTED GLOBAL VARIABLES/SIDE EFFECTS: None.
|
|
*
|
|
* NOTES: None.
|
|
*
|
|
*---------------------------------------------------------------------------*/
|
|
|
|
static void lan_util_menu( void )
|
|
|
|
{
|
|
|
|
/*
|
|
* Multiply calling printp() below is made due to the limitations
|
|
* of printp(), incapable of handling long formatting constants:
|
|
*/
|
|
|
|
printp( "\n -- Options --\n\n" );
|
|
|
|
printp( " %2X,'INIT' ............... Reset & (Re)INITIALIZE Interface.\n", (ULONG) LAN_UTIL_CODE );
|
|
printp( " %2X,'BAUD',<rate> ........ Set BAUD Rate.\n", (ULONG) LAN_UTIL_CODE );
|
|
printp( " %2X,'INTR',<mode> ........ Toggle 'RxRDY' Interrupts.\n", (ULONG) LAN_UTIL_CODE );
|
|
printp( " %2X,'XMT',<mode> ......... Toggle TRANSMIT-via-backplane.\n", (ULONG) LAN_UTIL_CODE );
|
|
printp( " %2X,'STAT' ............... Display STATUS.\n", (ULONG) LAN_UTIL_CODE );
|
|
printp( " %2X,'ECHO',<mode> ........ Enable/Disable Test ECHO.\n", (ULONG) LAN_UTIL_CODE );
|
|
printp( " %2X,'IN',<action> ........ Access INPUT Queue.\n", (ULONG) LAN_UTIL_CODE );
|
|
printp( " %2X,'OUT',<action> ....... Access OUTPUT Queue.\n\n", (ULONG) LAN_UTIL_CODE );
|
|
|
|
printp( " %2X,'PUTC',<char> ........ Output a Character (i.e. <char>).\n\n", (ULONG) LAN_UTIL_CODE );
|
|
|
|
/***
|
|
printp( " %2X,'WPM',address,word ... Write Protected Memory Test.\n\n", (ULONG) LAN_UTIL_CODE );
|
|
***/
|
|
|
|
printp( " <rate>: 4800 <mode>: E - enable <action>: C - clear/reset\n" );
|
|
printp( " 9600 D - disable D - display\n" );
|
|
printp( " 19200 F - fetch next char\n" );
|
|
printp( " 38400\n" );
|
|
}
|
|
/* end of 'lan_util_menu'
|
|
*===========================================================================*/
|
|
|
|
|
|
/* Thu Feb 5 17:14:41 EST 1998 CYGNUS...CYGNUS...CYGNUS...CYGNUS...CYGNUS...CYGNUS...CYGNUS...CYGNUS */
|
|
|
|
|
|
static long get_gdb_input( long c, T_RS232_QUEUE * p_input_q )
|
|
|
|
{
|
|
|
|
/* Now to detect when we've got a gdb packet... */
|
|
|
|
if ( '$' == c ) { /* char marks beginning of a packet */
|
|
|
|
if ( -1 != p_input_q->gdb_packet_start ||
|
|
-1 != p_input_q->gdb_packet_end ||
|
|
-1 != p_input_q->gdb_packet_csum1 ||
|
|
-1 != p_input_q->gdb_packet_csum2 ) { /* PROTOCOL ERROR */
|
|
|
|
/* NEW: Actually, this probably means that we muffed a packet,
|
|
and GDB has already resent it. The thing to do now is to
|
|
throw away the one we WERE working on, but immediately start
|
|
accepting the new one. Don't NAK, or GDB will have to try
|
|
and send it yet a third time! */
|
|
|
|
/*NACK_PKT( );*/ /*<ETHERNET>*/
|
|
discard_packet( ); /* throw away old packet */
|
|
lan_add_to_queue ('$', p_input_q); /* put the new "$" back in */
|
|
return 0;
|
|
} else { /* match new "$" */
|
|
p_input_q->gdb_packet_start = p_input_q->tail_index;
|
|
p_input_q->gdb_packet_end =
|
|
p_input_q->gdb_packet_csum1 =
|
|
p_input_q->gdb_packet_csum2 = -1;
|
|
}
|
|
} else if ( '#' == c ) { /* # marks end of packet (except for checksum) */
|
|
|
|
if ( -1 == p_input_q->gdb_packet_start ||
|
|
-1 != p_input_q->gdb_packet_end ||
|
|
-1 != p_input_q->gdb_packet_csum1 ||
|
|
-1 != p_input_q->gdb_packet_csum2 ) { /* PROTOCOL ERROR */
|
|
|
|
/* Garbled packet. Discard, but do not NAK. */
|
|
|
|
/*NACK_PKT( );*/ /*<ETHERNET>*/
|
|
discard_packet( );
|
|
return -1;
|
|
}
|
|
p_input_q->gdb_packet_end = p_input_q->tail_index;
|
|
p_input_q->gdb_packet_csum1 = p_input_q->gdb_packet_csum2 = -1;
|
|
|
|
} else if ( -1 != p_input_q->gdb_packet_start &&
|
|
-1 != p_input_q->gdb_packet_end) {
|
|
|
|
if ( isxdigit( c ) ) { /* char is one of two checksum digits for packet */
|
|
|
|
if ( -1 == p_input_q->gdb_packet_csum1 &&
|
|
LAN_Q_MOD( p_input_q->gdb_packet_end + 1 ) ==
|
|
p_input_q->tail_index ) {
|
|
|
|
/* first checksum digit */
|
|
|
|
p_input_q->gdb_packet_csum1 = p_input_q->tail_index;
|
|
p_input_q->gdb_packet_csum2 = -1;
|
|
|
|
} else if ( -1 == p_input_q->gdb_packet_csum2 &&
|
|
LAN_Q_MOD( p_input_q->gdb_packet_end + 2 ) ==
|
|
p_input_q->tail_index ) {
|
|
|
|
/* second checksum digit: packet is complete! */
|
|
|
|
p_input_q->gdb_packet_csum2 = p_input_q->tail_index;
|
|
getpacket(); /* got a packet -- extract it */
|
|
|
|
} else { /* probably can't happen (um... three hex digits?) */
|
|
|
|
/* PROTOCOL ERROR */
|
|
/* Not sure how this can happen, but ...
|
|
discard it, but do not NAK it. */
|
|
/*NACK_PKT( );*/ /*<ETHERNET>*/
|
|
discard_packet( );
|
|
return -1;
|
|
}
|
|
|
|
} else { /* '#' followed by non-hex char */
|
|
|
|
/* PROTOCOL ERROR */
|
|
/* Bad packet -- discard but do not NAK */
|
|
/*NACK_PKT( );*/ /*<ETHERNET>*/
|
|
discard_packet( );
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
|
|
#ifdef STANDALONE
|
|
|
|
/* stand-alone stand-alone stand-alone stand-alone stand-alone stand-alone
|
|
stand-alone stand-alone
|
|
stand-alone Enable stand-alone build, for ease of debugging stand-alone
|
|
stand-alone stand-alone
|
|
stand-alone stand-alone stand-alone stand-alone stand-alone stand-alone */
|
|
|
|
long write_to_protected_mem (addr, word)
|
|
void *addr;
|
|
unsigned short word;
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
|
|
char dummy_memory[0x4000];
|
|
|
|
int main ( void )
|
|
{
|
|
long c;
|
|
|
|
lan_init_queue( &lan_input_queue );
|
|
printf( "Stand-alone EMC 'stub', pid = %d\n", getpid( ) );
|
|
printf( "Start of simulated 'memory': 0x%08x\n", &dummy_memory);
|
|
while ( (c = getc( stdin ) ) != EOF )
|
|
{
|
|
if ( c == '\\' ) /* escape char */
|
|
break;
|
|
|
|
lan_add_to_queue( c, &lan_input_queue );
|
|
get_gdb_input (c, &lan_input_queue);
|
|
fflush( stdout );
|
|
}
|
|
|
|
printf( "Goodbye!\n" );
|
|
exit( 0 );
|
|
}
|
|
|
|
#define SRAM_START ((void *) (&dummy_memory[0] + 0x00000000))
|
|
#define SRAM_END ((void *) (&dummy_memory[0] + 0x00000400))
|
|
|
|
#define RO_AREA_START ((void *) (&dummy_memory[0] + 0x00000100))
|
|
#define RO_AREA_END ((void *) (&dummy_memory[0] + 0x00000300))
|
|
|
|
#define NVD_START ((void *) (&dummy_memory[0] + 0x00003000))
|
|
#define NVD_END ((void *) (&dummy_memory[0] + 0x00003100))
|
|
|
|
#else /* normal stub (not stand-alone) */
|
|
|
|
#define SRAM_START ((void *) 0x00000000)
|
|
#define SRAM_END ((void *) 0x00400000)
|
|
|
|
#define RO_AREA_START ((void *) 0x00100000)
|
|
#define RO_AREA_END ((void *) 0x00300000)
|
|
|
|
#define NVD_START ((void *) 0x03000000)
|
|
#define NVD_END ((void *) 0x03100000)
|
|
|
|
#endif /* STANDALONE */
|
|
|
|
|
|
|
|
|
|
/* gdb gdb gdb gdb gdb gdb gdb gdb gdb gdb gdb gdb gdb gdb gdb gdb gdb gdb
|
|
gdb gdb
|
|
gdb Here begins the gdb stub section. gdb
|
|
gdb The following functions were added by Cygnus, gdb
|
|
gdb to make this thing act like a gdb stub. gdb
|
|
gdb gdb
|
|
gdb gdb gdb gdb gdb gdb gdb gdb gdb gdb gdb gdb gdb gdb gdb gdb gdb gdb */
|
|
|
|
|
|
/* ------------------- global defines and data decl's -------------------- */
|
|
|
|
#define hexchars "0123456789abcdef"
|
|
|
|
/* there are 180 bytes of registers on a 68020 w/68881 */
|
|
/* many of the fpa registers are 12 byte (96 bit) registers */
|
|
#define NUMREGBYTES 180
|
|
#define NUMREGS 29
|
|
#define REGISTER_BYTE(regno) regno
|
|
|
|
enum regnames { D0, D1, D2, D3, D4, D5, D6, D7,
|
|
A0, A1, A2, A3, A4, A5, A6, A7,
|
|
PS, PC,
|
|
FP0, FP1,
|
|
FP2, FP3,
|
|
FP4, FP5,
|
|
FP6, FP7,
|
|
FPCONTROL, FPSTATUS, FPIADDR
|
|
};
|
|
|
|
unsigned long registers[NUMREGBYTES/4];
|
|
|
|
static long remote_debug;
|
|
|
|
#define BUFMAX MAX_IO_BUF_SIZE
|
|
static char inbuffer[BUFMAX], outbuffer[BUFMAX];
|
|
static char spare_buffer[BUFMAX];
|
|
|
|
|
|
struct stub_trace_frame
|
|
{
|
|
int valid;
|
|
unsigned long frame_id;
|
|
unsigned long tdp_id;
|
|
FRAME_DEF *frame_data;
|
|
COLLECTION_FORMAT_DEF *format;
|
|
unsigned long traceregs[NUMREGBYTES/4];
|
|
unsigned char *stack_data;
|
|
unsigned char *memrange_data;
|
|
} curframe;
|
|
|
|
/* ------------------- function prototypes -------------------- */
|
|
|
|
void handle_request ( char * );
|
|
|
|
/* ------------------- Implementation -------------------- */
|
|
|
|
static void
|
|
discard_packet( void )
|
|
{
|
|
lan_input_queue.head_index = lan_input_queue.tail_index;
|
|
|
|
lan_input_queue.gdb_packet_start =
|
|
lan_input_queue.gdb_packet_end =
|
|
lan_input_queue.gdb_packet_csum1 =
|
|
lan_input_queue.gdb_packet_csum2 = -1;
|
|
}
|
|
|
|
/* Utility function: convert an ASCII isxdigit to a hex nybble */
|
|
|
|
static long
|
|
hex( char ch )
|
|
{
|
|
if ( (ch >= 'A') && (ch <= 'F') )
|
|
return ch - 'A' + 10;
|
|
if ( (ch >= 'a') && (ch <= 'f') )
|
|
return ch - 'a' + 10;
|
|
if ( (ch >= '0') && (ch <= '9') )
|
|
return ch - '0';
|
|
return -1;
|
|
}
|
|
|
|
static void
|
|
getpacket( void )
|
|
{
|
|
unsigned char our_checksum, their_checksum;
|
|
char *copy = inbuffer;
|
|
unsigned char c;
|
|
|
|
our_checksum = 0;
|
|
|
|
/* first find the '$' */
|
|
while ((c = lan_next_queue_char ( &lan_input_queue )) != '$')
|
|
if (c == 0) /* ??? Protocol error? (paranoia) */
|
|
{
|
|
/* PROTOCOL ERROR (missing '$') */
|
|
/*NACK_PKT( );*/ /*<ETHERNET>*/
|
|
return;
|
|
}
|
|
|
|
/* Now copy the message (up to the '#') */
|
|
for (c = lan_next_queue_char ( &lan_input_queue ); /* skip the '$' */
|
|
c != 0 && c != '#'; /* stop at the '#' */
|
|
c = lan_next_queue_char ( &lan_input_queue ))
|
|
{
|
|
*copy++ = c;
|
|
our_checksum += c;
|
|
}
|
|
*copy++ = '\0'; /* terminate the copy */
|
|
|
|
if (c == 0) /* ??? Protocol error? (paranoia) */
|
|
{
|
|
/* PROTOCOL ERROR (missing '#') */
|
|
/*NACK_PKT( );*/ /*<ETHERNET>*/
|
|
return;
|
|
}
|
|
their_checksum = hex( lan_next_queue_char ( &lan_input_queue ) ) << 4;
|
|
their_checksum += hex( lan_next_queue_char ( &lan_input_queue ) );
|
|
|
|
/* Now reset the queue packet-recognition bits */
|
|
discard_packet( );
|
|
|
|
if ( remote_debug ||
|
|
our_checksum == their_checksum )
|
|
{
|
|
ACK_PKT( ); /* good packet */
|
|
/* Parse and process the packet */
|
|
handle_request( inbuffer );
|
|
}
|
|
else
|
|
/* PROTOCOL ERROR (bad check sum) */
|
|
NACK_PKT( );
|
|
}
|
|
|
|
/* EMC will provide a better implementation
|
|
(perhaps just of LAN_PUT_CHAR) that does not block.
|
|
For now, this works. */
|
|
|
|
|
|
static void
|
|
putpacket( char *str )
|
|
{
|
|
unsigned char checksum;
|
|
|
|
/* '$'<packet>'#'<checksum> */
|
|
|
|
if ( VIA_ETHERNET == gdb_host_comm )
|
|
{
|
|
char *p_out;
|
|
long length;
|
|
|
|
p_out = eth_outbuffer;
|
|
length = 0;
|
|
|
|
|
|
if ( YES == gdb_cat_ack )
|
|
{
|
|
*p_out++ = '+';
|
|
++length;
|
|
}
|
|
|
|
gdb_cat_ack = NO;
|
|
|
|
|
|
*p_out++ = '$';
|
|
++length;
|
|
|
|
checksum = 0;
|
|
|
|
while ( *str )
|
|
{
|
|
*p_out++ = *str;
|
|
++length;
|
|
checksum += *str++;
|
|
}
|
|
|
|
*p_out++ = '#';
|
|
*p_out++ = hexchars[checksum >> 4];
|
|
*p_out = hexchars[checksum % 16];
|
|
length += 3;
|
|
|
|
eth_to_gdb( (UCHAR *) eth_outbuffer, length );
|
|
}
|
|
|
|
else
|
|
{
|
|
|
|
/* via RS-232 */
|
|
do {
|
|
LAN_PUT_CHAR( '$' );
|
|
checksum = 0;
|
|
|
|
while ( *str )
|
|
{
|
|
LAN_PUT_CHAR( *str );
|
|
checksum += *str++;
|
|
}
|
|
|
|
LAN_PUT_CHAR( '#' );
|
|
LAN_PUT_CHAR( hexchars[checksum >> 4] );
|
|
LAN_PUT_CHAR( hexchars[checksum % 16] );
|
|
} while ( 0 /* get_debug_char( ) != '+' */ );
|
|
/* XXX FIXME: not waiting for the ack. */
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
/*-----------------------------------------------------------------------------
|
|
*
|
|
* FUNCTION NAME: gdb_get_eth_input
|
|
*
|
|
*
|
|
* DESCRIPTION:
|
|
*
|
|
*
|
|
* RETURN VALUE: None.
|
|
*
|
|
*
|
|
* USED GLOBAL VARIABLES:
|
|
*
|
|
*
|
|
* AFFECTED GLOBAL VARIABLES/SIDE EFFECTS:
|
|
*
|
|
*
|
|
* NOTES:
|
|
*
|
|
*
|
|
*---------------------------------------------------------------------------*/
|
|
|
|
void gdb_get_eth_input( unsigned char *buf, long length )
|
|
|
|
{
|
|
|
|
gdb_host_comm = VIA_ETHERNET;
|
|
|
|
for ( ; 0 < length; ++buf, --length)
|
|
{
|
|
|
|
if ( *buf == CONTROL_C )
|
|
{
|
|
/* can't stop the target, but we can tell gdb to stop waiting... */
|
|
discard_packet( );
|
|
putpacket( "S03" ); /* send back SIGINT to the debugger */
|
|
}
|
|
|
|
else
|
|
{
|
|
lan_add_to_queue( (long) *buf, &lan_input_queue );
|
|
get_gdb_input( (long) *buf, &lan_input_queue );
|
|
}
|
|
|
|
}
|
|
|
|
|
|
return;
|
|
}
|
|
/* end of 'gdb_get_eth_input'
|
|
*===========================================================================*/
|
|
|
|
|
|
|
|
|
|
/* STDOUT STDOUT STDOUT STDOUT STDOUT STDOUT STDOUT STDOUT STDOUT STDOUT
|
|
Stuff pertaining to simulating stdout by sending chars to gdb to be echoed.
|
|
|
|
Dear reader:
|
|
This code is based on the premise that if GDB receives a packet
|
|
from the stub that begins with the character CAPITAL-OH, GDB will
|
|
echo the rest of the packet to GDB's console / stdout. This gives
|
|
the stub a way to send a message directly to the user. In practice,
|
|
(as currently implemented), GDB will only accept such a packet when
|
|
it believes the target to be running (ie. when you say STEP or
|
|
CONTINUE); at other times it does not expect it. This will probably
|
|
change as a side effect of the "asynchronous" behavior.
|
|
|
|
Functions: gdb_putchar(char ch)
|
|
gdb_write(char *str, int len)
|
|
gdb_puts(char *str)
|
|
gdb_error(char *format, char *parm)
|
|
*/
|
|
|
|
#if 0 /* avoid compiler warning while this is not used */
|
|
|
|
/* Function: gdb_putchar(int)
|
|
Make gdb write a char to stdout.
|
|
Returns: the char */
|
|
|
|
static int
|
|
gdb_putchar( long ch )
|
|
{
|
|
char buf[4];
|
|
|
|
buf[0] = 'O';
|
|
buf[1] = hexchars[ch >> 4];
|
|
buf[2] = hexchars[ch & 0x0F];
|
|
buf[3] = 0;
|
|
putpacket( buf );
|
|
return ch;
|
|
}
|
|
#endif
|
|
|
|
/* Function: gdb_write(char *, int)
|
|
Make gdb write n bytes to stdout (not assumed to be null-terminated).
|
|
Returns: number of bytes written */
|
|
|
|
static int
|
|
gdb_write( char *data, long len )
|
|
{
|
|
char *buf, *cpy;
|
|
long i;
|
|
|
|
buf = outbuffer;
|
|
buf[0] = 'O';
|
|
i = 0;
|
|
while ( i < len )
|
|
{
|
|
for ( cpy = buf+1;
|
|
i < len && cpy < buf + BUFMAX - 3;
|
|
i++ )
|
|
{
|
|
*cpy++ = hexchars[data[i] >> 4];
|
|
*cpy++ = hexchars[data[i] & 0x0F];
|
|
}
|
|
*cpy = 0;
|
|
putpacket( buf );
|
|
}
|
|
return len;
|
|
}
|
|
|
|
/* Function: gdb_puts(char *)
|
|
Make gdb write a null-terminated string to stdout.
|
|
Returns: the length of the string */
|
|
|
|
static int
|
|
gdb_puts( char *str )
|
|
{
|
|
return gdb_write( str, strlen( str ) );
|
|
}
|
|
|
|
/* Function: gdb_error(char *, char *)
|
|
Send an error message to gdb's stdout.
|
|
First string may have 1 (one) optional "%s" in it, which
|
|
will cause the optional second string to be inserted. */
|
|
|
|
#if 0
|
|
static void
|
|
gdb_error( char *format, char *parm )
|
|
{
|
|
static char buf[400];
|
|
char *cpy;
|
|
long len;
|
|
|
|
if ( remote_debug )
|
|
{
|
|
if ( format && *format )
|
|
len = strlen( format );
|
|
else
|
|
return; /* empty input */
|
|
|
|
if ( parm && *parm )
|
|
len += strlen( parm );
|
|
|
|
for ( cpy = buf; *format; )
|
|
{
|
|
if ( format[0] == '%' && format[1] == 's' ) /* include 2nd string */
|
|
{
|
|
format += 2; /* advance two chars instead of just one */
|
|
while ( parm && *parm )
|
|
*cpy++ = *parm++;
|
|
}
|
|
else
|
|
*cpy++ = *format++;
|
|
}
|
|
*cpy = '\0';
|
|
gdb_puts( buf );
|
|
}
|
|
}
|
|
#endif
|
|
|
|
static void gdb_note (char *, int);
|
|
static int error_ret (int, char *, int);
|
|
|
|
static unsigned long
|
|
elinum_to_index (unsigned long elinum)
|
|
{
|
|
if ((elinum & 0xf0) == 0xd0)
|
|
return (elinum & 0x0f);
|
|
else if ((elinum & 0xf0) == 0xa0)
|
|
return (elinum & 0x0f) + 8;
|
|
else
|
|
return -1;
|
|
}
|
|
|
|
static long
|
|
index_to_elinum (unsigned long index)
|
|
{
|
|
if (index <= 7)
|
|
return index + 0xd0;
|
|
else if (index <= 15)
|
|
return (index - 8) + 0xa0;
|
|
else
|
|
return -1;
|
|
}
|
|
|
|
|
|
/*
|
|
READMEM READMEM READMEM READMEM READMEM READMEM READMEM READMEM READMEM
|
|
|
|
The following code pertains to reading memory from the target.
|
|
Some sort of exception handling should be added to make it safe.
|
|
|
|
READMEM READMEM READMEM READMEM READMEM READMEM READMEM READMEM READMEM
|
|
|
|
Safe Memory Access:
|
|
|
|
All reads and writes into the application's memory will pass thru
|
|
get_uchar() or set_uchar(), which check whether accessing their
|
|
argument is legal before actual access (thus avoiding a bus error).
|
|
|
|
*/
|
|
|
|
enum { SUCCESS = 0, FAIL = -1 };
|
|
|
|
#if 0
|
|
static long get_uchar ( const unsigned char * );
|
|
#endif
|
|
static long set_uchar ( unsigned char *, unsigned char );
|
|
static long read_access_violation ( const void * );
|
|
static long write_access_violation ( const void * );
|
|
static long read_access_range(const void *, long);
|
|
static DTC_RESPONSE find_memory(unsigned char *,long,unsigned char **,long *);
|
|
|
|
static int
|
|
dtc_error_ret (int ret, char *src, DTC_RESPONSE code)
|
|
{
|
|
if (src)
|
|
sprintp (spare_buffer,
|
|
"'%s' returned DTC error '%s'.\n", src, get_err_text (code));
|
|
else
|
|
sprintp (spare_buffer, "DTC error '%s'.\n", get_err_text (code));
|
|
|
|
gdb_puts (spare_buffer);
|
|
return ret;
|
|
}
|
|
|
|
|
|
#if 0
|
|
/* I think this function is unnecessary since the introduction of
|
|
adbg_find_memory_addr_in_frame. */
|
|
|
|
/* Return the number of expressions in the format associated with a
|
|
given trace frame. */
|
|
static int
|
|
count_frame_exprs (FRAME_DEF *frame)
|
|
{
|
|
CFD *format;
|
|
T_EXPR *expr;
|
|
int num_exprs;
|
|
|
|
/* Get the format from the frame. */
|
|
get_frame_format_pointer (frame, &format);
|
|
|
|
/* Walk the linked list of expressions, and count the number of
|
|
expressions we find there. */
|
|
num_exprs = 0;
|
|
for (expr = format->p_cfd_expr; expr; expr = expr->next)
|
|
num_exprs++;
|
|
|
|
return num_exprs;
|
|
}
|
|
#endif
|
|
|
|
#if 0
|
|
/* Function: get_frame_addr
|
|
*
|
|
* Description: If the input memory address was collected in the
|
|
* current trace frame, then lookup and return the address
|
|
* from within the trace buffer from which the collected byte
|
|
* may be retrieved. Else return -1. */
|
|
|
|
unsigned char *
|
|
get_frame_addr ( const unsigned char *addr )
|
|
{
|
|
unsigned char *base, *regs, *stack, *mem;
|
|
CFD *dummy;
|
|
DTC_RESPONSE ret;
|
|
|
|
/* first, see if addr is on the saved piece of stack for curframe */
|
|
if (curframe.format->stack_size > 0 &&
|
|
(base = (unsigned char *) curframe.traceregs[A7]) <= addr &&
|
|
addr < base + curframe.format->stack_size)
|
|
{
|
|
gdb_puts("STUB: get_frame_addr: call get_addr_to_frame_regs_stack_mem\n");
|
|
if ((ret = get_addr_to_frame_regs_stack_mem (curframe.frame_data,
|
|
&dummy,
|
|
(void *) ®s,
|
|
(void *) &stack,
|
|
(void *) &mem))
|
|
!= OK_TARGET_RESPONSE)
|
|
return (void *) dtc_error_ret (-1,
|
|
"get_addr_to_frame_regs_stack_mem",
|
|
ret);
|
|
else
|
|
return stack + (addr - base);
|
|
}
|
|
|
|
/* Next, try to find addr in the current frame's expression-
|
|
collected memory blocks. I'm sure this is at least quadradic in
|
|
time. */
|
|
{
|
|
int num_exprs = count_frame_exprs (curframe.frame_data);
|
|
int expr, block;
|
|
|
|
/* Try each expression in turn. */
|
|
for (expr = 0; expr < num_exprs; expr++)
|
|
{
|
|
for (block = 0; ; block++)
|
|
{
|
|
T_EXPR_DATA *data;
|
|
if (adbg_get_expr_data (curframe.frame_data,
|
|
'x', expr, block,
|
|
&data)
|
|
!= OK_TARGET_RESPONSE)
|
|
break;
|
|
else if ((unsigned char *) data->address <= addr
|
|
&& addr < ((unsigned char *) data->address + data->size))
|
|
{
|
|
/* We have found the right block; is it valid data?
|
|
Upper-case stamps mean bad data. */
|
|
if ('A' <= data->stamp && data->stamp <= 'Z')
|
|
{
|
|
gdb_puts("STUB: get_frame_addr: adbg_get_expr_data INVALID\n");
|
|
return (unsigned char *) -1;
|
|
}
|
|
else
|
|
{
|
|
if (remote_debug > 1)
|
|
{
|
|
sprintp(spare_buffer,
|
|
"STUB: get_frame_addr: got it [%x,%x)\n",
|
|
data->address, data->address + data->size);
|
|
gdb_puts(spare_buffer);
|
|
}
|
|
|
|
return (((unsigned char *) &data->data)
|
|
+ (addr - (unsigned char *) data->address));
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
/* not found, return error */
|
|
return (unsigned char *) -1;
|
|
}
|
|
|
|
/*============================================================*/
|
|
|
|
static long get_uchar ( const unsigned char * addr )
|
|
{
|
|
unsigned char *frame_addr;
|
|
|
|
if ( read_access_violation ( addr ) )
|
|
return ( -1 ); /* Access error */
|
|
|
|
if (curframe.valid) /* if debugging a trace frame? */
|
|
{
|
|
/* If the requested address was collected in the current frame,
|
|
* then fetch and return the data from the trace buffer.
|
|
*/
|
|
if ((frame_addr = get_frame_addr (addr)) != (unsigned char *) -1)
|
|
return ( *frame_addr );
|
|
/* If the requested address is in the Code Section,
|
|
* let's be magnanimous and read it anyway (else we shall
|
|
* not be able to disassemble, find function prologues, etc.)
|
|
*/
|
|
else if (CS_CODE_START <= (unsigned long) addr &&
|
|
(unsigned long) addr < CS_CODE_START + CS_CODE_SIZE)
|
|
return (*addr);
|
|
else
|
|
return ( -1 ); /* "Access error" (the data was not collected) */
|
|
}
|
|
else
|
|
/* Not debugging a trace frame, read the data from live memory. */
|
|
return ( *addr ); /* Meaningful result >= 0 */
|
|
}
|
|
#endif
|
|
|
|
/*============================================================*/
|
|
|
|
static long set_uchar ( unsigned char * addr, unsigned char val )
|
|
{
|
|
long check_result = write_access_violation ( addr );
|
|
|
|
if ( check_result != 0L )
|
|
return ( check_result ); /* Access error */
|
|
|
|
return ( *addr = val ); /* Successful writing */
|
|
}
|
|
|
|
/*============================================================*/
|
|
|
|
/*
|
|
* Function read_access_violation() below returns TRUE if dereferencing
|
|
* its argument for reading would cause a bus error - and FALSE otherwise:
|
|
*/
|
|
|
|
static long read_access_violation ( const void * addr )
|
|
{
|
|
return ( ( ( addr < SRAM_START ) || ( addr >= SRAM_END ) ) &&
|
|
( ( addr < NVD_START ) || ( addr >= NVD_END ) ) );
|
|
}
|
|
|
|
/*============================================================*/
|
|
|
|
/*
|
|
* Function write_access_violation() below returns zero if dereferencing
|
|
* its argument for writing is safe, -1 on a soft error (the argument
|
|
* falls into the write-protected area), -2 on a hard error (the argument
|
|
* points to a non-existent memory location). In other words, it returns
|
|
* FALSE when no bus error is expected - and an error code otherwise:
|
|
*/
|
|
|
|
static long write_access_violation ( const void * addr )
|
|
{
|
|
/*
|
|
* The boundaries of the write-protected area have to be received via
|
|
* an API provided in the Symmetrix core code. For now, these limits
|
|
* are hard-coded:
|
|
*/
|
|
|
|
if ( ( addr >= RO_AREA_START ) && ( addr < RO_AREA_END ) )
|
|
return ( -1 ); /* soft error */
|
|
|
|
if ( ( ( addr < SRAM_START ) || ( addr >= SRAM_END ) ) &&
|
|
( ( addr < NVD_START ) || ( addr >= NVD_END ) ) )
|
|
return ( -2 ); /* hard error */
|
|
|
|
return ( 0 );
|
|
}
|
|
|
|
|
|
/* read_access_range is like read_access_violation,
|
|
but returns the number of bytes we can read w/o faulting.
|
|
that is, it checks an address range and tells us what portion
|
|
(if any) of the prefix is safe to read without a bus error */
|
|
static long
|
|
read_access_range(const void *addr, long count)
|
|
{
|
|
if ((addr >= SRAM_START) && (addr < SRAM_END))
|
|
{
|
|
if ((char *)addr + count < (char *)SRAM_END)
|
|
return (count);
|
|
else
|
|
return ((char *)SRAM_END - (char *)addr);
|
|
}
|
|
else if (((char *)addr >= (char *)NVD_START) &&
|
|
((char *)addr < (char *)NVD_END))
|
|
{
|
|
if ((char *)addr + count < (char *)NVD_END)
|
|
return (count);
|
|
else
|
|
return ((char *)NVD_END - (char *)addr);
|
|
}
|
|
else
|
|
return (0);
|
|
}
|
|
|
|
/* Convert the memory pointed to by mem into hex, placing result in buf.
|
|
Return SUCCESS or FAIL.
|
|
If MAY_FAULT is non-zero, then we should return FAIL in response to
|
|
a fault; if zero treat a fault like any other fault in the stub. */
|
|
|
|
static long
|
|
mem2hex(unsigned char *mem, char *buf, long count, long may_fault)
|
|
{
|
|
long ndx;
|
|
long ndx2;
|
|
long ch;
|
|
long incr;
|
|
unsigned char *location;
|
|
DTC_RESPONSE status;
|
|
|
|
if (may_fault)
|
|
{
|
|
for (ndx = 0, incr = 1; (ndx < count) && (incr > 0); ndx += incr)
|
|
{
|
|
status = find_memory(mem, count - ndx, &location, &incr);
|
|
|
|
if (status == OK_TARGET_RESPONSE)
|
|
{
|
|
if (incr > 0)
|
|
{
|
|
for (ndx2 = 0; ndx2 < incr; ndx2++)
|
|
{
|
|
ch = *location++;
|
|
*buf++ = hexchars[ch >> 4];
|
|
*buf++ = hexchars[ch & 0xf];
|
|
}
|
|
mem += incr;
|
|
}
|
|
else if (incr <= 0) /* should never happen */
|
|
{
|
|
*buf = 0;
|
|
return (0);
|
|
}
|
|
}
|
|
else if (status == NOT_FOUND_TARGET_RESPONSE)
|
|
{
|
|
*buf = 0;
|
|
return (ndx); /* return amount copied */
|
|
}
|
|
else
|
|
{
|
|
*buf = 0;
|
|
return (0); /* XXX: how do we tell the user the status? */
|
|
}
|
|
}
|
|
*buf = 0;
|
|
return (count);
|
|
}
|
|
else
|
|
{
|
|
for (ndx = 0; ndx < count; ndx++)
|
|
{
|
|
ch = *mem++;
|
|
*buf++ = hexchars[ch >> 4];
|
|
*buf++ = hexchars[ch & 0xf];
|
|
}
|
|
*buf = 0;
|
|
return (count); /* we copied everything */
|
|
}
|
|
}
|
|
|
|
static DTC_RESPONSE
|
|
find_memory(unsigned char *mem, long count,
|
|
unsigned char **location, long *incr)
|
|
{
|
|
DTC_RESPONSE retval;
|
|
long length;
|
|
|
|
/* figure out how much of the memory range we can read w/o faulting */
|
|
count = read_access_range(mem, count);
|
|
if (count == 0)
|
|
return (NOT_FOUND_TARGET_RESPONSE);
|
|
|
|
if (curframe.valid)
|
|
{
|
|
unsigned char *mem_block;
|
|
unsigned char *mem_addr;
|
|
unsigned long mem_size;
|
|
unsigned long mem_stamp;
|
|
|
|
retval = adbg_find_memory_addr_in_frame(curframe.frame_data, mem,
|
|
(unsigned long **)&mem_block,
|
|
(unsigned long **)&mem_addr,
|
|
&mem_size, &mem_stamp);
|
|
|
|
switch (retval)
|
|
{
|
|
case OK_TARGET_RESPONSE:
|
|
#if 0
|
|
printp("FOUND: mem %x block %x addr %x size %d stamp %x\n",
|
|
mem, mem_block, mem_addr, mem_size, mem_stamp);
|
|
#endif
|
|
*location = mem_block + (mem - mem_addr);
|
|
length = mem_size - (mem - mem_addr);
|
|
|
|
if (length < count)
|
|
*incr = length;
|
|
else
|
|
*incr = count;
|
|
|
|
break;
|
|
|
|
case NOT_FOUND_TARGET_RESPONSE:
|
|
case NEAR_FOUND_TARGET_RESPONSE:
|
|
#if 0
|
|
printp("NOT FOUND: mem %x, checking code region\n", mem);
|
|
#endif
|
|
/* check to see if it's in the code region */
|
|
if ((CS_CODE_START <= (long)mem) &&
|
|
((long)mem < CS_CODE_START + CS_CODE_SIZE))
|
|
{
|
|
/* some or all of the address range is in the code */
|
|
*location = mem;
|
|
if ((long)mem + count <= CS_CODE_START + CS_CODE_SIZE)
|
|
*incr = count; /* it's totally in the code */
|
|
else
|
|
/* how much is in the code? */
|
|
*incr = CS_CODE_START + CS_CODE_SIZE - (long)mem;
|
|
#if 0
|
|
printp("FOUND in code region: %x\n", mem);
|
|
#endif
|
|
retval = OK_TARGET_RESPONSE;
|
|
}
|
|
else
|
|
retval = NOT_FOUND_TARGET_RESPONSE;
|
|
|
|
break;
|
|
|
|
default:
|
|
#if 0
|
|
printp("BAD RETURN: %d\n", retval);
|
|
#endif
|
|
retval = NOT_FOUND_TARGET_RESPONSE;
|
|
break;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
*location = mem;
|
|
*incr = count;
|
|
retval = OK_TARGET_RESPONSE;
|
|
}
|
|
|
|
return (retval);
|
|
}
|
|
|
|
/* Convert the hex array pointed to by buf into binary to be placed in mem.
|
|
Return SUCCESS or FAIL. */
|
|
|
|
static long
|
|
hex2mem( char *buf, unsigned char *mem, long count, long may_fault )
|
|
{
|
|
long i, ch;
|
|
|
|
for ( i=0; i<count; i++ )
|
|
{
|
|
ch = hex( *buf++ ) << 4;
|
|
ch = ch + hex( *buf++ );
|
|
if ( may_fault )
|
|
{
|
|
ch = set_uchar( mem++, ch );
|
|
if ( ch < 0 ) /* negative return indicates error */
|
|
return FAIL;
|
|
}
|
|
else
|
|
*mem++ = ch;
|
|
}
|
|
return SUCCESS;
|
|
}
|
|
|
|
/**********************************************/
|
|
/* WHILE WE FIND NICE HEX CHARS, BUILD AN INT */
|
|
/* RETURN NUMBER OF CHARS PROCESSED */
|
|
/**********************************************/
|
|
|
|
static int
|
|
hexToInt( char **ptr, unsigned long *intValue )
|
|
{
|
|
long numChars = 0;
|
|
long hexValue;
|
|
|
|
*intValue = 0;
|
|
while ( **ptr )
|
|
{
|
|
hexValue = hex( **ptr );
|
|
if ( hexValue >=0 )
|
|
{
|
|
*intValue = (*intValue << 4) | hexValue;
|
|
numChars ++;
|
|
}
|
|
else
|
|
break;
|
|
(*ptr)++;
|
|
}
|
|
return numChars;
|
|
}
|
|
|
|
static volatile long gdb_handling_trap1;
|
|
static volatile long gdb_handling_sstrace;
|
|
static volatile long gdb_signo;
|
|
|
|
/*
|
|
Here is the "callable" stub entry point.
|
|
Call this function with a GDB request as an argument,
|
|
and it will service the request and return.
|
|
|
|
May be further broken up as we go along, with individual requests
|
|
broken out as separate functions.
|
|
*/
|
|
|
|
static char * handle_trace_query (char *);
|
|
static char * handle_trace_set (char *);
|
|
static int handle_format (char **request, CFD *format);
|
|
static unsigned long crc32 (unsigned char *buf, int len, unsigned long crc);
|
|
static char * crc_query (char *);
|
|
static char * handle_test (char *);
|
|
|
|
void
|
|
handle_request( char *request )
|
|
{
|
|
#if 0
|
|
remote_debug = 2;
|
|
#endif
|
|
switch( *request++ )
|
|
{
|
|
case 'k': /* "kill" */
|
|
curframe.valid = FALSE;
|
|
putpacket ("");
|
|
break;
|
|
case 'D': /* "detach" */
|
|
curframe.valid = FALSE;
|
|
putpacket ("");
|
|
break;
|
|
default: /* Unknown code. Return an empty reply message. */
|
|
putpacket( "" ); /* return empty packet */
|
|
break;
|
|
|
|
case 'H': /* Set thread for subsequent operations.
|
|
Hct... c = 'c' for thread used in step and continue;
|
|
t... can be -1 for all threads.
|
|
c = 'g' for thread used in other operations.
|
|
If zero, pick a thread, any thread. */
|
|
|
|
putpacket( "OK" );
|
|
break;
|
|
|
|
case 'g': /* Read registers.
|
|
Each byte of register data is described by
|
|
two hex digits. registers are in the
|
|
internal order for GDB, and the bytes in a
|
|
register are in the same order the machine
|
|
uses. */
|
|
{
|
|
/* Return the values in (one of) the registers cache(s).
|
|
Several situations may pertain:
|
|
1) We're synchronous, in which case the "registers" array
|
|
should actually be current.
|
|
2) We're asynchronous, in which case the "registers" array
|
|
holds whatever was cached most recently.
|
|
3) We're looking at a trace frame that was collected earlier:
|
|
we will return those earlier registers.
|
|
*/
|
|
|
|
/* all registers default to zero */
|
|
memset (outbuffer, '0', NUMREGBYTES);
|
|
outbuffer[NUMREGBYTES] = '\0';
|
|
|
|
if (curframe.valid) /* debugging a trace frame */
|
|
mem2hex( (unsigned char*) curframe.traceregs,
|
|
outbuffer, NUMREGBYTES, 0 );
|
|
else
|
|
mem2hex( (unsigned char*) registers, outbuffer, NUMREGBYTES, 0 );
|
|
|
|
putpacket( outbuffer );
|
|
}
|
|
break;
|
|
case 'G': /* Write registers.
|
|
Gxxxxxxxx Each byte of register data is described by
|
|
two hex digits. */
|
|
if (curframe.valid) /* debugging a trace frame */
|
|
putpacket ("E03"); /* can't write regs into a trace frame! */
|
|
else
|
|
{
|
|
/* Write the values into the local registers cache...
|
|
Note that no actual registers are being changed. */
|
|
|
|
hex2mem( request,
|
|
(unsigned char *) registers, NUMREGBYTES, 0 );
|
|
putpacket( "OK" );
|
|
}
|
|
break;
|
|
case 'P': /* Write (single) register.
|
|
Pnn=xxxxxxxx register nn gets value xxxxxxxx;
|
|
two hex digits for each byte in the register
|
|
(target byte order). */
|
|
|
|
if (curframe.valid)
|
|
putpacket ("E03"); /* can't write regs into a trace frame! */
|
|
else
|
|
{
|
|
unsigned long regno;
|
|
|
|
if ( hexToInt( &request, ®no ) && *(request++) == '=' )
|
|
{
|
|
if ( regno < NUMREGS )
|
|
{
|
|
hexToInt( &request,
|
|
(unsigned long *) ®isters[REGISTER_BYTE(regno)]);
|
|
|
|
putpacket( "OK" );
|
|
}
|
|
else
|
|
putpacket( "E01" ); /* bad packet or regno */
|
|
}
|
|
}
|
|
break;
|
|
case 'm': /* Read memory.
|
|
mAAAAAAAA,LLLL AAAAAAAA is address, LLLL is length.
|
|
Reply can be fewer bytes than requested
|
|
if able to read only part of the data. */
|
|
{
|
|
unsigned long addr, len;
|
|
|
|
if ( hexToInt( &request, &addr ) &&
|
|
*(request++) == ',' &&
|
|
hexToInt( &request, &len ) )
|
|
{
|
|
/* better not overwrite outbuffer! */
|
|
if ( len > (BUFMAX / 2) - 5 )
|
|
len = (BUFMAX / 2) - 5;
|
|
if (mem2hex((unsigned char *) addr, outbuffer, len, 1) == 0) /* XXX: eventually use returned value */
|
|
putpacket( "E03" ); /* read fault (access denied) */
|
|
else
|
|
putpacket( outbuffer ); /* read succeeded */
|
|
}
|
|
else
|
|
putpacket( "E01" ); /* badly formed read request */
|
|
|
|
}
|
|
break;
|
|
case 'M': /* Write memory.
|
|
Maaaaaaaa,llll:xxxx aaaaaaaa is address, llll is length;
|
|
xxxx is data to write. */
|
|
|
|
{
|
|
unsigned long addr, len;
|
|
|
|
if (curframe.valid) /* can't write memory into a trace frame! */
|
|
putpacket ("E03"); /* "access denied" */
|
|
else /*** if ( write_access_enabled ) ***/
|
|
{
|
|
if ( hexToInt( &request, &addr ) &&
|
|
*(request++) == ',' &&
|
|
hexToInt( &request, &len ) &&
|
|
*(request++) == ':' )
|
|
{
|
|
if (len == 2 &&
|
|
addr >= CS_CODE_START &&
|
|
addr <= LAST_CS_WORD)
|
|
{
|
|
unsigned long val;
|
|
|
|
if ( !hexToInt( &request, &val ) ||
|
|
write_to_protected_mem( (void *)addr, val ) )
|
|
putpacket( "E03" ); /* write fault (access denied) */
|
|
else
|
|
putpacket( "OK" ); /* write succeeded */
|
|
}
|
|
else
|
|
{
|
|
if ( hex2mem( request, (unsigned char*) addr, len, 1 ) )
|
|
putpacket( "E03" ); /* write fault (access denied) */
|
|
else
|
|
putpacket( "OK" ); /* write succeeded */
|
|
}
|
|
}
|
|
else
|
|
putpacket( "E02" ); /* badly formed write request */
|
|
}
|
|
}
|
|
break;
|
|
case 'c': /* Continue.
|
|
cAAAAAAAA AAAAAAAA is address from which to resume.
|
|
If omitted, resume at current PC. */
|
|
|
|
{
|
|
unsigned long addr;
|
|
|
|
if (curframe.valid)
|
|
{
|
|
/* Don't continue if debugging a trace frame! */
|
|
gdb_puts ("Error: can't continue!\n");
|
|
putpacket ("S03");
|
|
}
|
|
else
|
|
{
|
|
gdb_signo = 3;
|
|
if (isxdigit(request[0]))
|
|
{
|
|
hexToInt(&request, &addr);
|
|
registers[REGISTER_BYTE(PC)] = addr;
|
|
}
|
|
|
|
gdb_handling_trap1 = FALSE;
|
|
gdb_handling_sstrace = FALSE;
|
|
sss_trace_flag = '\0';
|
|
}
|
|
}
|
|
break;
|
|
case 's': /* Step.
|
|
sAAAAAAAA AAAAAAAA is address from which to begin stepping.
|
|
If omitted, begin stepping at current PC. */
|
|
{
|
|
unsigned long addr;
|
|
|
|
if (curframe.valid)
|
|
{
|
|
/* Don't step if debugging a trace frame! */
|
|
gdb_puts ("Error: can't step!\n");
|
|
putpacket ("S03");
|
|
}
|
|
else
|
|
{
|
|
gdb_signo = 3;
|
|
if (isxdigit(request[0]))
|
|
{
|
|
hexToInt(&request, &addr);
|
|
registers[REGISTER_BYTE(PC)] = addr;
|
|
}
|
|
|
|
gdb_handling_trap1 = FALSE;
|
|
gdb_handling_sstrace = FALSE;
|
|
sss_trace_flag = 't';
|
|
}
|
|
}
|
|
break;
|
|
case 'C': /* Continue with signal.
|
|
Cxx;AAAAAAAA xx is signal number in hex;
|
|
AAAAAAAA is adddress from which to resume.
|
|
If ;AAAAAAAA omitted, continue from PC. */
|
|
|
|
{
|
|
unsigned long addr = 0;
|
|
|
|
if (!gdb_handling_trap1 || curframe.valid)
|
|
{
|
|
/* Don't continue if not currently in synchronous mode,
|
|
or if currently debugging a trace frame! */
|
|
gdb_puts( "Error: can't continue!\n" );
|
|
putpacket( "S03" ); /* "sigquit" (better idea?) */
|
|
}
|
|
else
|
|
{
|
|
gdb_signo = 3;
|
|
if ( isxdigit( *request ) )
|
|
{
|
|
hex2mem( request, (unsigned char *) &gdb_signo, 2, 0 );
|
|
request += 2;
|
|
if ( *request == ';' && isxdigit( *++request ) )
|
|
{
|
|
hexToInt( &request, &addr );
|
|
registers[REGISTER_BYTE(PC)] = addr;
|
|
}
|
|
}
|
|
gdb_handling_trap1 = FALSE;
|
|
gdb_handling_sstrace = FALSE;
|
|
sss_trace_flag = '\0';
|
|
}
|
|
}
|
|
break;
|
|
case 'S': /* Step with signal.
|
|
Sxx;AAAAAAAA xx is signal number in hex;
|
|
AAAAAAAA is adddress from which to begin stepping.
|
|
If ;AAAAAAAA omitted, begin stepping from PC. */
|
|
{
|
|
unsigned long addr = 0;
|
|
|
|
if (!gdb_handling_trap1 || curframe.valid)
|
|
{
|
|
/* Don't step if not currently in synchronous mode,
|
|
or if currently debugging a trace frame! */
|
|
gdb_puts( "Error: can't step!\n" );
|
|
putpacket( "S03" ); /* "sigquit" (better idea?) */
|
|
}
|
|
else
|
|
{
|
|
gdb_signo = 3;
|
|
if ( isxdigit( *request ) )
|
|
{
|
|
hex2mem( request, (unsigned char *) &gdb_signo, 2, 0 );
|
|
request += 2;
|
|
if ( *request == ';' && isxdigit( *++request ) )
|
|
{
|
|
hexToInt( &request, &addr );
|
|
registers[REGISTER_BYTE(PC)] = addr;
|
|
}
|
|
}
|
|
gdb_handling_trap1 = FALSE;
|
|
gdb_handling_sstrace = FALSE;
|
|
sss_trace_flag = 't';
|
|
}
|
|
}
|
|
break;
|
|
case '?': /* Query the latest reason for stopping.
|
|
Should be same reply as was last generated
|
|
for step or continue. */
|
|
|
|
if ( gdb_signo == 0 )
|
|
gdb_signo = 3; /* default to SIGQUIT */
|
|
outbuffer[ 0 ] = 'S';
|
|
outbuffer[ 1 ] = hexchars[ gdb_signo >> 4 ];
|
|
outbuffer[ 2 ] = hexchars[ gdb_signo & 0xf ];
|
|
outbuffer[ 3 ] = 0;
|
|
putpacket( outbuffer );
|
|
break;
|
|
|
|
case 'd': /* Toggle debug mode
|
|
I'm sure we can think of something interesting. */
|
|
|
|
remote_debug = !remote_debug;
|
|
putpacket( "" ); /* return empty packet */
|
|
break;
|
|
|
|
case 'q': /* general query */
|
|
switch (*request++)
|
|
{
|
|
default:
|
|
putpacket (""); /* nak a request which we don't handle */
|
|
break;
|
|
case 'T': /* trace query */
|
|
putpacket (handle_trace_query (request));
|
|
break;
|
|
case 'C': /* crc query (?) */
|
|
if (*request++ == 'R' &&
|
|
*request++ == 'C' &&
|
|
*request++ == ':')
|
|
putpacket (crc_query (request));
|
|
else
|
|
putpacket (""); /* unknown query */
|
|
break;
|
|
}
|
|
break;
|
|
|
|
case 'Q': /* general set */
|
|
switch (*request++)
|
|
{
|
|
default:
|
|
putpacket (""); /* nak a request which we don't handle */
|
|
break;
|
|
case 'T': /* trace */
|
|
putpacket (handle_trace_set (request));
|
|
break;
|
|
}
|
|
break;
|
|
|
|
case 'T':
|
|
/* call test function: TAAA,BBB,CCC
|
|
A, B, and C are arguments to pass to gdb_c_test. Reply is
|
|
"E01" (bad arguments) or "OK" (test function called). */
|
|
putpacket (handle_test (request));
|
|
break;
|
|
}
|
|
}
|
|
|
|
static TDP_SETUP_INFO tdp_temp;
|
|
static int trace_running;
|
|
|
|
/*
|
|
* Function msgcmp:
|
|
*
|
|
* If second argument (str) is matched in first argument,
|
|
* then advance first argument past end of str and return "SAME"
|
|
* else return "DIFFERENT" without changing first argument.
|
|
*
|
|
* Return: zero for DIFFERENT, non-zero for SUCCESS
|
|
*/
|
|
|
|
static int
|
|
msgcmp (char **msgp, char *str)
|
|
{
|
|
char *next;
|
|
|
|
if (msgp != 0 && str != 0) /* input validation */
|
|
if ((next = *msgp) != 0)
|
|
{
|
|
for (;
|
|
*next && *str && *next == *str;
|
|
next++, str++)
|
|
;
|
|
|
|
if (*str == 0) /* matched all of str in msg */
|
|
return (int) (*msgp = next); /* advance msg ptr past str */
|
|
}
|
|
return 0; /* failure */
|
|
}
|
|
|
|
static char *
|
|
handle_trace_query (char *request)
|
|
{
|
|
if (msgcmp (&request, "Status"))
|
|
{
|
|
if (adbg_check_if_active ())
|
|
{
|
|
gdb_puts ("Target trace is running.\n");
|
|
return "T1";
|
|
}
|
|
else
|
|
{
|
|
gdb_puts ("Target trace not running.\n");
|
|
trace_running = 0;
|
|
return "T0";
|
|
}
|
|
}
|
|
else /* unknown trace query */
|
|
{
|
|
return "";
|
|
}
|
|
}
|
|
|
|
static void
|
|
gdb_note (char *fmt, int arg1)
|
|
{
|
|
if (remote_debug > 1)
|
|
{
|
|
sprintp (spare_buffer, fmt, arg1);
|
|
gdb_puts (spare_buffer);
|
|
}
|
|
}
|
|
|
|
static int
|
|
error_ret (int ret, char *fmt, int arg1)
|
|
{
|
|
if (remote_debug > 0)
|
|
{
|
|
sprintp (spare_buffer, fmt, arg1);
|
|
gdb_puts (spare_buffer);
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
static int
|
|
handle_format (char **request, COLLECTION_FORMAT_DEF *format)
|
|
{
|
|
MEMRANGE_DEF m;
|
|
DTC_RESPONSE ret;
|
|
int elinum;
|
|
unsigned long regnum;
|
|
long bytecodes[(MAX_BYTE_CODES + sizeof (struct t_expr_tag))/ 4];
|
|
struct t_expr_tag *t_expr = (struct t_expr_tag *)bytecodes;
|
|
|
|
if (format->id == 0)
|
|
{
|
|
if ((ret = get_unused_format_id (&format->id)) != OK_TARGET_RESPONSE)
|
|
return dtc_error_ret (-1, "get_unused_format_id", ret);
|
|
|
|
if (**request == 'R')
|
|
{
|
|
(*request)++;
|
|
hexToInt (request, &format->regs_mask);
|
|
}
|
|
gdb_note ("STUB: call define_format (id = %d, ", format->id);
|
|
gdb_note ("regs_mask = 0x%X);\n", format->regs_mask);
|
|
|
|
if ((ret = define_format (format)) != OK_TARGET_RESPONSE)
|
|
{
|
|
sprintp (spare_buffer,
|
|
"'define_format': DTC error '%s' for format id %d.\n",
|
|
get_err_text (ret),
|
|
format->id);
|
|
gdb_puts (spare_buffer);
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
while ((**request == 'M') || (**request == 'X'))
|
|
{
|
|
switch (**request)
|
|
{
|
|
case 'M': /* M<regnum>,<offset>,<size> */
|
|
(*request)++;
|
|
hexToInt(request, ®num);
|
|
|
|
if (regnum == 0 || regnum == (unsigned long) -1)
|
|
m.typecode = -1;
|
|
else if ((elinum = index_to_elinum (regnum)) > 0)
|
|
m.typecode = elinum;
|
|
else
|
|
return error_ret (-1,
|
|
"Memrange register %d is not between 0 and 15\n",
|
|
regnum);
|
|
|
|
if (*(*request)++ != ',')
|
|
return error_ret (-1,"Malformed memrange (comma #%d missing)\n",1);
|
|
hexToInt(request, &m.offset);
|
|
if (*(*request)++ != ',')
|
|
return error_ret (-1,"Malformed memrange (comma #%d missing)\n",2);
|
|
hexToInt(request, &m.size);
|
|
|
|
gdb_note ("STUB: call add_format_mem_range (typecode = 0x%x, ",
|
|
m.typecode);
|
|
gdb_note ("offset = 0x%X, ", m.offset);
|
|
gdb_note ("size = %d);\n", m.size);
|
|
if ((ret = add_format_mem_ranges (format->id, &m)) !=
|
|
OK_TARGET_RESPONSE)
|
|
{
|
|
dtc_error_ret (-1, "add_format_mem_ranges", ret);
|
|
sprintp (spare_buffer,
|
|
"format id %d: memrange (0x%x, 0x%x, 0x%x).\n",
|
|
format->id, m.typecode, m.offset, m.size);
|
|
gdb_puts (spare_buffer);
|
|
return -1;
|
|
}
|
|
break;
|
|
|
|
case 'X': /* X<length>,<bytecodes> */
|
|
{
|
|
unsigned long length;
|
|
|
|
(*request)++;
|
|
hexToInt(request, &length);
|
|
|
|
if ((length <= 0) || (length > MAX_BYTE_CODES))
|
|
return error_ret (-1,
|
|
"Bytecode expression length (%d) too large\n",
|
|
length);
|
|
|
|
if (*(*request)++ != ',')
|
|
return error_ret (-1,
|
|
"Malformed bytecode expr (comma#%d missing)\n",
|
|
1);
|
|
t_expr->next = NULL;
|
|
/* subtract one to account for expr[0] in header */
|
|
t_expr->size = sizeof(struct t_expr_tag) + length - 1;
|
|
t_expr->expr_size = length;
|
|
|
|
hex2mem(*request, &t_expr->expr[0], length, 0);
|
|
*request += 2 * length;
|
|
build_and_add_expression(format->id, t_expr);
|
|
}
|
|
break;
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static char *
|
|
handle_trace_set (char *request)
|
|
{
|
|
long n_frame;
|
|
unsigned long frameno, tdp, pc, start, stop;
|
|
DTC_RESPONSE ret = -1;
|
|
static COLLECTION_FORMAT_DEF tempfmt1;
|
|
static char enable;
|
|
static char retbuf[20];
|
|
|
|
if (msgcmp (&request, "init"))
|
|
{
|
|
gdb_note ("STUB: call clear_trace_state();\n", 0);
|
|
curframe.valid = 0; /* all old frames become invalid now */
|
|
if ((ret = clear_trace_state ()) == OK_TARGET_RESPONSE)
|
|
return "OK";
|
|
else
|
|
{
|
|
sprintp (retbuf, "E2%x", ret);
|
|
return (char *) dtc_error_ret ((int) &retbuf,
|
|
"clear_trace_state",
|
|
ret);
|
|
}
|
|
}
|
|
else if (msgcmp (&request, "Start"))
|
|
{
|
|
trace_running = 1;
|
|
curframe.valid = 0; /* all old frames become invalid now */
|
|
gdb_note ("STUB: call start_trace_experiment();\n", 0);
|
|
adbg_save_trace_in_nvd ();
|
|
if ((ret = start_trace_experiment ()) == OK_TARGET_RESPONSE)
|
|
return "OK";
|
|
else
|
|
{
|
|
sprintp (retbuf, "E2%x", ret);
|
|
return (char *) dtc_error_ret ((int) &retbuf,
|
|
"start_trace_experiment",
|
|
ret);
|
|
}
|
|
}
|
|
else if (msgcmp (&request, "Stop"))
|
|
{
|
|
trace_running = 0;
|
|
if (adbg_check_if_active ())
|
|
{
|
|
gdb_note ("STUB: call end_trace_experiment();\n", 0);
|
|
if ((ret = end_trace_experiment ()) == OK_TARGET_RESPONSE)
|
|
return "OK";
|
|
else
|
|
{
|
|
sprintp (retbuf, "E2%x", ret);
|
|
return (char *) dtc_error_ret ((int) &retbuf,
|
|
"end_trace_experiment",
|
|
ret);
|
|
}
|
|
}
|
|
else return "OK";
|
|
}
|
|
/* "TDP:" (The 'T' was consumed in handle_request.) */
|
|
else if (msgcmp (&request, "DP:"))
|
|
{
|
|
/* TDP:<id>:<addr>:{D,E}:<stepcount>:<pass_limit>{R[M,X]+}<tdp-format>
|
|
{S{R[M,X]+}}<tp-format>
|
|
|
|
D -- disable tracepoint (illegal from EMC's point of view)
|
|
E -- enable tracepoint?
|
|
|
|
R -- regs format: R<regs-mask>
|
|
M -- memory format: M<regnum>,<offset>,<size>
|
|
X -- expr format: X<size>,<bytecodes>
|
|
S -- fencepost between trap formats and stepping formats.
|
|
*/
|
|
|
|
/* state variable, required for splitting TDP packets. */
|
|
static int doing_step_formats;
|
|
|
|
/*
|
|
* TDP: packets may now be split into multiple packets.
|
|
* If a TDP packet is to be continued in another packet, it
|
|
* must end in a "-" character. The subsequent continuation
|
|
* packet will then begin with a "-" character, between the
|
|
* token "TDP:" and the tdp_id field. The ID and address
|
|
* will be repeated in each sub-packet. The step_count,
|
|
* pass_count, and 'enabled' field must appear in the first
|
|
* packet. The boundary between sub-packets may not appear
|
|
* between the "S" that denotes the start of stepping "formats",
|
|
* and the regs_mask that follows it. The split may also not
|
|
* occur in the middle of either a memrange description or a
|
|
* bytecode string. -- MVS
|
|
*/
|
|
|
|
if (*request == '-') /* this is a continuation of a
|
|
trace definition in progress */
|
|
{
|
|
unsigned long temp_id, temp_addr;
|
|
|
|
request++;
|
|
if (!(hexToInt (&request, &temp_id) &&
|
|
*request++ == ':'))
|
|
return "E11"; /* badly formed packet, field 1 */
|
|
|
|
if (!(hexToInt (&request, (unsigned long *) &temp_addr) &&
|
|
*request++ == ':'))
|
|
return "E12"; /* badly formed packet, field 2 */
|
|
|
|
if (temp_id != tdp_temp.id)
|
|
return "E11"; /* something wrong: field 1 doesn't match */
|
|
if (temp_addr != (unsigned long) tdp_temp.addr)
|
|
return "E12"; /* something wrong: field 2 doesn't match */
|
|
}
|
|
else /* This is a new TDP definition */
|
|
{
|
|
memset ((char *) &tdp_temp, 0, sizeof (tdp_temp));
|
|
memset ((char *) &tempfmt1, 0, sizeof (tempfmt1));
|
|
doing_step_formats = FALSE;
|
|
|
|
if (!(hexToInt (&request, &tdp_temp.id) &&
|
|
*request++ == ':'))
|
|
return "E11"; /* badly formed packet, field 1 */
|
|
|
|
if (!(hexToInt (&request, (unsigned long *) &tdp_temp.addr) &&
|
|
*request++ == ':'))
|
|
return "E12"; /* badly formed packet, field 2 */
|
|
|
|
if (!(((enable = *request++) == 'D' || enable == 'E') &&
|
|
*request++ == ':'))
|
|
return "E13"; /* badly formed packet, field 3 */
|
|
#if 0
|
|
if (enable == 'D')
|
|
{
|
|
gdb_puts ("Disabling of tracepoints not supported by EMC target\n");
|
|
return "E20";
|
|
}
|
|
#endif
|
|
if (!(hexToInt (&request, &tdp_temp.stepcount) &&
|
|
*request++ == ':'))
|
|
return "E14"; /* badly formed packet, field 4 */
|
|
|
|
if (!hexToInt (&request, &tdp_temp.pass_limit))
|
|
return "E15"; /* badly formed packet, field 5 */
|
|
|
|
}
|
|
|
|
/* Typically, the first group of collection descriptors
|
|
refers to the trap collection. There is an "S" token
|
|
to act as a fencepost between collection descriptors for
|
|
the trap, and those for the single-stepping.
|
|
|
|
However, when the packet is split up into several packets,
|
|
this "S" token may already have been seen in a previous
|
|
sub-packet; so we have to remember it in a state variable. */
|
|
|
|
if (*request == 'R' || *request == 'M' || *request == 'X')
|
|
{
|
|
if (handle_format (&request, &tempfmt1))
|
|
return "E16";
|
|
if (doing_step_formats)
|
|
tdp_temp.tp_format_p = tempfmt1.id;
|
|
else
|
|
tdp_temp.tdp_format_p = tempfmt1.id;
|
|
}
|
|
|
|
/* When we see the "S" token, we remember it in a state variable
|
|
(in case the packet is split up and continued in another message),
|
|
and discard all current state from the collection "format". */
|
|
if (*request == 'S')
|
|
{
|
|
doing_step_formats = TRUE;
|
|
/* discard prev format and start a new one */
|
|
memset ((char *) &tempfmt1, 0, sizeof (tempfmt1));
|
|
request++;
|
|
|
|
/* Having seen the "S" fencepost, it is now possible that
|
|
we will see some more collection descriptors pertaining
|
|
to the stepping collection. */
|
|
if (*request == 'R' || *request == 'M' || *request == 'X')
|
|
{
|
|
if (handle_format (&request, &tempfmt1))
|
|
return "E17";
|
|
/* new format ID is tp_format */
|
|
tdp_temp.tp_format_p = tempfmt1.id;
|
|
}
|
|
}
|
|
|
|
if (*request == '-') /* this TDP definition will be continued. */
|
|
sprintp (retbuf, "OK");
|
|
else if (enable == 'E') /* end of TDP definition: pass to ADBG (if enabled!) */
|
|
{
|
|
gdb_note ("STUB: call define_tdp (id %d, ", tdp_temp.id);
|
|
gdb_note ("addr 0x%X, ", (int) tdp_temp.addr);
|
|
gdb_note ("passc %d, ", tdp_temp.pass_limit);
|
|
gdb_note ("stepc %d, ", tdp_temp.stepcount);
|
|
gdb_note ("TDP fmt #%d, ", tdp_temp.tdp_format_p);
|
|
gdb_note ("TP fmt #%d);\n", tdp_temp.tp_format_p);
|
|
|
|
ret = define_tdp (tdp_temp.id, &tdp_temp, 0);
|
|
|
|
if (ret == OK_TARGET_RESPONSE)
|
|
{
|
|
sprintp (retbuf, "OK");
|
|
}
|
|
else
|
|
{
|
|
sprintp (spare_buffer,
|
|
"'define_tdp' returned DTC error '%s' for tracepoint %d.\n",
|
|
get_err_text (ret),
|
|
tdp_temp.id);
|
|
gdb_puts (spare_buffer);
|
|
sprintp (retbuf, "E2%x", ret);
|
|
}
|
|
/* Redundant, but let's try to make sure this state gets discarded. */
|
|
{
|
|
memset ((char *) &tdp_temp, 0, sizeof (tdp_temp));
|
|
memset ((char *) &tempfmt1, 0, sizeof (tempfmt1));
|
|
}
|
|
}
|
|
else /* ADBG_DTC does not support disabled tracepoints -- ignore it. */
|
|
gdb_note ("STUB: ignoring disabled tracepoint %d.\n", tdp_temp.id);
|
|
|
|
return retbuf;
|
|
}
|
|
else if (msgcmp (&request, "Frame:"))
|
|
{
|
|
ret = OK_TARGET_RESPONSE;
|
|
|
|
if (msgcmp (&request, "pc:"))
|
|
{
|
|
if (!hexToInt (&request, &pc))
|
|
return "E10"; /* badly formed packet */
|
|
n_frame = curframe.valid ? curframe.frame_id + 1 : 0;
|
|
gdb_note ("STUB: call fetch_trace_frame_pc (id %d, ", n_frame);
|
|
gdb_note ("pc 0x%X);\n", pc);
|
|
ret = fetch_trace_frame_with_pc (&n_frame,
|
|
(void *) pc,
|
|
&curframe.format,
|
|
&curframe.frame_data);
|
|
}
|
|
else if (msgcmp (&request, "tdp:"))
|
|
{
|
|
if (!hexToInt (&request, &tdp))
|
|
return "E10"; /* badly formed packet */
|
|
n_frame = curframe.valid ? curframe.frame_id + 1: 0;
|
|
gdb_note ("STUB: call fetch_trace_frame_tdp (id %d, ", n_frame);
|
|
gdb_note ("tdp 0x%X);\n", tdp);
|
|
ret = fetch_trace_frame_with_tdp (&n_frame,
|
|
tdp,
|
|
&curframe.format,
|
|
&curframe.frame_data);
|
|
}
|
|
else if (msgcmp (&request, "range:"))
|
|
{
|
|
if (!(hexToInt (&request, &start) &&
|
|
*request++ == ':'))
|
|
return "E11"; /* badly formed packet, field 1 */
|
|
else if (!hexToInt (&request, &stop))
|
|
return "E12"; /* badly formed packet, field 2 */
|
|
n_frame = curframe.valid ? curframe.frame_id + 1: 0;
|
|
gdb_note ("STUB: call fetch_trace_frame_range (id %d, ", n_frame);
|
|
gdb_note ("start 0x%X, ", start);
|
|
gdb_note ("stop 0x%X);\n", stop);
|
|
ret = fetch_trace_frame_with_pc_in_range (&n_frame,
|
|
(void *) start,
|
|
(void *) stop,
|
|
&curframe.format,
|
|
&curframe.frame_data);
|
|
}
|
|
else if (msgcmp (&request, "outside:"))
|
|
{
|
|
if (!(hexToInt (&request, &start) &&
|
|
*request++ == ':'))
|
|
return "E11"; /* badly formed packet, field 1 */
|
|
else if (!hexToInt (&request, &stop))
|
|
return "E12"; /* badly formed packet, field 2 */
|
|
n_frame = curframe.valid ? curframe.frame_id + 1: 0;
|
|
gdb_note ("STUB: call fetch_trace_frame_outside (id %d, ", n_frame);
|
|
gdb_note ("start 0x%X, ", start);
|
|
gdb_note ("stop 0x%X);\n", stop);
|
|
ret = fetch_trace_frame_with_pc_outside (&n_frame,
|
|
(void *) start,
|
|
(void *) stop,
|
|
&curframe.format,
|
|
&curframe.frame_data);
|
|
}
|
|
else /* simple TFind by frame number: */
|
|
{
|
|
if (!hexToInt (&request, &frameno))
|
|
return "E10"; /* badly formed packet */
|
|
if (frameno != (unsigned long) -1)
|
|
{
|
|
gdb_note ("STUB: call fetch_trace_frame (id %d);\n", frameno);
|
|
ret = fetch_trace_frame (n_frame = frameno,
|
|
&curframe.format,
|
|
&curframe.frame_data);
|
|
#if 0
|
|
printp("STUB: fetch_trace_frame: return %d\n", ret);
|
|
#endif
|
|
}
|
|
else /* discard any trace frame, debug "the real world" */
|
|
{
|
|
if (curframe.valid)
|
|
gdb_note ("STUB: discard current trace frame #%d.\n",
|
|
curframe.frame_id);
|
|
curframe.valid = 0;
|
|
return "OK";
|
|
}
|
|
}
|
|
if (ret == OK_TARGET_RESPONSE) /* fetch_trace_frame succeeded */
|
|
{ /* setup for debugging the trace frame */
|
|
curframe.valid = 1;
|
|
curframe.frame_id = n_frame;
|
|
curframe.tdp_id = curframe.frame_data->id;
|
|
|
|
memset ((char *) &curframe.traceregs, 0,
|
|
sizeof (curframe.traceregs));
|
|
curframe.traceregs[PC] = (unsigned long)
|
|
curframe.frame_data->program_counter;
|
|
|
|
if (curframe.format)
|
|
{
|
|
unsigned long regs_mask = curframe.format->regs_mask;
|
|
unsigned long *regs, *stack, *mem;
|
|
unsigned long regno, index = 0;
|
|
CFD *dummy;
|
|
|
|
if ((ret = get_addr_to_frame_regs_stack_mem
|
|
(curframe.frame_data, &dummy, ®s, &stack, &mem))
|
|
!= OK_TARGET_RESPONSE)
|
|
{
|
|
curframe.valid = 0;
|
|
sprintp (retbuf, "E2%x", ret);
|
|
return (char *)
|
|
dtc_error_ret ((int) &retbuf,
|
|
"get_addr_to_frame_regs_stack_mem",
|
|
ret);
|
|
}
|
|
|
|
if (remote_debug > 1)
|
|
{ /* echo what we've found to gdb console */
|
|
sprintp (spare_buffer,
|
|
"STUB: Found frame %d, TDP %d, format %d (%s):\n",
|
|
curframe.frame_id,
|
|
curframe.tdp_id & 0x7fffffff,
|
|
curframe.format->id,
|
|
curframe.tdp_id & 0x80000000 ?
|
|
"trap frame" : "stepping frame");
|
|
gdb_puts (spare_buffer);
|
|
}
|
|
/* copy trace frame regs into stub's data format */
|
|
for (regno = 0, index = 0;
|
|
regno < 16;
|
|
regno++, regs_mask >>= 1)
|
|
if (regs_mask & 1) /* got a collected register */
|
|
{
|
|
curframe.traceregs[regno] = regs[index++];
|
|
if (remote_debug > 1)
|
|
{
|
|
sprintp (spare_buffer,
|
|
" Collected 0x%08x for register %d.\n",
|
|
curframe.traceregs[regno], regno);
|
|
gdb_puts (spare_buffer);
|
|
}
|
|
}
|
|
if (remote_debug > 1)
|
|
{
|
|
long midx, ridx, len;
|
|
MEMRANGE_DEF *mrange;
|
|
unsigned char *data, *base;
|
|
|
|
if (curframe.format->stack_size > 0)
|
|
{
|
|
len = curframe.format->stack_size;
|
|
sprintp (spare_buffer,
|
|
" Collected %d bytes of stack at 0x%x:\n",
|
|
len, curframe.traceregs[A7]);
|
|
gdb_puts (spare_buffer);
|
|
|
|
/* print stack data, but stay under msg len */
|
|
if (len >= (NUMREGBYTES/2 - 2))
|
|
len = (NUMREGBYTES/2 - 3);
|
|
mem2hex ((unsigned char *) stack,
|
|
spare_buffer, len, 0);
|
|
spare_buffer [len * 2] = '\n';
|
|
spare_buffer [len * 2 + 1] = '\0'; /* EOS */
|
|
gdb_puts (spare_buffer);
|
|
}
|
|
else
|
|
gdb_puts ("Stack not collected\n");
|
|
|
|
for (midx = 0;
|
|
get_addr_to_a_mem_range (curframe.frame_data,
|
|
midx,
|
|
&mrange,
|
|
(void **) &data)
|
|
== OK_TARGET_RESPONSE;
|
|
midx++)
|
|
{
|
|
if ((mrange->typecode == 0) ||
|
|
(mrange->typecode == (unsigned long) -1))
|
|
{
|
|
sprintp (spare_buffer,
|
|
" Collected %d bytes at MEM: 0x%x:\n",
|
|
mrange->size, mrange->offset);
|
|
base = (unsigned char *) mrange->offset;
|
|
}
|
|
else
|
|
{
|
|
if ((ridx = elinum_to_index (mrange->typecode)) > 0)
|
|
base = (unsigned char *) curframe.traceregs[ridx]
|
|
+ (long) mrange->offset;
|
|
else
|
|
{
|
|
sprintp (spare_buffer,
|
|
"STUB: bad typecode in memrange #%d: (0x%x,0x%x,0x%x).\n",
|
|
midx,
|
|
mrange->typecode,
|
|
mrange->offset,
|
|
mrange->size);
|
|
gdb_puts (spare_buffer);
|
|
continue;
|
|
}
|
|
sprintp (spare_buffer,
|
|
" Collected %d bytes at 0x%x (REG %X + %d):\n",
|
|
mrange->size,
|
|
base,
|
|
mrange->typecode,
|
|
mrange->offset);
|
|
}
|
|
gdb_puts (spare_buffer);
|
|
len = mrange->size;
|
|
if (len >= (NUMREGBYTES/2 - 2))
|
|
len = (NUMREGBYTES/2 - 3);
|
|
mem2hex (data, spare_buffer, len, 0);
|
|
spare_buffer [len * 2] = '\n';
|
|
spare_buffer [len * 2 + 1] = '\0'; /* EOS */
|
|
gdb_puts (spare_buffer);
|
|
}
|
|
}
|
|
}
|
|
sprintp (retbuf, "F%xT%x", n_frame, curframe.tdp_id & 0x7fffffff);
|
|
return retbuf;
|
|
}
|
|
else if (ret == NOT_FOUND_TARGET_RESPONSE)
|
|
{
|
|
/* Here's a question: if the fetch_trace_frame call failed
|
|
(which probably means a bad "TFIND" command from GDB),
|
|
should we remain focused on the previous frame (if any),
|
|
or should we revert to "no current frame"?
|
|
*/
|
|
return "F-1";
|
|
}
|
|
else
|
|
{
|
|
sprintp (retbuf, "E2%x", ret);
|
|
return (char *) dtc_error_ret ((int) &retbuf,
|
|
"fetch_trace_frame[...]",
|
|
ret);
|
|
}
|
|
}
|
|
else /* unknown trace command */
|
|
{
|
|
return "";
|
|
}
|
|
}
|
|
|
|
/* Table used by the crc32 function to calcuate the checksum. */
|
|
static unsigned long crc32_table[256];
|
|
|
|
static int crc_mem_err;
|
|
|
|
static unsigned long
|
|
crc32 (buf, len, crc)
|
|
unsigned char *buf;
|
|
int len;
|
|
unsigned long crc;
|
|
{
|
|
crc_mem_err = FALSE;
|
|
|
|
if (! crc32_table[1])
|
|
{
|
|
/* Initialize the CRC table and the decoding table. */
|
|
int i, j;
|
|
unsigned int c;
|
|
|
|
for (i = 0; i < 256; i++)
|
|
{
|
|
for (c = i << 24, j = 8; j > 0; --j)
|
|
c = c & 0x80000000 ? (c << 1) ^ 0x04c11db7 : (c << 1);
|
|
crc32_table[i] = c;
|
|
}
|
|
}
|
|
|
|
while (len--)
|
|
{
|
|
if (read_access_violation (buf))
|
|
{
|
|
crc_mem_err = TRUE;
|
|
return -1;
|
|
}
|
|
crc = (crc << 8) ^ crc32_table[((crc >> 24) ^ *buf++) & 255];
|
|
}
|
|
return crc;
|
|
}
|
|
|
|
static char *
|
|
crc_query (cmd)
|
|
char *cmd;
|
|
{
|
|
unsigned long startmem, len, crc;
|
|
static char buf[32];
|
|
|
|
if (hexToInt (&cmd, &startmem) &&
|
|
*cmd++ == ',' &&
|
|
hexToInt (&cmd, &len))
|
|
{
|
|
crc = crc32 ((unsigned char *) startmem, len, 0xffffffff);
|
|
if (!crc_mem_err)
|
|
{
|
|
sprintp (buf, "C%08x", crc);
|
|
return buf;
|
|
}
|
|
/* else error, fall thru */
|
|
}
|
|
sprintp (buf, "E01");
|
|
return buf;
|
|
}
|
|
|
|
|
|
static char *
|
|
handle_test (request)
|
|
char *request;
|
|
{
|
|
ULONG args[7];
|
|
int i;
|
|
|
|
/* Parse the arguments, a comma-separated list of hex numbers, into
|
|
ARGS. Parse at most six arguments. */
|
|
i = 1;
|
|
if (*request != '\0')
|
|
while (i < 7)
|
|
{
|
|
if (! hexToInt (&request, &args[i++]))
|
|
return "E01";
|
|
if (*request == '\0')
|
|
break;
|
|
if (*request++ != ',')
|
|
return "E01";
|
|
}
|
|
|
|
/* Fill the rest of the args array with zeros. This is what the
|
|
INLINES command processor does with omitted arguments. */
|
|
for (; i < 7; i++)
|
|
args[i] = 0;
|
|
|
|
gdb_c_test (args);
|
|
|
|
return "OK";
|
|
}
|
|
|
|
|
|
/* GDB_TRAP_1_HANDLER
|
|
|
|
By the time this is called, the registers have been saved in "registers",
|
|
and the interrupt priority has been set to permit serial UART interrupts.
|
|
|
|
However, since no gdb request has yet been received, and there is no
|
|
equivalent of getpacket for us to wait on, we can't sit here waiting
|
|
for packets and processing them.
|
|
|
|
In fact, the ONLY thing for us to do here is sit and wait.
|
|
As gdb sends packet requests, they will handle themselves at the
|
|
interrupt level. When gdb decides we can continue, it will reset
|
|
the global variable "gdb_handling_trap1", and we will return
|
|
(whereupon registers will be restored etc.) */
|
|
|
|
void gdb_trap_1_handler( void )
|
|
{
|
|
gdb_handling_trap1 = TRUE;
|
|
sss_trace_flag = '\0'; /* shut off "trace bit" (indirectly) */
|
|
gdb_signo = 5;
|
|
putpacket( "S05" );
|
|
while ( gdb_handling_trap1 )
|
|
;
|
|
return;
|
|
}
|
|
|
|
void gdb_trace_handler( void )
|
|
{
|
|
sss_trace_flag = '\0'; /* shut off "trace bit" (indirectly) */
|
|
gdb_handling_trap1 = TRUE;
|
|
gdb_handling_sstrace = TRUE;
|
|
gdb_signo = 5;
|
|
putpacket( "S05" );
|
|
while ( gdb_handling_trap1 )
|
|
;
|
|
return;
|
|
}
|