1024 lines
26 KiB
C
1024 lines
26 KiB
C
/* i386-nlmstub.c -- NLM debugging stub for the i386.
|
|
|
|
This is originally based on an m68k software stub written by Glenn
|
|
Engel at HP, but has changed quite a bit. It was modified for the
|
|
i386 by Jim Kingdon, Cygnus Support. It was modified to run under
|
|
NetWare by Ian Lance Taylor, Cygnus Support.
|
|
|
|
This code is intended to produce an NLM (a NetWare Loadable Module)
|
|
to run under NetWare on an i386 platform. To create the NLM,
|
|
compile this code into an object file using the NLM SDK on any i386
|
|
host, and use the nlmconv program (available in the GNU binutils)
|
|
to transform the resulting object file into an NLM. */
|
|
|
|
/****************************************************************************
|
|
|
|
THIS SOFTWARE IS NOT COPYRIGHTED
|
|
|
|
HP offers the following for use in the public domain. HP makes no
|
|
warranty with regard to the software or it's performance and the
|
|
user accepts the software "AS IS" with all faults.
|
|
|
|
HP DISCLAIMS ANY WARRANTIES, EXPRESS OR IMPLIED, WITH REGARD
|
|
TO THIS SOFTWARE INCLUDING BUT NOT LIMITED TO THE WARRANTIES
|
|
OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
|
|
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
*
|
|
* The following gdb commands are supported:
|
|
*
|
|
* command function Return value
|
|
*
|
|
* g return the value of the CPU registers hex data or ENN
|
|
* G set the value of the CPU registers OK or ENN
|
|
*
|
|
* mAA..AA,LLLL Read LLLL bytes at address AA..AA hex data or ENN
|
|
* MAA..AA,LLLL: Write LLLL bytes at address AA.AA OK or ENN
|
|
*
|
|
* c Resume at current address SNN ( signal NN)
|
|
* cAA..AA Continue at address AA..AA SNN
|
|
*
|
|
* s Step one instruction SNN
|
|
* sAA..AA Step one instruction from AA..AA SNN
|
|
*
|
|
* k kill
|
|
*
|
|
* ? What was the last sigval ? SNN (signal NN)
|
|
*
|
|
* All commands and responses are sent with a packet which includes a
|
|
* checksum. A packet consists of
|
|
*
|
|
* $<packet info>#<checksum>.
|
|
*
|
|
* where
|
|
* <packet info> :: <characters representing the command or response>
|
|
* <checksum> :: < two hex digits computed as modulo 256 sum of <packetinfo>>
|
|
*
|
|
* When a packet is received, it is first acknowledged with either '+' or '-'.
|
|
* '+' indicates a successful transfer. '-' indicates a failed transfer.
|
|
*
|
|
* Example:
|
|
*
|
|
* Host: Reply:
|
|
* $m0,10#2a +$00010203040506070809101112131415#42
|
|
*
|
|
****************************************************************************/
|
|
|
|
#include <dfs.h>
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include <stdlib.h>
|
|
#include <ctype.h>
|
|
#include <time.h>
|
|
#include <aio.h>
|
|
#include <conio.h>
|
|
#include <advanced.h>
|
|
#include <debugapi.h>
|
|
#include <process.h>
|
|
#include <errno.h>
|
|
|
|
/****************************************************/
|
|
/* This information is from Novell. It is not in any of the standard
|
|
NetWare header files. */
|
|
|
|
struct DBG_LoadDefinitionStructure
|
|
{
|
|
void *reserved1[4];
|
|
LONG reserved5;
|
|
LONG LDCodeImageOffset;
|
|
LONG LDCodeImageLength;
|
|
LONG LDDataImageOffset;
|
|
LONG LDDataImageLength;
|
|
LONG LDUninitializedDataLength;
|
|
LONG LDCustomDataOffset;
|
|
LONG LDCustomDataSize;
|
|
LONG reserved6[2];
|
|
LONG (*LDInitializationProcedure)(void);
|
|
};
|
|
|
|
#define LO_NORMAL 0x0000
|
|
#define LO_STARTUP 0x0001
|
|
#define LO_PROTECT 0x0002
|
|
#define LO_DEBUG 0x0004
|
|
#define LO_AUTO_LOAD 0x0008
|
|
|
|
/* Loader returned error codes */
|
|
#define LOAD_COULD_NOT_FIND_FILE 1
|
|
#define LOAD_ERROR_READING_FILE 2
|
|
#define LOAD_NOT_NLM_FILE_FORMAT 3
|
|
#define LOAD_WRONG_NLM_FILE_VERSION 4
|
|
#define LOAD_REENTRANT_INITIALIZE_FAILURE 5
|
|
#define LOAD_CAN_NOT_LOAD_MULTIPLE_COPIES 6
|
|
#define LOAD_ALREADY_IN_PROGRESS 7
|
|
#define LOAD_NOT_ENOUGH_MEMORY 8
|
|
#define LOAD_INITIALIZE_FAILURE 9
|
|
#define LOAD_INCONSISTENT_FILE_FORMAT 10
|
|
#define LOAD_CAN_NOT_LOAD_AT_STARTUP 11
|
|
#define LOAD_AUTO_LOAD_MODULES_NOT_LOADED 12
|
|
#define LOAD_UNRESOLVED_EXTERNAL 13
|
|
#define LOAD_PUBLIC_ALREADY_DEFINED 14
|
|
/****************************************************/
|
|
|
|
/* The main thread ID. */
|
|
static int mainthread;
|
|
|
|
/* An error message for the main thread to print. */
|
|
static char *error_message;
|
|
|
|
/* The AIO port handle. */
|
|
static int AIOhandle;
|
|
|
|
/* BUFMAX defines the maximum number of characters in inbound/outbound
|
|
buffers. At least NUMREGBYTES*2 are needed for register packets */
|
|
#define BUFMAX (REGISTER_BYTES * 2 + 16)
|
|
|
|
/* remote_debug > 0 prints ill-formed commands in valid packets and
|
|
checksum errors. */
|
|
static int remote_debug = 1;
|
|
|
|
static const char hexchars[] = "0123456789abcdef";
|
|
|
|
/* Register values. All of these values *MUST* agree with tm.h */
|
|
#define SP_REGNUM 4 /* Contains address of top of stack */
|
|
#define PC_REGNUM 8 /* Contains program counter */
|
|
#define FP_REGNUM 5 /* Virtual frame pointer */
|
|
#define NUM_REGS 16 /* Number of machine registers */
|
|
#define REGISTER_BYTES (NUM_REGS * 4) /* Total size of registers array */
|
|
|
|
static void flush_i_cache() {}
|
|
|
|
static char *mem2hex (void *mem, char *buf, int count, int may_fault);
|
|
static char *hex2mem (char *buf, void *mem, int count, int may_fault);
|
|
|
|
#if 0
|
|
__main() {};
|
|
#endif
|
|
|
|
/* Read a character from the serial port. This must busy wait, but
|
|
that's OK because we will be the only thread running anyhow. */
|
|
|
|
static int
|
|
getDebugChar ()
|
|
{
|
|
int err;
|
|
LONG got;
|
|
unsigned char ret;
|
|
|
|
do
|
|
{
|
|
err = AIOReadData (AIOhandle, (char *) &ret, 1, &got);
|
|
if (err != 0)
|
|
{
|
|
error_message = "AIOReadData failed";
|
|
ResumeThread (mainthread);
|
|
return -1;
|
|
}
|
|
}
|
|
while (got == 0);
|
|
|
|
return ret;
|
|
}
|
|
|
|
/* Write a character to the serial port. Returns 0 on failure,
|
|
non-zero on success. */
|
|
|
|
static int
|
|
putDebugChar (c)
|
|
unsigned char c;
|
|
{
|
|
int err;
|
|
LONG put;
|
|
|
|
put = 0;
|
|
while (put < 1)
|
|
{
|
|
err = AIOWriteData (AIOhandle, (char *) &c, 1, &put);
|
|
if (err != 0)
|
|
ConsolePrintf ("AIOWriteData: err = %d, put = %d\r\n", err, put);
|
|
}
|
|
return 1;
|
|
}
|
|
|
|
/* Get the registers out of the frame information. */
|
|
|
|
static void
|
|
frame_to_registers (frame, regs)
|
|
T_TSS_StackFrame *frame;
|
|
char *regs;
|
|
{
|
|
/* Copy EAX -> EDI */
|
|
mem2hex (&frame->ExceptionEAX, ®s[0 * 4 * 2], 4 * 8, 0);
|
|
|
|
/* Copy EIP & PS */
|
|
mem2hex (&frame->ExceptionEIP, ®s[8 * 4 * 2], 4 * 2, 0);
|
|
|
|
/* Copy CS, SS, DS */
|
|
mem2hex (&frame->ExceptionCS, ®s[10 * 4 * 2], 4 * 3, 0);
|
|
|
|
/* Copy ES */
|
|
mem2hex (&frame->ExceptionES, ®s[13 * 4 * 2], 4 * 1, 0);
|
|
|
|
/* Copy FS & GS */
|
|
mem2hex (&frame->ExceptionFS, ®s[14 * 4 * 2], 4 * 2, 0);
|
|
}
|
|
|
|
/* Put the registers back into the frame information. */
|
|
|
|
static void
|
|
registers_to_frame (regs, frame)
|
|
char *regs;
|
|
T_TSS_StackFrame *frame;
|
|
{
|
|
/* Copy EAX -> EDI */
|
|
hex2mem (®s[0 * 4 * 2], &frame->ExceptionEAX, 4 * 8, 0);
|
|
|
|
/* Copy EIP & PS */
|
|
hex2mem (®s[8 * 4 * 2], &frame->ExceptionEIP, 4 * 2, 0);
|
|
|
|
/* Copy CS, SS, DS */
|
|
hex2mem (®s[10 * 4 * 2], &frame->ExceptionCS, 4 * 3, 0);
|
|
|
|
/* Copy ES */
|
|
hex2mem (®s[13 * 4 * 2], &frame->ExceptionES, 4 * 1, 0);
|
|
|
|
/* Copy FS & GS */
|
|
hex2mem (®s[14 * 4 * 2], &frame->ExceptionFS, 4 * 2, 0);
|
|
}
|
|
|
|
/* Turn a hex character into a number. */
|
|
|
|
static int
|
|
hex (ch)
|
|
char ch;
|
|
{
|
|
if ((ch >= 'a') && (ch <= 'f'))
|
|
return (ch-'a'+10);
|
|
if ((ch >= '0') && (ch <= '9'))
|
|
return (ch-'0');
|
|
if ((ch >= 'A') && (ch <= 'F'))
|
|
return (ch-'A'+10);
|
|
return (-1);
|
|
}
|
|
|
|
/* Scan for the sequence $<data>#<checksum>. Returns 0 on failure,
|
|
non-zero on success. */
|
|
|
|
static int
|
|
getpacket (buffer)
|
|
char * buffer;
|
|
{
|
|
unsigned char checksum;
|
|
unsigned char xmitcsum;
|
|
int i;
|
|
int count;
|
|
int ch;
|
|
|
|
do
|
|
{
|
|
/* wait around for the start character, ignore all other characters */
|
|
while ((ch = getDebugChar()) != '$')
|
|
if (ch == -1)
|
|
return 0;
|
|
checksum = 0;
|
|
xmitcsum = -1;
|
|
|
|
count = 0;
|
|
|
|
/* now, read until a # or end of buffer is found */
|
|
while (count < BUFMAX)
|
|
{
|
|
ch = getDebugChar();
|
|
if (ch == -1)
|
|
return 0;
|
|
if (ch == '#')
|
|
break;
|
|
checksum = checksum + ch;
|
|
buffer[count] = ch;
|
|
count = count + 1;
|
|
}
|
|
buffer[count] = 0;
|
|
|
|
if (ch == '#')
|
|
{
|
|
ch = getDebugChar ();
|
|
if (ch == -1)
|
|
return 0;
|
|
xmitcsum = hex(ch) << 4;
|
|
ch = getDebugChar ();
|
|
if (ch == -1)
|
|
return 0;
|
|
xmitcsum += hex(ch);
|
|
|
|
if (checksum != xmitcsum)
|
|
{
|
|
if (remote_debug)
|
|
ConsolePrintf ("bad checksum. My count = 0x%x, sent=0x%x. buf=%s\n",
|
|
checksum,xmitcsum,buffer);
|
|
/* failed checksum */
|
|
if (! putDebugChar('-'))
|
|
return 0;
|
|
return 1;
|
|
}
|
|
else
|
|
{
|
|
/* successful transfer */
|
|
if (! putDebugChar('+'))
|
|
return 0;
|
|
/* if a sequence char is present, reply the sequence ID */
|
|
if (buffer[2] == ':')
|
|
{
|
|
if (! putDebugChar (buffer[0])
|
|
|| ! putDebugChar (buffer[1]))
|
|
return 0;
|
|
/* remove sequence chars from buffer */
|
|
count = strlen(buffer);
|
|
for (i=3; i <= count; i++)
|
|
buffer[i-3] = buffer[i];
|
|
}
|
|
}
|
|
}
|
|
}
|
|
while (checksum != xmitcsum);
|
|
|
|
if (remote_debug)
|
|
ConsolePrintf ("Received packet \"%s\"\r\n", buffer);
|
|
|
|
return 1;
|
|
}
|
|
|
|
/* Send the packet in buffer. Returns 0 on failure, non-zero on
|
|
success. */
|
|
|
|
static int
|
|
putpacket (buffer)
|
|
char * buffer;
|
|
{
|
|
unsigned char checksum;
|
|
int count;
|
|
int ch;
|
|
|
|
if (remote_debug)
|
|
ConsolePrintf ("Sending packet \"%s\"\r\n", buffer);
|
|
|
|
/* $<packet info>#<checksum>. */
|
|
do
|
|
{
|
|
if (! putDebugChar('$'))
|
|
return 0;
|
|
checksum = 0;
|
|
count = 0;
|
|
|
|
while (ch=buffer[count])
|
|
{
|
|
if (! putDebugChar(ch))
|
|
return 0;
|
|
checksum += ch;
|
|
count += 1;
|
|
}
|
|
|
|
if (! putDebugChar('#')
|
|
|| ! putDebugChar(hexchars[checksum >> 4])
|
|
|| ! putDebugChar(hexchars[checksum % 16]))
|
|
return 0;
|
|
|
|
ch = getDebugChar ();
|
|
if (ch == -1)
|
|
return 0;
|
|
}
|
|
while (ch != '+');
|
|
|
|
return 1;
|
|
}
|
|
|
|
static char remcomInBuffer[BUFMAX];
|
|
static char remcomOutBuffer[BUFMAX];
|
|
static short error;
|
|
|
|
static void
|
|
debug_error (format, parm)
|
|
char *format;
|
|
char *parm;
|
|
{
|
|
if (remote_debug)
|
|
{
|
|
ConsolePrintf (format, parm);
|
|
ConsolePrintf ("\n");
|
|
}
|
|
}
|
|
|
|
/* This is set if we could get a memory access fault. */
|
|
static int mem_may_fault;
|
|
|
|
/* Indicate to caller of mem2hex or hex2mem that there has been an
|
|
error. */
|
|
static volatile int mem_err = 0;
|
|
|
|
/* These are separate functions so that they are so short and sweet
|
|
that the compiler won't save any registers (if there is a fault
|
|
to mem_fault, they won't get restored, so there better not be any
|
|
saved). */
|
|
|
|
static int
|
|
get_char (addr)
|
|
char *addr;
|
|
{
|
|
return *addr;
|
|
}
|
|
|
|
static void
|
|
set_char (addr, val)
|
|
char *addr;
|
|
int val;
|
|
{
|
|
*addr = val;
|
|
}
|
|
|
|
/* This bit of assembly language just returns from a function. If a
|
|
memory error occurs within get_char or set_char, the debugger
|
|
handler points EIP at these instructions to get out. */
|
|
|
|
extern void just_return ();
|
|
asm (".globl just_return");
|
|
asm (".globl _just_return");
|
|
asm ("just_return:");
|
|
asm ("_just_return:");
|
|
asm ("leave");
|
|
asm ("ret");
|
|
|
|
/* convert the memory pointed to by mem into hex, placing result in buf */
|
|
/* return a pointer to the last char put in buf (null) */
|
|
/* If MAY_FAULT is non-zero, then we should set mem_err in response to
|
|
a fault; if zero treat a fault like any other fault in the stub. */
|
|
|
|
static char *
|
|
mem2hex (mem, buf, count, may_fault)
|
|
void *mem;
|
|
char *buf;
|
|
int count;
|
|
int may_fault;
|
|
{
|
|
int i;
|
|
unsigned char ch;
|
|
char *ptr = mem;
|
|
|
|
mem_may_fault = may_fault;
|
|
for (i = 0; i < count; i++)
|
|
{
|
|
ch = get_char (ptr++);
|
|
if (may_fault && mem_err)
|
|
return (buf);
|
|
*buf++ = hexchars[ch >> 4];
|
|
*buf++ = hexchars[ch % 16];
|
|
}
|
|
*buf = 0;
|
|
mem_may_fault = 0;
|
|
return(buf);
|
|
}
|
|
|
|
/* convert the hex array pointed to by buf into binary to be placed in mem */
|
|
/* return a pointer to the character AFTER the last byte written */
|
|
|
|
static char *
|
|
hex2mem (buf, mem, count, may_fault)
|
|
char *buf;
|
|
void *mem;
|
|
int count;
|
|
int may_fault;
|
|
{
|
|
int i;
|
|
unsigned char ch;
|
|
char *ptr = mem;
|
|
|
|
mem_may_fault = may_fault;
|
|
for (i=0;i<count;i++)
|
|
{
|
|
ch = hex(*buf++) << 4;
|
|
ch = ch + hex(*buf++);
|
|
set_char (ptr++, ch);
|
|
if (may_fault && mem_err)
|
|
return (ptr);
|
|
}
|
|
mem_may_fault = 0;
|
|
return(mem);
|
|
}
|
|
|
|
/* This function takes the 386 exception vector and attempts to
|
|
translate this number into a unix compatible signal value. */
|
|
|
|
static int
|
|
computeSignal (exceptionVector)
|
|
int exceptionVector;
|
|
{
|
|
int sigval;
|
|
switch (exceptionVector)
|
|
{
|
|
case 0 : sigval = 8; break; /* divide by zero */
|
|
case 1 : sigval = 5; break; /* debug exception */
|
|
case 3 : sigval = 5; break; /* breakpoint */
|
|
case 4 : sigval = 16; break; /* into instruction (overflow) */
|
|
case 5 : sigval = 16; break; /* bound instruction */
|
|
case 6 : sigval = 4; break; /* Invalid opcode */
|
|
case 7 : sigval = 8; break; /* coprocessor not available */
|
|
case 8 : sigval = 7; break; /* double fault */
|
|
case 9 : sigval = 11; break; /* coprocessor segment overrun */
|
|
case 10 : sigval = 11; break; /* Invalid TSS */
|
|
case 11 : sigval = 11; break; /* Segment not present */
|
|
case 12 : sigval = 11; break; /* stack exception */
|
|
case 13 : sigval = 11; break; /* general protection */
|
|
case 14 : sigval = 11; break; /* page fault */
|
|
case 16 : sigval = 7; break; /* coprocessor error */
|
|
default:
|
|
sigval = 7; /* "software generated"*/
|
|
}
|
|
return (sigval);
|
|
}
|
|
|
|
/**********************************************/
|
|
/* WHILE WE FIND NICE HEX CHARS, BUILD AN INT */
|
|
/* RETURN NUMBER OF CHARS PROCESSED */
|
|
/**********************************************/
|
|
static int
|
|
hexToInt(ptr, intValue)
|
|
char **ptr;
|
|
int *intValue;
|
|
{
|
|
int numChars = 0;
|
|
int hexValue;
|
|
|
|
*intValue = 0;
|
|
|
|
while (**ptr)
|
|
{
|
|
hexValue = hex(**ptr);
|
|
if (hexValue >=0)
|
|
{
|
|
*intValue = (*intValue <<4) | hexValue;
|
|
numChars ++;
|
|
}
|
|
else
|
|
break;
|
|
|
|
(*ptr)++;
|
|
}
|
|
|
|
return (numChars);
|
|
}
|
|
|
|
static void
|
|
do_status (ptr, frame)
|
|
char *ptr;
|
|
struct T_TSS_StackFrame *frame;
|
|
{
|
|
int sigval;
|
|
|
|
sigval = computeSignal (frame->ExceptionNumber);
|
|
|
|
sprintf (ptr, "T%02x", sigval);
|
|
ptr += 3;
|
|
|
|
sprintf (ptr, "%02x:", PC_REGNUM);
|
|
ptr = mem2hex (&frame->ExceptionEIP, ptr + 3, 4, 0);
|
|
*ptr++ = ';';
|
|
|
|
sprintf (ptr, "%02x:", SP_REGNUM);
|
|
ptr = mem2hex (&frame->ExceptionESP, ptr + 3, 4, 0);
|
|
*ptr++ = ';';
|
|
|
|
sprintf (ptr, "%02x:", FP_REGNUM);
|
|
ptr = mem2hex (&frame->ExceptionEBP, ptr + 3, 4, 0);
|
|
*ptr++ = ';';
|
|
|
|
*ptr = '\000';
|
|
}
|
|
|
|
/* This function does all command processing for interfacing to gdb.
|
|
It is called whenever an exception occurs in the module being
|
|
debugged. */
|
|
|
|
static LONG
|
|
handle_exception (frame)
|
|
T_TSS_StackFrame *frame;
|
|
{
|
|
int addr, length;
|
|
char *ptr;
|
|
static struct DBG_LoadDefinitionStructure *ldinfo = 0;
|
|
static LONG first_insn; /* The first instruction in the program. */
|
|
|
|
/* Apparently the bell can sometimes be ringing at this point, and
|
|
should be stopped. */
|
|
StopBell ();
|
|
|
|
if (remote_debug)
|
|
{
|
|
ConsolePrintf ("vector=%d: %s, sr=%08x, pc=%08x, thread=%08x\r\n",
|
|
frame->ExceptionNumber,
|
|
frame->ExceptionDescription,
|
|
frame->ExceptionSystemFlags,
|
|
frame->ExceptionEIP,
|
|
GetThreadID ());
|
|
}
|
|
|
|
switch (frame->ExceptionNumber)
|
|
{
|
|
case START_NLM_EVENT:
|
|
/* If the NLM just started, we record the module load information
|
|
and the thread ID, and set a breakpoint at the first instruction
|
|
in the program. */
|
|
|
|
ldinfo = ((struct DBG_LoadDefinitionStructure *)
|
|
frame->ExceptionErrorCode);
|
|
first_insn = *(unsigned char *)ldinfo->LDInitializationProcedure;
|
|
*(unsigned char *)ldinfo->LDInitializationProcedure = 0xcc;
|
|
flush_i_cache ();
|
|
return RETURN_TO_PROGRAM;
|
|
|
|
case ENTER_DEBUGGER_EVENT:
|
|
case KEYBOARD_BREAK_EVENT:
|
|
/* Pass some events on to the next debugger, in case it will handle
|
|
them. */
|
|
return RETURN_TO_NEXT_DEBUGGER;
|
|
|
|
case 3: /* Breakpoint */
|
|
/* After we've reached the initial breakpoint, reset it. */
|
|
if (frame->ExceptionEIP - 1 == (long) ldinfo->LDInitializationProcedure
|
|
&& *(unsigned char *) ldinfo->LDInitializationProcedure == 0xcc)
|
|
{
|
|
*(unsigned char *) ldinfo->LDInitializationProcedure = first_insn;
|
|
frame->ExceptionEIP -= 1;
|
|
flush_i_cache ();
|
|
}
|
|
/* Normal breakpoints end up here */
|
|
do_status (remcomOutBuffer, frame);
|
|
break;
|
|
|
|
default:
|
|
/* At the moment, we don't care about most of the unusual NetWare
|
|
exceptions. */
|
|
if (frame->ExceptionNumber > 31)
|
|
return RETURN_TO_PROGRAM;
|
|
|
|
/* Most machine level exceptions end up here */
|
|
do_status (remcomOutBuffer, frame);
|
|
break;
|
|
|
|
case 11: /* Segment not present */
|
|
case 13: /* General protection */
|
|
case 14: /* Page fault */
|
|
/* If we get a GP fault, and mem_may_fault is set, and the
|
|
instruction pointer is near set_char or get_char, then we caused
|
|
the fault ourselves accessing an illegal memory location. */
|
|
if (mem_may_fault
|
|
&& ((frame->ExceptionEIP >= (long) &set_char
|
|
&& frame->ExceptionEIP < (long) &set_char + 50)
|
|
|| (frame->ExceptionEIP >= (long) &get_char
|
|
&& frame->ExceptionEIP < (long) &get_char + 50)))
|
|
{
|
|
mem_err = 1;
|
|
/* Point the instruction pointer at an assembly language stub
|
|
which just returns from the function. */
|
|
|
|
frame->ExceptionEIP = (long) &just_return;
|
|
|
|
/* Keep going. This will act as though it returned from
|
|
set_char or get_char. The calling routine will check
|
|
mem_err, and do the right thing. */
|
|
return RETURN_TO_PROGRAM;
|
|
}
|
|
/* Random mem fault, report it */
|
|
do_status (remcomOutBuffer, frame);
|
|
break;
|
|
|
|
case TERMINATE_NLM_EVENT:
|
|
/* There is no way to get the exit status. */
|
|
sprintf (remcomOutBuffer, "W%02x", 0);
|
|
break; /* We generate our own status */
|
|
}
|
|
|
|
/* FIXME: How do we know that this exception has anything to do with
|
|
the program we are debugging? We can check whether the PC is in
|
|
the range of the module we are debugging, but that doesn't help
|
|
much since an error could occur in a library routine. */
|
|
|
|
if (! putpacket(remcomOutBuffer))
|
|
return RETURN_TO_NEXT_DEBUGGER;
|
|
|
|
if (frame->ExceptionNumber == TERMINATE_NLM_EVENT)
|
|
{
|
|
ResumeThread (mainthread);
|
|
return RETURN_TO_PROGRAM;
|
|
}
|
|
|
|
while (1)
|
|
{
|
|
error = 0;
|
|
remcomOutBuffer[0] = 0;
|
|
if (! getpacket (remcomInBuffer))
|
|
return RETURN_TO_NEXT_DEBUGGER;
|
|
switch (remcomInBuffer[0])
|
|
{
|
|
case '?':
|
|
do_status (remcomOutBuffer, frame);
|
|
break;
|
|
case 'd':
|
|
remote_debug = !(remote_debug); /* toggle debug flag */
|
|
break;
|
|
case 'g':
|
|
/* return the value of the CPU registers */
|
|
frame_to_registers (frame, remcomOutBuffer);
|
|
break;
|
|
case 'G':
|
|
/* set the value of the CPU registers - return OK */
|
|
registers_to_frame (&remcomInBuffer[1], frame);
|
|
strcpy(remcomOutBuffer,"OK");
|
|
break;
|
|
|
|
case 'm':
|
|
/* mAA..AA,LLLL Read LLLL bytes at address AA..AA */
|
|
/* TRY TO READ %x,%x. IF SUCCEED, SET PTR = 0 */
|
|
ptr = &remcomInBuffer[1];
|
|
if (hexToInt(&ptr,&addr))
|
|
if (*(ptr++) == ',')
|
|
if (hexToInt(&ptr,&length))
|
|
{
|
|
ptr = 0;
|
|
mem_err = 0;
|
|
mem2hex((char*) addr, remcomOutBuffer, length, 1);
|
|
if (mem_err)
|
|
{
|
|
strcpy (remcomOutBuffer, "E03");
|
|
debug_error ("memory fault");
|
|
}
|
|
}
|
|
|
|
if (ptr)
|
|
{
|
|
strcpy(remcomOutBuffer,"E01");
|
|
debug_error("malformed read memory command: %s",remcomInBuffer);
|
|
}
|
|
break;
|
|
|
|
case 'M':
|
|
/* MAA..AA,LLLL: Write LLLL bytes at address AA.AA return OK */
|
|
/* TRY TO READ '%x,%x:'. IF SUCCEED, SET PTR = 0 */
|
|
ptr = &remcomInBuffer[1];
|
|
if (hexToInt(&ptr,&addr))
|
|
if (*(ptr++) == ',')
|
|
if (hexToInt(&ptr,&length))
|
|
if (*(ptr++) == ':')
|
|
{
|
|
mem_err = 0;
|
|
hex2mem(ptr, (char*) addr, length, 1);
|
|
|
|
if (mem_err)
|
|
{
|
|
strcpy (remcomOutBuffer, "E03");
|
|
debug_error ("memory fault");
|
|
}
|
|
else
|
|
{
|
|
strcpy(remcomOutBuffer,"OK");
|
|
}
|
|
|
|
ptr = 0;
|
|
}
|
|
if (ptr)
|
|
{
|
|
strcpy(remcomOutBuffer,"E02");
|
|
debug_error("malformed write memory command: %s",remcomInBuffer);
|
|
}
|
|
break;
|
|
|
|
case 'c':
|
|
case 's':
|
|
/* cAA..AA Continue at address AA..AA(optional) */
|
|
/* sAA..AA Step one instruction from AA..AA(optional) */
|
|
/* try to read optional parameter, pc unchanged if no parm */
|
|
ptr = &remcomInBuffer[1];
|
|
if (hexToInt(&ptr,&addr))
|
|
{
|
|
/* registers[PC_REGNUM].lo = addr;*/
|
|
fprintf (stderr, "Setting PC to 0x%x\n", addr);
|
|
while (1);
|
|
}
|
|
|
|
/* clear the trace bit */
|
|
frame->ExceptionSystemFlags &= ~0x100;
|
|
|
|
/* set the trace bit if we're stepping */
|
|
if (remcomInBuffer[0] == 's')
|
|
frame->ExceptionSystemFlags |= 0x100;
|
|
|
|
flush_i_cache ();
|
|
return RETURN_TO_PROGRAM;
|
|
|
|
case 'k':
|
|
/* kill the program */
|
|
KillMe (ldinfo);
|
|
ResumeThread (mainthread);
|
|
return RETURN_TO_PROGRAM;
|
|
|
|
case 'q': /* Query message */
|
|
if (strcmp (&remcomInBuffer[1], "Offsets") == 0)
|
|
{
|
|
sprintf (remcomOutBuffer, "Text=%x;Data=%x;Bss=%x",
|
|
ldinfo->LDCodeImageOffset,
|
|
ldinfo->LDDataImageOffset,
|
|
ldinfo->LDDataImageOffset + ldinfo->LDDataImageLength);
|
|
}
|
|
else
|
|
sprintf (remcomOutBuffer, "E04, Unknown query %s", &remcomInBuffer[1]);
|
|
break;
|
|
}
|
|
|
|
/* reply to the request */
|
|
if (! putpacket(remcomOutBuffer))
|
|
return RETURN_TO_NEXT_DEBUGGER;
|
|
}
|
|
}
|
|
|
|
char *baudRates[] = { "50", "75", "110", "134.5", "150", "300", "600", "1200",
|
|
"1800", "2000", "2400", "3600", "4800", "7200", "9600",
|
|
"19200", "38400", "57600", "115200" };
|
|
|
|
char dataBits[] = "5678";
|
|
|
|
char *stopBits[] = { "1", "1.5", "2" };
|
|
|
|
char parity[] = "NOEMS";
|
|
|
|
/* Start up. The main thread opens the named serial I/O port, loads
|
|
the named NLM module and then goes to sleep. The serial I/O port
|
|
is named as a board number and a port number. It would be more DOS
|
|
like to provide a menu of available serial ports, but I don't want
|
|
to have to figure out how to do that. */
|
|
|
|
int
|
|
main (argc, argv)
|
|
int argc;
|
|
char **argv;
|
|
{
|
|
int hardware, board, port;
|
|
LONG err;
|
|
struct debuggerStructure s;
|
|
char *cmdlin;
|
|
int i;
|
|
|
|
/* Use the -B option to invoke the NID if you want to debug the stub. */
|
|
|
|
if (argc > 1 && strcmp(argv[1], "-B") == 0)
|
|
{
|
|
Breakpoint(argc);
|
|
++argv, --argc;
|
|
}
|
|
|
|
if (argc < 4)
|
|
{
|
|
fprintf (stderr,
|
|
"Usage: load gdbserve board port program [arguments]\n");
|
|
exit (1);
|
|
}
|
|
|
|
hardware = -1;
|
|
board = strtol (argv[1], (char **) NULL, 0);
|
|
port = strtol (argv[2], (char **) NULL, 0);
|
|
|
|
err = AIOAcquirePort (&hardware, &board, &port, &AIOhandle);
|
|
if (err != AIO_SUCCESS)
|
|
{
|
|
switch (err)
|
|
{
|
|
case AIO_PORT_NOT_AVAILABLE:
|
|
fprintf (stderr, "Port not available\n");
|
|
break;
|
|
|
|
case AIO_BOARD_NUMBER_INVALID:
|
|
case AIO_PORT_NUMBER_INVALID:
|
|
fprintf (stderr, "No such port\n");
|
|
break;
|
|
|
|
default:
|
|
fprintf (stderr, "Could not open port: %d\n", err);
|
|
break;
|
|
}
|
|
|
|
exit (1);
|
|
}
|
|
|
|
err = AIOConfigurePort (AIOhandle, AIO_BAUD_9600, AIO_DATA_BITS_8,
|
|
AIO_STOP_BITS_1, AIO_PARITY_NONE,
|
|
AIO_HARDWARE_FLOW_CONTROL_OFF);
|
|
|
|
if (err == AIO_QUALIFIED_SUCCESS)
|
|
{
|
|
AIOPORTCONFIG portConfig;
|
|
AIODVRCONFIG dvrConfig;
|
|
|
|
fprintf (stderr, "Port configuration changed!\n");
|
|
AIOGetPortConfiguration (AIOhandle, &portConfig, &dvrConfig);
|
|
fprintf (stderr,
|
|
" Bit Rate: %s, Data Bits: %c, Stop Bits: %s, Parity: %c,\
|
|
Flow:%s\n",
|
|
baudRates[portConfig.bitRate],
|
|
dataBits[portConfig.dataBits],
|
|
stopBits[portConfig.stopBits],
|
|
parity[portConfig.parityMode],
|
|
portConfig.flowCtrlMode ? "ON" : "OFF");
|
|
}
|
|
else if (err != AIO_SUCCESS)
|
|
{
|
|
fprintf (stderr, "Could not configure port: %d\n", err);
|
|
AIOReleasePort (AIOhandle);
|
|
exit (1);
|
|
}
|
|
|
|
if (AIOSetExternalControl(AIOhandle, AIO_EXTERNAL_CONTROL,
|
|
(AIO_EXTCTRL_DTR | AIO_EXTCTRL_RTS))
|
|
!= AIO_SUCCESS)
|
|
{
|
|
LONG extStatus, chgdExtStatus;
|
|
|
|
fprintf (stderr, "Could not set desired port controls!\n");
|
|
AIOGetExternalStatus (AIOhandle, &extStatus, &chgdExtStatus);
|
|
fprintf (stderr, "Port controls now: %d, %d\n", extStatus,
|
|
chgdExtStatus);
|
|
}
|
|
|
|
/* Register ourselves as an alternate debugger. */
|
|
memset (&s, 0, sizeof s);
|
|
s.DDSResourceTag = ((struct ResourceTagStructure *)
|
|
AllocateResourceTag (GetNLMHandle (),
|
|
(BYTE *)"gdbserver",
|
|
DebuggerSignature));
|
|
if (s.DDSResourceTag == 0)
|
|
{
|
|
fprintf (stderr, "AllocateResourceTag failed\n");
|
|
AIOReleasePort (AIOhandle);
|
|
exit (1);
|
|
}
|
|
s.DDSdebuggerEntry = handle_exception;
|
|
s.DDSFlags = TSS_FRAME_BIT;
|
|
|
|
err = RegisterDebuggerRTag (&s, AT_FIRST);
|
|
if (err != 0)
|
|
{
|
|
fprintf (stderr, "RegisterDebuggerRTag failed\n");
|
|
AIOReleasePort (AIOhandle);
|
|
exit (1);
|
|
}
|
|
|
|
/* Get the command line we were invoked with, and advance it past
|
|
our name and the board and port arguments. */
|
|
cmdlin = getcmd ((char *) NULL);
|
|
for (i = 0; i < 2; i++)
|
|
{
|
|
while (! isspace (*cmdlin))
|
|
++cmdlin;
|
|
while (isspace (*cmdlin))
|
|
++cmdlin;
|
|
}
|
|
|
|
/* In case GDB is started before us, ack any packets (presumably
|
|
"$?#xx") sitting there. */
|
|
if (! putDebugChar ('+'))
|
|
{
|
|
fprintf (stderr, "putDebugChar failed\n");
|
|
UnRegisterDebugger (&s);
|
|
AIOReleasePort (AIOhandle);
|
|
exit (1);
|
|
}
|
|
|
|
mainthread = GetThreadID ();
|
|
|
|
if (remote_debug > 0)
|
|
ConsolePrintf ("About to call LoadModule with \"%s\" %08x\r\n",
|
|
cmdlin, __GetScreenID (GetCurrentScreen()));
|
|
|
|
/* Start up the module to be debugged. */
|
|
err = LoadModule ((struct ScreenStruct *) __GetScreenID (GetCurrentScreen()),
|
|
(BYTE *)cmdlin, LO_DEBUG);
|
|
if (err != 0)
|
|
{
|
|
fprintf (stderr, "LoadModule failed: %d\n", err);
|
|
UnRegisterDebugger (&s);
|
|
AIOReleasePort (AIOhandle);
|
|
exit (1);
|
|
}
|
|
|
|
/* Wait for the debugger to wake us up. */
|
|
if (remote_debug > 0)
|
|
ConsolePrintf ("Suspending main thread (%08x)\r\n", mainthread);
|
|
SuspendThread (mainthread);
|
|
if (remote_debug > 0)
|
|
ConsolePrintf ("Resuming main thread (%08x)\r\n", mainthread);
|
|
|
|
/* If we are woken up, print an optional error message, deregister
|
|
ourselves and exit. */
|
|
if (error_message != NULL)
|
|
fprintf (stderr, "%s\n", error_message);
|
|
UnRegisterDebugger (&s);
|
|
AIOReleasePort (AIOhandle);
|
|
exit (0);
|
|
}
|