123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508 |
- /* $Id$ */
- #define DEBUGGEE
- #include "message.h"
- #define MAXBP 128
- #define MAXTRACE 16
- static int nbp; /* # of breakpoints */
- static char *bp[MAXBP];
- static int ntrace;
- static struct trace {
- char *begin_trace, *end_trace;
- } trace_buf[MAXTRACE];
- static struct message_hdr ok_message;
- #define OFF 0
- #define SS 1 /* single stepping */
- #define SSF 2 /* single stepping, counting functions
- as single statements */
- static char *
- BUFTOA(p)
- register char *p;
- {
- register long l = 0;
- register int i;
- for (i = PS; i>0; i--) {
- l = (l << 8) | (*p++ & 0377);
- }
- return (char *) l;
- }
- static long
- BUFTOL(p)
- register char *p;
- {
- register long l = 0;
- register int i;
- for (i = LS; i>0; i--) {
- l = (l << 8) | (*p++ & 0377);
- }
- return l;
- }
- static
- ATOBUF(p, cp)
- register char *p;
- char *cp;
- {
- register int i;
- register long l = (long) cp;
- p += PS;
- for (i = PS; i > 0; i--) {
- *--p = l;
- l >>= 8;
- }
- }
- static
- LTOBUF(p, l)
- register char *p;
- register long l;
- {
- register int i;
- p += LS;
- for (i = LS; i > 0; i--) {
- *--p = l;
- l >>= 8;
- }
- }
- static int single_stepping = OFF;
- static int db_ss = 0;
- static int step_count = 0;
- static char *savedlb;
- static int break_flag = 0;
- static int reading = 0;
- static char *retaddr;
- static char *LB;
- static char *currbrk;
- extern char *__Get_LB();
- extern char *__Get_Hol0();
- extern char *__Get_PC();
- extern char *__Cvt_LB_AB();
- extern char *__Get_HP();
- extern char *_sbrk();
- extern int etext;
- extern __Set_PC();
- static send_ok();
- #define check_ptr(c) (((c) >= (char *)&etext && (c) <= currbrk) || (c) >= LB)
- #define IN_FD 3
- #define OUT_FD 6
- static int
- ureceive(p, c)
- char *p;
- long c;
- {
- int i;
- int retval = 1;
- reading = 1;
- while (c >= 0x1000) {
- i = _read(IN_FD, p, 0x1000);
- if (i == 0) return 0;
- if (i < 0) {
- retval = 0;
- c -= 0x1000;
- }
- else {
- p += i;
- c -= i;
- }
- }
- while (c > 0) {
- i = _read(IN_FD, p, (int)c);
- if (i == 0) return 0;
- if (i < 0) {
- retval = 0;
- break;
- }
- else {
- p += i;
- c -= i;
- }
- }
- reading = 0;
- return retval;
- }
- static int
- usend(p, c)
- char *p;
- long c;
- {
- int i;
- while (c >= 0x1000) {
- i = _write(OUT_FD, p, 0x1000);
- if (i < 0) {
- return 0;
- }
- p += i;
- c -= i;
- }
- while (c > 0) {
- i = _write(OUT_FD, p, (int)c);
- if (i < 0) {
- return 0;
- }
- p += i;
- c -= i;
- }
- return 1;
- }
- static int
- ugetm(message)
- struct message_hdr *message;
- {
- if (! ureceive((char *) message, (long) sizeof(struct message_hdr))) {
- return 0;
- }
- return 1;
- }
- static int
- uputm(message)
- struct message_hdr *message;
- {
- if (! usend((char *) message, (long) sizeof(struct message_hdr))) {
- return 0;
- }
- return 1;
- }
- static int
- sendreply(m, p, sz)
- struct message_hdr *m;
- char *p;
- long sz;
- {
- if (! uputm(m) || ! (sz && p ? usend(p, sz) : 1)) {
- return 0;
- }
- return 1;
- }
- static int
- do_request()
- {
- /* obtain a request from the debugger and perform it */
- int fail = 0;
- register int i;
- register char *c;
- char *c1;
- long sz;
- struct message_hdr message;
- start:
- if (! ugetm(&message)) {
- /* failed to get a message. Something is wrong. Let process continue */
- return 1;
- }
- if (message.m_type & M_DB_SS) db_ss = 1;
- message.m_type &= 0177;
- switch(message.m_type) {
- case M_OK:
- /* sometimes sent to child to see if it lives */
- goto start;
- case M_SETBP:
- /* set a breakpoint */
- if (nbp == MAXBP) {
- fail = 1;
- break;
- }
- bp[nbp++] = BUFTOA(message.m_buf+1);
- break;
- case M_SETTRACE:
- if (ntrace == MAXTRACE) {
- fail = 1;
- break;
- }
- trace_buf[ntrace].begin_trace = BUFTOA(message.m_buf+1);
- trace_buf[ntrace++].end_trace = BUFTOA(message.m_buf+(PS+1));
- break;
- case M_CLRBP:
- i = 0;
- c = BUFTOA(message.m_buf+1);
- while (i < nbp && bp[i] != c) {
- i++;
- }
- if (i < nbp) {
- while (i < nbp) {
- bp[i] = bp[i+1];
- i++;
- }
- nbp--;
- }
- else {
- fail = 1;
- }
- break;
- case M_CLRTRACE:
- i = 0;
- c = BUFTOA(message.m_buf+1);
- c1 = BUFTOA(message.m_buf+(PS+1));
- while (i < ntrace &&
- trace_buf[i].begin_trace != c &&
- trace_buf[i].end_trace != c1){
- i++;
- }
- if (i < ntrace) {
- while (i < ntrace) {
- trace_buf[i] = trace_buf[i+1];
- i++;
- }
- ntrace--;
- }
- else {
- fail = 1;
- }
- break;
- case M_SETSS:
- single_stepping = SS;
- step_count = BUFTOL(message.m_buf+1);
- return 1;
- case M_CLRSS:
- single_stepping = OFF;
- break;
- case M_SETSSF:
- savedlb = __Get_LB(2);
- step_count = BUFTOL(message.m_buf+1);
- single_stepping = SSF;
- return 1;
- case M_GETBYTES:
- message.m_type = M_DATA;
- sz = BUFTOL(message.m_buf+1);
- c = BUFTOA(message.m_buf+(LS+1));
- currbrk = _sbrk(0);
- if (! check_ptr(c) || ! check_ptr(c+sz-1)) {
- fail = 1;
- break;
- }
- return sendreply(&message, c, sz)
- ? 0
- : -1;
- case M_GETSTR:
- sz = BUFTOL(message.m_buf+1);
- c1 = c = BUFTOA(message.m_buf+(LS+1));
- currbrk = _sbrk(0);
- if (check_ptr(c)) {
- while (*c) {
- if (c - c1 + 1 >= sz) break;
- c++;
- if (! check_ptr(c)) {
- fail = 1;
- break;
- }
- }
- }
- else fail = 1;
- if (fail) break;
- message.m_type = M_DATA;
- sz = c - c1 + 1;
- LTOBUF(message.m_buf+1, sz);
- return sendreply(&message, c1, sz)
- ? 0
- : -1;
- case M_SETBYTES:
- if (! ureceive(BUFTOA(message.m_buf+(LS+1)), BUFTOL(message.m_buf+1))) {
- fail = 1;
- }
- break;
- case M_GETEMREGS:
- i = BUFTOL(message.m_buf+1);
- c = __Get_LB(i+2); /* local base */
- c1 = __Get_LB(i+1); /* needed to find PC and SP */
- ATOBUF(message.m_buf+LB_OFF, c);
- ATOBUF(message.m_buf+AB_OFF, __Cvt_LB_AB(c));
- ATOBUF(message.m_buf+PC_OFF, __Get_PC(c1));
- ATOBUF(message.m_buf+HP_OFF, __Get_HP());
- ATOBUF(message.m_buf+SP_OFF, __Cvt_LB_AB(c1));
- return sendreply(&message, (char *) 0, 0L) ? 0 : -1;
- case M_SETEMREGS:
- /* actually, only the program counter is settable */
- i = BUFTOL(message.m_buf+1);
- c = __Get_LB(i+1);
- __Set_PC(c, BUFTOA(message.m_buf+PC_OFF));
- break;
- case M_CONT:
- return 1;
- case M_DUMP:
- currbrk = _sbrk(0);
- c = __Get_Hol0();
- c1 = currbrk;
- message.m_type = M_DGLOB;
- sz = c1 - c;
- LTOBUF(message.m_buf+1, sz);
- ATOBUF(message.m_buf + HP_OFF, __Get_HP());
- ATOBUF(message.m_buf + PC_OFF, __Get_PC(__Get_LB(1)));
- ATOBUF(message.m_buf + LB_OFF, c1);
- sendreply(&message, c, sz);
- if (! ___topsave()) {
- /* we get here after a ___topload() ! */
- step_count = 0;
- nbp = 0;
- single_stepping = 0;
- savedlb = 0;
- break_flag = 0;
- db_ss = 0;
- break;
- }
- return 0;
- case M_DGLOB:
- _brk(BUFTOA(message.m_buf + LB_OFF));
- __Set_HP(BUFTOA(message.m_buf+HP_OFF));
- if (! ureceive(__Get_Hol0(), BUFTOL(message.m_buf+1))) {}
- ___topload(BUFTOA(message.m_buf + SP_OFF));
- /*NOTREACHED*/
- }
- send_ok(fail ? M_FAIL : M_OK);
- return fail ? -1 : 0;
- }
- ___sendtop(addr, SP, sz)
- char *addr, *SP;
- unsigned sz;
- {
- struct message_hdr m;
- m.m_type = M_DSTACK;
- LTOBUF(m.m_buf+1, (long) sz);
- ATOBUF(m.m_buf+SP_OFF, SP);
- sendreply(&m, addr, (long)sz);
- }
- ___restoretop(SP)
- char *SP;
- {
- struct message_hdr m;
- if (! ugetm(&m)) {}
- if (! ureceive(SP, BUFTOL(m.m_buf+1))) {}
- }
- static
- sigcatch()
- {
- signal(7, sigcatch);
- if (reading) send_ok(M_INTR);
- else break_flag = 1;
- db_ss = 0;
- }
- static int
- check_bp()
- {
- register int i;
- for (i = 0; i < nbp; i++) {
- if (bp[i] == retaddr) {
- return 1;
- }
- }
- return 0;
- }
- static int
- check_trace()
- {
- register int i;
- for (i = 0; i < ntrace; i++) {
- if (trace_buf[i].begin_trace <= retaddr &&
- trace_buf[i].end_trace >= retaddr) {
- return 1;
- }
- }
- return 0;
- }
- static
- send_ok(type)
- {
- register int i;
- ok_message.m_type = type;
- LTOBUF(ok_message.m_buf+1, (long) retaddr);
- uputm(&ok_message);
- }
- void
- __uX_LiB()
- /* This function must be called after every LIN and LNI */
- {
- int status = M_CONT;
- LB = __Get_LB(0);
- if ( retaddr) {
- /* not the first time ... */
- retaddr = __Get_PC(LB);
- /* first, adjust step_count when single stepping
- */
- if (single_stepping == SS) step_count--;
- else if (single_stepping == SSF) {
- char *lb = __Get_LB(1);
- if (!((char *) &lb < lb && lb >= savedlb ||
- (char *) &lb > lb && lb <= savedlb)) {
- }
- else {
- savedlb = lb;
- step_count--;
- }
- }
- if (single_stepping != OFF && step_count <= 0) {
- status = M_END_SS;
- single_stepping = OFF;
- }
- else if (break_flag) status = M_INTR;
- }
- else {
- signal(7, sigcatch);
- retaddr = __Get_PC(LB);
- status = M_OK;
- }
- if (status == M_CONT) {
- if ((nbp != 0 && check_bp() != 0) ||
- (ntrace != 0 && check_trace() != 0)) {
- status = M_OK;
- }
- else if (break_flag) status = M_INTR;
- else {
- if (db_ss) {
- db_ss = 0;
- send_ok(M_DB_SS);
- while (do_request() <= 0) /* nothing */;
- }
- if (break_flag) status = M_INTR;
- else return;
- }
- }
- break_flag = 0;
- send_ok(status);
- db_ss = 0;
- while (do_request() <= 0) /* nothing */;
- }
|