#pragma ident "%Z%%M% %I% %E% SMI"
#include <rpc/types.h>
#include <rpc/xdr.h>
#include <netinet/in.h>
#include <sys/promif.h>
#include <sys/salib.h>
#include <sys/bootdebug.h>
#define dprintf if (boothowto & RB_DEBUG) printf
extern long lseek();
static bool_t xdrrec_getint32();
static bool_t xdrrec_putint32();
static bool_t xdrrec_getbytes();
static bool_t xdrrec_putbytes();
static uint_t xdrrec_getpos();
static bool_t xdrrec_setpos();
static int32_t *xdrrec_inline();
static void xdrrec_destroy();
static struct xdr_ops *xdrrec_ops();
static bool_t flush_out();
static bool_t fill_input_buf();
static bool_t get_input_bytes();
static bool_t set_input_fragment();
static bool_t skip_input_bytes();
static uint_t fix_buf_size();
#define LAST_FRAG 0x80000000
typedef struct rec_strm {
caddr_t tcp_handle;
caddr_t the_buffer;
int (*writeit)();
caddr_t out_base;
caddr_t out_finger;
caddr_t out_boundry;
uint32_t *frag_header;
bool_t frag_sent;
int (*readit)();
uint32_t in_size;
caddr_t in_base;
caddr_t in_finger;
caddr_t in_boundry;
int fbtbc;
bool_t last_frag;
uint_t sendsize;
uint_t recvsize;
} RECSTREAM;
void
xdrrec_create(XDR *xdrs, uint_t sendsize, uint_t recvsize, caddr_t tcp_handle,
int (*readit)(), int (*writeit)())
{
RECSTREAM *rstrm = (RECSTREAM *)mem_alloc(sizeof (RECSTREAM));
if (rstrm == NULL) {
dprintf("xdrrec_create: out of memory\n");
return;
}
rstrm->sendsize = sendsize = fix_buf_size(sendsize);
rstrm->recvsize = recvsize = fix_buf_size(recvsize);
rstrm->the_buffer = mem_alloc(sendsize + recvsize + BYTES_PER_XDR_UNIT);
if (rstrm->the_buffer == NULL) {
dprintf("xdrrec_create: out of memory\n");
return;
}
for (rstrm->out_base = rstrm->the_buffer;
(uintptr_t)rstrm->out_base % BYTES_PER_XDR_UNIT != 0;
rstrm->out_base++);
rstrm->in_base = rstrm->out_base + sendsize;
xdrs->x_ops = xdrrec_ops();
xdrs->x_private = (caddr_t)rstrm;
rstrm->tcp_handle = tcp_handle;
rstrm->readit = readit;
rstrm->writeit = writeit;
rstrm->out_finger = rstrm->out_boundry = rstrm->out_base;
rstrm->frag_header = (uint32_t *)rstrm->out_base;
rstrm->out_finger += sizeof (uint_t);
rstrm->out_boundry += sendsize;
rstrm->frag_sent = FALSE;
rstrm->in_size = recvsize;
rstrm->in_boundry = rstrm->in_base;
rstrm->in_finger = (rstrm->in_boundry += recvsize);
rstrm->fbtbc = 0;
rstrm->last_frag = TRUE;
}
static bool_t
xdrrec_getint32(XDR *xdrs, int32_t *ip)
{
RECSTREAM *rstrm = (RECSTREAM *)(xdrs->x_private);
int32_t *bufip = (int32_t *)(rstrm->in_finger);
int32_t myint;
if ((rstrm->fbtbc >= sizeof (int32_t)) &&
(((ptrdiff_t)rstrm->in_boundry
- (ptrdiff_t)bufip) >= sizeof (int32_t))) {
*ip = (int32_t)ntohl((uint32_t)(*bufip));
rstrm->fbtbc -= sizeof (int32_t);
rstrm->in_finger += sizeof (int32_t);
} else {
if (!xdrrec_getbytes(xdrs, (caddr_t)&myint, sizeof (int32_t)))
return (FALSE);
*ip = (int32_t)ntohl((uint32_t)myint);
}
return (TRUE);
}
static bool_t
xdrrec_putint32(XDR *xdrs, int32_t *ip)
{
RECSTREAM *rstrm = (RECSTREAM *)(xdrs->x_private);
int32_t *dest_ip = ((int32_t *)(rstrm->out_finger));
if ((rstrm->out_finger += sizeof (int32_t)) > rstrm->out_boundry) {
rstrm->out_finger -= sizeof (int32_t);
rstrm->frag_sent = TRUE;
if (! flush_out(rstrm, FALSE))
return (FALSE);
dest_ip = ((int32_t *)(rstrm->out_finger));
rstrm->out_finger += sizeof (int32_t);
}
*dest_ip = (int32_t)htonl((uint32_t)(*ip));
return (TRUE);
}
static bool_t
xdrrec_getbytes(XDR *xdrs, caddr_t addr, int32_t len)
{
RECSTREAM *rstrm = (RECSTREAM *)(xdrs->x_private);
int current;
int frag_len;
while (len > 0) {
current = frag_len = rstrm->fbtbc;
if (current == 0) {
if (rstrm->last_frag)
return (FALSE);
if (!set_input_fragment(rstrm))
return (FALSE);
continue;
}
current = (len < current) ? len : current;
if (!get_input_bytes(rstrm, addr, frag_len, current))
return (FALSE);
addr += current;
rstrm->fbtbc -= current;
len -= current;
}
return (TRUE);
}
static bool_t
xdrrec_putbytes(XDR *xdrs, caddr_t addr, int32_t len)
{
RECSTREAM *rstrm = (RECSTREAM *)(xdrs->x_private);
ptrdiff_t current;
while (len > 0) {
current = rstrm->out_boundry - rstrm->out_finger;
current = (len < current) ? len : current;
bcopy(addr, rstrm->out_finger, current);
rstrm->out_finger += current;
addr += current;
len -= current;
if (rstrm->out_finger == rstrm->out_boundry) {
rstrm->frag_sent = TRUE;
if (! flush_out(rstrm, FALSE))
return (FALSE);
}
}
return (TRUE);
}
static uint_t
xdrrec_getpos(XDR *xdrs)
{
RECSTREAM *rstrm = (RECSTREAM *)xdrs->x_private;
int32_t pos;
pos = lseek((int)(intptr_t)rstrm->tcp_handle, 0, 1);
if (pos != -1)
switch (xdrs->x_op) {
case XDR_ENCODE:
pos += rstrm->out_finger - rstrm->out_base;
break;
case XDR_DECODE:
pos -= rstrm->in_boundry - rstrm->in_finger;
break;
default:
pos = (uint_t)-1;
break;
}
return ((uint_t)pos);
}
static bool_t
xdrrec_setpos(XDR *xdrs, uint_t pos)
{
RECSTREAM *rstrm = (RECSTREAM *)xdrs->x_private;
uint_t currpos = xdrrec_getpos(xdrs);
int delta = currpos - pos;
caddr_t newpos;
if ((int)currpos != -1)
switch (xdrs->x_op) {
case XDR_ENCODE:
newpos = rstrm->out_finger - delta;
if ((newpos > (caddr_t)(rstrm->frag_header)) &&
(newpos < rstrm->out_boundry)) {
rstrm->out_finger = newpos;
return (TRUE);
}
break;
case XDR_DECODE:
newpos = rstrm->in_finger - delta;
if ((delta < (int)(rstrm->fbtbc)) &&
(newpos <= rstrm->in_boundry) &&
(newpos >= rstrm->in_base)) {
rstrm->in_finger = newpos;
rstrm->fbtbc -= delta;
return (TRUE);
}
break;
}
return (FALSE);
}
static int32_t *
xdrrec_inline(XDR *xdrs, int len)
{
RECSTREAM *rstrm = (RECSTREAM *)xdrs->x_private;
int32_t *buf = NULL;
switch (xdrs->x_op) {
case XDR_ENCODE:
if ((rstrm->out_finger + len) <= rstrm->out_boundry) {
buf = (int32_t *)rstrm->out_finger;
rstrm->out_finger += len;
}
break;
case XDR_DECODE:
if ((len <= rstrm->fbtbc) &&
((rstrm->in_finger + len) <= rstrm->in_boundry)) {
buf = (int32_t *)rstrm->in_finger;
rstrm->fbtbc -= len;
rstrm->in_finger += len;
}
break;
}
return (buf);
}
static void
xdrrec_destroy(XDR *xdrs)
{
RECSTREAM *rstrm = (RECSTREAM *)xdrs->x_private;
mem_free(rstrm->the_buffer,
rstrm->sendsize + rstrm->recvsize + BYTES_PER_XDR_UNIT);
mem_free((caddr_t)rstrm, sizeof (RECSTREAM));
}
bool_t
xdrrec_skiprecord(XDR *xdrs)
{
RECSTREAM *rstrm = (RECSTREAM *)(xdrs->x_private);
while (rstrm->fbtbc > 0 || (! rstrm->last_frag)) {
if (! skip_input_bytes(rstrm, rstrm->fbtbc))
return (FALSE);
rstrm->fbtbc = 0;
if ((! rstrm->last_frag) && (! set_input_fragment(rstrm)))
return (FALSE);
}
rstrm->last_frag = FALSE;
return (TRUE);
}
#ifdef notneeded
bool_t
xdrrec_eof(XDR *xdrs)
{
RECSTREAM *rstrm = (RECSTREAM *)(xdrs->x_private);
while (rstrm->fbtbc > 0 || (! rstrm->last_frag)) {
if (! skip_input_bytes(rstrm, rstrm->fbtbc))
return (TRUE);
rstrm->fbtbc = 0;
if ((! rstrm->last_frag) && (! set_input_fragment(rstrm)))
return (TRUE);
}
if (rstrm->in_finger == rstrm->in_boundry)
return (TRUE);
return (FALSE);
}
#endif
bool_t
xdrrec_endofrecord(XDR *xdrs, bool_t sendnow)
{
RECSTREAM *rstrm = (RECSTREAM *)(xdrs->x_private);
ptrdiff_t len;
if (sendnow || rstrm->frag_sent ||
((ptrdiff_t)rstrm->out_finger + sizeof (uint32_t)
>= (ptrdiff_t)rstrm->out_boundry)) {
rstrm->frag_sent = FALSE;
return (flush_out(rstrm, TRUE));
}
len = (ptrdiff_t)rstrm->out_finger - (ptrdiff_t)rstrm->frag_header;
len -= sizeof (uint32_t);
*(rstrm->frag_header) = htonl((uint32_t)len | LAST_FRAG);
rstrm->frag_header = (uint32_t *)rstrm->out_finger;
rstrm->out_finger += sizeof (uint32_t);
return (TRUE);
}
static bool_t
flush_out(RECSTREAM *rstrm, bool_t eor)
{
uint32_t eormask = (eor == TRUE) ? LAST_FRAG : 0;
ptrdiff_t len;
len = (ptrdiff_t)rstrm->out_finger - (ptrdiff_t)rstrm->frag_header;
len -= sizeof (uint32_t);
*(rstrm->frag_header) = htonl(len | eormask);
len = rstrm->out_finger - rstrm->out_base;
if ((*(rstrm->writeit))(rstrm->tcp_handle, rstrm->out_base, (int)len)
!= (int)len)
return (FALSE);
rstrm->frag_header = (uint32_t *)rstrm->out_base;
rstrm->out_finger = (caddr_t)rstrm->out_base + sizeof (uint32_t);
return (TRUE);
}
static bool_t
fill_input_buf(RECSTREAM *rstrm, int frag_len)
{
caddr_t where;
uintptr_t i;
int len;
where = rstrm->in_base;
i = (uintptr_t)rstrm->in_boundry % BYTES_PER_XDR_UNIT;
where += i;
len = (frag_len < (rstrm->in_size - i)) ? frag_len :
rstrm->in_size - i;
#ifdef DEBUG
printf("fill_input_buf: len = %d\n", len);
#endif
if ((len = (*(rstrm->readit))(rstrm->tcp_handle, where, len)) == -1)
return (FALSE);
rstrm->in_finger = where;
where += len;
rstrm->in_boundry = where;
return (TRUE);
}
static bool_t
get_input_bytes(RECSTREAM *rstrm, caddr_t addr, int frag_len, int len)
{
ptrdiff_t current;
while (len > 0) {
current = rstrm->in_boundry - rstrm->in_finger;
#ifdef DEBUG
printf("get_input_bytes: len = %d, frag_len = %d, current %d\n",
len, frag_len, current);
#endif
if (frag_len == 0)
frag_len = len;
if (current == 0) {
if (! fill_input_buf(rstrm, frag_len))
return (FALSE);
continue;
}
current = (len < current) ? len : current;
bcopy(rstrm->in_finger, addr, current);
rstrm->in_finger += current;
addr += current;
len -= current;
}
return (TRUE);
}
static bool_t
set_input_fragment(RECSTREAM *rstrm)
{
uint32_t header;
if (! get_input_bytes(rstrm, (caddr_t)&header, 0, sizeof (header)))
return (FALSE);
header = (uint32_t)ntohl(header);
rstrm->last_frag = ((header & LAST_FRAG) == 0) ? FALSE : TRUE;
rstrm->fbtbc = header & (~LAST_FRAG);
#ifdef DEBUG
printf("set_input_fragment: frag_len = %d, last frag = %s\n",
rstrm->fbtbc, rstrm->last_frag ? "TRUE" : "FALSE");
#endif
return (TRUE);
}
static bool_t
skip_input_bytes(RECSTREAM *rstrm, int32_t cnt)
{
ptrdiff_t current;
#ifdef DEBUG
printf("skip_input_fragment: cnt = %d\n", cnt);
#endif
while (cnt > 0) {
current = rstrm->in_boundry - rstrm->in_finger;
if (current == 0) {
if (! fill_input_buf(rstrm, cnt))
return (FALSE);
continue;
}
current = (cnt < current) ? cnt : current;
rstrm->in_finger += current;
cnt -= current;
}
return (TRUE);
}
static uint_t
fix_buf_size(uint_t s)
{
if (s < 100)
s = 4000;
return (RNDUP(s));
}
static struct xdr_ops *
xdrrec_ops()
{
static struct xdr_ops ops;
if (ops.x_getint32 == NULL) {
ops.x_getint32 = xdrrec_getint32;
ops.x_putint32 = xdrrec_putint32;
ops.x_getbytes = xdrrec_getbytes;
ops.x_putbytes = xdrrec_putbytes;
ops.x_getpostn = xdrrec_getpos;
ops.x_setpostn = xdrrec_setpos;
ops.x_inline = xdrrec_inline;
ops.x_destroy = xdrrec_destroy;
}
return (&ops);
}