diff options
Diffstat (limited to 'gdb/rdi-share/msgbuild.c')
| -rw-r--r-- | gdb/rdi-share/msgbuild.c | 282 |
1 files changed, 282 insertions, 0 deletions
diff --git a/gdb/rdi-share/msgbuild.c b/gdb/rdi-share/msgbuild.c new file mode 100644 index 0000000..e2db2cc --- /dev/null +++ b/gdb/rdi-share/msgbuild.c @@ -0,0 +1,282 @@ +/* + * Copyright (C) 1995 Advanced RISC Machines Limited. All rights reserved. + * + * This software may be freely used, copied, modified, and distributed + * provided that the above copyright notice is preserved in all copies of the + * software. + */ + +/* -*-C-*- + * + * $Revision$ + * $Date$ + * + * + * msgbuild.c - utilities for assembling and interpreting ADP messages + * + */ + +#include <stdarg.h> /* ANSI varargs support */ + +#ifdef TARGET +# include "angel.h" +# include "devconf.h" +#else +# include "host.h" +# include "hostchan.h" +#endif + +#include "channels.h" +#include "buffers.h" +#include "endian.h" /* Endianness support macros */ +#include "msgbuild.h" /* Header file for this source code */ + +#ifndef UNUSED +# define UNUSED(x) ((x)=(x)) +#endif + +#ifndef TARGET + +extern unsigned int Armsd_BufferSize; + +#endif /* ndef TARGET */ + + +unsigned int vmsgbuild(unsigned char *buffer, const char *format, va_list args) +{ + unsigned int blen = 0; + int ch; + + /* Step through the format string */ + while ((ch = *format++) != '\0') + { + if (ch != '%') + { + if (buffer != NULL) + *buffer++ = (unsigned char)ch; + + blen++; + } + else + { + switch (ch = *format++) + { + case 'w': + case 'W': + /* 32bit pointer */ + case 'p': + case 'P': + { + /* 32bit word / 32bit pointer */ + unsigned int na = va_arg(args, unsigned int); + + if (buffer != NULL) + { + PUT32LE(buffer, na); + buffer += sizeof(unsigned int); + } + + blen += sizeof(unsigned int); + + break; + } + + case 'h': + case 'H': + { + /* 16bit value */ + unsigned int na = va_arg(args, unsigned int); + + if (buffer != NULL) + { + PUT16LE(buffer, na); + buffer += sizeof(unsigned short); + } + + blen += sizeof(unsigned short); + + break; + } + + case 'c': + case 'C': + case 'b': + case 'B': + /* 8bit character / 8bit byte */ + ch = va_arg(args, int); + + /* + * XXX + * + * fall through to the normal character processing + */ + + case '%': + default: + /* normal '%' character, or a different normal character */ + if (buffer != NULL) + *buffer++ = (unsigned char)ch; + + blen++; + break; + } + } + } + + return blen; +} + +/* + * msgbuild + * -------- + * Simple routine to aid in construction of Angel messages. See the + * "msgbuild.h" header file for a detailed description of the operation + * of this routine. + */ +unsigned int msgbuild(unsigned char *buffer, const char *format, ...) +{ + va_list args; + unsigned int blen; + + va_start(args, format); + blen = vmsgbuild(buffer, format, args); + va_end(args); + + return blen; +} + +#if !defined(JTAG_ADP_SUPPORTED) && !defined(MSG_UTILS_ONLY) +/* + * This routine allocates a buffer, puts the data supplied as + * parameters into the buffer and sends the message. It does *NOT* + * wait for a reply. + */ +extern int msgsend(ChannelID chan, const char *format,...) +{ + unsigned int length; + p_Buffer buffer; + va_list args; +# ifndef TARGET + Packet *packet; + + packet = DevSW_AllocatePacket(Armsd_BufferSize); + buffer = packet->pk_buffer; +# else + buffer = angel_ChannelAllocBuffer(Angel_ChanBuffSize); +# endif + + if (buffer != NULL) + { + va_start(args, format); + + length = vmsgbuild(BUFFERDATA(buffer), format, args); + +# ifdef TARGET + angel_ChannelSend(CH_DEFAULT_DEV, chan, buffer, length); +# else + packet->pk_length = length; + Adp_ChannelWrite(chan, packet); +# endif + + va_end(args); + return 0; + } + else + return -1; +} + +#endif /* ndef JTAG_ADP_SUPPORTED && ndef MSG_UTILS_ONLY */ + +/* + * unpack_message + * -------------- + */ +extern unsigned int unpack_message(unsigned char *buffer, const char *format, ...) +{ + va_list args; + unsigned int blen = 0; + int ch; + char *chp = NULL; + + va_start(args, format); + + /* Step through the format string. */ + while ((ch = *format++) != '\0') + { + if (ch != '%') + { + if (buffer != NULL) + ch = (unsigned char)*buffer++; + + blen++; + } + else + { + switch (ch = *format++) + { + case 'w': + case 'W': + { + /* 32bit word. */ + unsigned int *nap = va_arg(args, unsigned int*); + + if (buffer != NULL) + { + *nap = PREAD32(LE, buffer); + buffer += sizeof(unsigned int); + } + + blen += sizeof(unsigned int); + + break; + } + + case 'h': + case 'H': + { + /* 16bit value. */ + unsigned int *nap = va_arg(args, unsigned int*); + + if (buffer != NULL) + { + *nap = PREAD16(LE,buffer); + buffer += sizeof(unsigned short); + } + + blen += sizeof(unsigned short); + + break; + } + + case 'c': + case 'C': + case 'b': + case 'B': + /* 8-bit character, or 8-bit byte */ + chp = va_arg(args, char*); + + /* + * XXX + * + * fall through to the normal character processing. + */ + + case '%': + default: + /* normal '%' character, or a different normal character */ + if (buffer != NULL) + *chp = (unsigned char)*buffer++; + + blen++; + + break; + } + } + } + + va_end(args); + return(blen); +} + + +/* EOF msgbuild.c */ |