Subversion Repositories or1k

/******************************************************************************
* Copyright 1991 Advanced Micro Devices, Inc.
*
* This software is the property of Advanced Micro Devices, Inc  (AMD)  which
* specifically  grants the user the right to modify, use and distribute this
* software provided this notice is not removed or altered.  All other rights
* are reserved by AMD.
*
* AMD MAKES NO WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, WITH REGARD TO THIS
* SOFTWARE.  IN NO EVENT SHALL AMD BE LIABLE FOR INCIDENTAL OR CONSEQUENTIAL
* DAMAGES IN CONNECTION WITH OR ARISING FROM THE FURNISHING, PERFORMANCE, OR
* USE OF THIS SOFTWARE.
*
* So that all may benefit from your experience, please report  any  problems
* or  suggestions about this software to the 29K Technical Support Center at
* 800-29-29-AMD (800-292-9263) in the USA, or 0800-89-1131  in  the  UK,  or
* 0031-11-1129 in Japan, toll free.  The direct dial number is 512-462-4118.
*
* Advanced Micro Devices, Inc.
* 29K Support Products
* Mail Stop 573
* 5900 E. Ben White Blvd.
* Austin, TX 78741
* 800-292-9263
*****************************************************************************
*/
static char udr_c[] = "@(#)udr.c	2.8  Daniel Mann";
static char udr_c_AMD[] = "@(#)udr.c	2.3, AMD";
/*
*	This module supports sending and receiving
*	data objects over a socket conection.
*	All data is serialised into a character stream,
*	and de-serialised back into the approproiate objects.
********************************************************************** HISTORY
*/
#include <stdio.h>
#include <sys/fcntl.h>
#include <sys/types.h>
#include <sys/socket.h>
#include "udiproc.h"
#include "udisoc.h"
 
extern int errno;
extern char *malloc ();
 
/* local type decs. and macro defs. not in a .h  file ************* MACRO/TYPE
*/
 
/* global dec/defs. which are not in a .h   file ************* EXPORT DEC/DEFS
*/
int udr_errno;			/* error occurs during UDR service */
 
/* local dec/defs. which are not in a .h   file *************** LOCAL DEC/DEFS
*/
 
/****************************************************************** UDR_CREATE
* Build UDR structure for character stream processing.
*/
int 
udr_create (udrs, sd, size)
     UDR *udrs;
     int sd;
     int size;
{
  udrs->sd = sd;
  if (!udrs->buff)
    udrs->buff = malloc (size);
  udrs->getbytes = udrs->buff;	/* set the buffer to the start */
  udrs->putbytes = udrs->buff;
  udrs->putend = udrs->buff;
  udrs->udr_op = -1;		/* don't know the direction */
  udrs->previous_op = -1;	/* don't know the direction */
  udrs->bufsize = size;
  return 0;
}
 
/******************************************************************** UDR_FREE
* Free USR structure and close socket.
*/
int 
udr_free (udrs)
     UDR *udrs;
{
  close (udrs->sd);
  free (udrs->buff);
  return 0;
}
 
/****************************************************************** UDR_SIGNAL
* Send a signal to the process at the other end of the socket,
* indicating that it should expect to recieve a new message shortly.
*/
int 
udr_signal (udrs)
     UDR *udrs;
{
  if (send (udrs->sd, "I", 1, MSG_OOB) == -1)
    {
      perror ("ERROR, udr_signal(), send(...MSG_OOB)");
      udr_errno = UDIErrorIPCInternal;
      return -1;		/* return error code */
    }
  return 0;
}
 
/***************************************************************** UDR_SENDNOW
* used to flush the current character stream buffer to
* the associated socket.  */
int 
udr_sendnow (udrs)
     UDR *udrs;
{
  int size = (UDIUInt32) (udrs->putend) - (UDIUInt32) (udrs->buff);
  if (udrs->previous_op == 0)
    {
      udr_errno = UDIErrorIPCInternal;
      return -1;
    }
  udrs->putbytes = udrs->buff;
  udrs->putend = udrs->buff;
  if (write (udrs->sd, udrs->buff, size) == -1)
    {
      perror ("ERROR, udr_sendnow(), write() call: ");
      udr_errno = UDIErrorIPCInternal;
      return -1;		/* return error code */
    }
  return 0;
}
 
/******************************************************************** UDR_WORK
* Function to send or recieve data from the buffers supporting
* socket communication. The buffer contains serialised objects
* sent/recieved over a socket connection.
*/
int 
udr_work (udrs, object_p, size)
     UDR *udrs;
     void *object_p;
     int size;
{
  int cnt, remain;
 
  if (udrs->udr_op != udrs->previous_op)
    {
      if (udrs->previous_op == 0)
	{
	  udr_errno = UDIErrorIPCInternal;
	  return -1;
	}
      udrs->previous_op = udrs->udr_op;
      udrs->putbytes = udrs->buff;
      udrs->getbytes = udrs->buff;
    }
 
  if (udrs->udr_op == UDR_ENCODE)
    {				/* write data into character stream buffer */
      if ((UDIUInt32) (udrs->putbytes) + size >
	  (UDIUInt32) (udrs->buff) + (UDIUInt32) (udrs->bufsize))
	{
	  udr_errno = UDIErrorIPCInternal;
	  return -1;
	}
      bcopy ((char *) object_p, udrs->putbytes, size);
      udrs->putbytes += size;
      if (udrs->putbytes > udrs->putend)
	udrs->putend = udrs->putbytes;
    }
  else if (udrs->udr_op == UDR_DECODE)
    {
      if ((UDIUInt32) (udrs->putbytes) - (UDIUInt32) (udrs->getbytes) < size)
	{			/* need more data in character stream buffer */
	  remain = (UDIUInt32) (udrs->bufsize) -
	    ((UDIUInt32) (udrs->putbytes) - (UDIUInt32) (udrs->buff));
	  if (((UDIUInt32) (udrs->bufsize) + (UDIUInt32) (udrs->buff)
	       - (UDIUInt32) (udrs->getbytes)) < size)
	    {
	      udr_errno = UDIErrorIPCInternal;
	      return -1;
	    }
	  cnt = read (udrs->sd, (char *) udrs->putbytes, remain);
	  if (cnt == -1)
	    perror ("ERROR udr_work(),  read() failure: ");
	  udrs->putbytes += cnt;
	  if ((UDIUInt32) (udrs->putbytes) - (UDIUInt32) (udrs->getbytes) < size)
	    {
	      udr_errno = UDIErrorIPCInternal;
	      return -1;	/* return error code */
	    }
	}			/* read data from character stream buffer */
      bcopy (udrs->getbytes, (char *) object_p, size);
      udrs->getbytes += size;
    }
  else
    {
      udr_errno = UDIErrorIPCInternal;
      return -1;
    }
  return 0;
}
 
/************************************************************* UDR_UDIResource
*/
int 
udr_UDIResource (udrs, object_p)
     UDR *udrs;
     UDIResource *object_p;
{
  int retval;
 
  retval = udr_CPUSpace (udrs, &object_p->Space);
  retval = retval | udr_CPUOffset (udrs, &object_p->Offset);
  return retval;
}
 
/**************************************************************** UDR_UDIRange
*/
int 
udr_UDIRange (udrs, object_p)
     UDR *udrs;
     UDIRange *object_p;
{
  int retval;
 
  retval = udr_CPUOffset (udrs, &object_p->Low);
  retval = retval | udr_CPUOffset (udrs, &object_p->High);
  return retval;
}
 
/********************************************************** UDR_UDIMemoryRange
*/
int 
udr_UDIMemoryRange (udrs, object_p)
     UDR *udrs;
     UDIMemoryRange *object_p;
{
  int retval;
 
  retval = udr_CPUSpace (udrs, &object_p->Space);
  retval = retval | udr_CPUOffset (udrs, &object_p->Offset);
  retval = retval | udr_CPUSizeT (udrs, &object_p->Size);
  return retval;
}
 
/****************************************************************** UDR_string
*/
int 
udr_string (udrs, sp)
     UDR *udrs;
     char *sp;
{
  int len, retval;
 
  if (udrs->udr_op == UDR_ENCODE)
    {
      if (sp)
	{
	  len = strlen (sp) + 1;
	  retval = udr_UDIInt32 (udrs, &len);
	  retval = retval | udr_work (udrs, sp, len);
	}
      else
	/* deal with NULL pointer */
	{
	  len = 0;
	  retval = udr_UDIInt32 (udrs, &len);
	}
    }
  else if (udrs->udr_op == UDR_DECODE)
    {
      retval = udr_UDIInt32 (udrs, &len);
      if (len)
	retval = retval | udr_work (udrs, sp, len);
      else
	*sp = '\0';		/* terminate string */
    }
  else
    {
      udr_errno = UDIErrorIPCInternal;
      return -1;
    }
  return retval;
}
 
/******************************************************************* UDR_BYTES
*/
int 
udr_bytes (udrs, ptr, len)
     UDR *udrs;
     char *ptr;
     int len;
{
  return udr_work (udrs, ptr, len);
}
 
/********************************************************************* UDR_INT
*/
int 
udr_int (udrs, int_p)
     UDR *udrs;
     int *int_p;
{
  int ret_val;
  UDIInt32 udr_obj;		/* object of know size */
 
  if (udrs->udr_op == UDR_ENCODE)
    {
      udr_obj = *int_p;		/* copy into know object size */
      return udr_UDIInt32 (udrs, &udr_obj);
    }
  else if (udrs->udr_op == UDR_DECODE)
    {
      ret_val = udr_UDIInt32 (udrs, &udr_obj);	/* get object of known size */
      *int_p = udr_obj;
      return ret_val;
    }
  else
    {
      udr_errno = UDIErrorIPCInternal;
      return -1;
    }
}
 
/****************************************************************** UDR_INLINE
*/
char *
udr_inline (udrs, size)
     UDR *udrs;
     int size;
{
  if (udrs->udr_op != udrs->previous_op)
    {
      if (udrs->previous_op == 0)
	{
	  udr_errno = UDIErrorIPCInternal;
	  return 0;
	}
      udrs->previous_op = udrs->udr_op;
      udrs->putbytes = udrs->buff;
      udrs->getbytes = udrs->buff;
    }
  if (udrs->udr_op == UDR_ENCODE)
    {
      if (udrs->putbytes + size > udrs->bufsize + udrs->buff)
	return 0;
      udrs->putbytes += size;
      return udrs->putbytes - size;
    }
  else if (udrs->udr_op == UDR_DECODE)
    {
      if (udrs->getbytes + size > udrs->bufsize + udrs->buff)
	return 0;
      udrs->getbytes += size;
      return udrs->getbytes - size;
    }
  else
    {
      udr_errno = UDIErrorIPCInternal;
      return 0;
    }
}
 
/****************************************************************** UDR_GETPOS
*/
char *
udr_getpos (udrs)
     UDR *udrs;
{
  if (udrs->udr_op == UDR_ENCODE)
    {
      return udrs->putbytes;
    }
  else if (udrs->udr_op == UDR_DECODE)
    {
      return udrs->getbytes;
    }
  else
    {
      udr_errno = UDIErrorIPCInternal;
      return 0;
    }
}
 
/****************************************************************** UDR_SETPOS
*/
int 
udr_setpos (udrs, pos)
     UDR *udrs;
     char *pos;
{
  if (((UDIUInt32) pos > (UDIUInt32) (udrs->buff) + (UDIUInt32) (udrs->bufsize))
      || ((UDIUInt32) pos < (UDIUInt32) (udrs->buff)))
    {
      udr_errno = UDIErrorIPCInternal;
      return 0;
    }
  if (udrs->udr_op == UDR_ENCODE)
    {
      udrs->putbytes = pos;
      return 1;
    }
  else if (udrs->udr_op == UDR_DECODE)
    {
      udrs->getbytes = pos;
      return 1;
    }
  else
    {
      udr_errno = UDIErrorIPCInternal;
      return 0;
    }
}
 
/***************************************************************** UDR_READNOW
* Try and ensure "size" bytes are available in the
* receive buffer character stream.
*/
int 
udr_readnow (udrs, size)
     UDR *udrs;
     int size;
{
  int cnt, remain;
 
  if (udrs->udr_op == UDR_ENCODE)
    {
      udr_errno = UDIErrorIPCInternal;
      return -1;
    }
  else if (udrs->udr_op == UDR_DECODE)
    {
      if ((UDIUInt32) (udrs->putbytes) - (UDIUInt32) (udrs->getbytes) < size)
	{			/* need more data in character stream buffer */
	  remain = (UDIUInt32) (udrs->bufsize) -
	    ((UDIUInt32) (udrs->putbytes) - (UDIUInt32) (udrs->buff));
	  cnt = read (udrs->sd, (char *) udrs->putbytes, remain);
	  if (cnt == -1)
	    perror ("ERROR udr_work(),  read() failure: ");
	  udrs->putbytes += cnt;
	  if ((UDIUInt32) (udrs->putbytes) - (UDIUInt32) (udrs->getbytes) < size)
	    {
	      fprintf (stderr, "ERROR, udr_readnow() too few bytes in stream\n");
	      return -1;	/* return error code */
	    }
	}
    }
  else
    {
      udr_errno = UDIErrorIPCInternal;
      return -1;
    }
  return 0;
}
 
/******************************************************************* UDR_ALIGN
*/
int 
udr_align (udrs, size)
     UDR *udrs;
     int size;
{
  char *align;
  int offset;
 
  align = udr_getpos (udrs);
  offset = size - ((int) align & (size - 1));
  offset = offset & (size - 1);
  if (offset)
    udr_setpos (udrs, align + offset);
}