#include <sys/types.h>
#include <stdarg.h>
#include <ctype.h>
#include <stdio.h>
#include <stdlib.h>
#include <strings.h>
#include <string.h>
#include <assert.h>
#include <syslog.h>
#include <libmlrpc/mlrpc.h>
#include <libmlrpc/ndr.h>
#define NDOBUFSZ 128
#define NDR_PDU_BLOCK_SIZE (4*1024)
#define NDR_PDU_BLOCK_MASK (NDR_PDU_BLOCK_SIZE - 1)
#define NDR_PDU_ALIGN(N) \
(((N) + NDR_PDU_BLOCK_SIZE) & ~NDR_PDU_BLOCK_MASK)
#define NDR_PDU_MAX_SIZE (64*1024*1024)
static char *mlndo_malloc(struct mlndr_stream *, size_t,
struct ndr_reference *);
static int mlndo_free(struct mlndr_stream *, char *, struct ndr_reference *);
static int mlndo_grow_pdu(struct mlndr_stream *, unsigned long,
struct ndr_reference *);
static int mlndo_pad_pdu(struct mlndr_stream *, unsigned long, unsigned long,
struct ndr_reference *);
static int mlndo_get_pdu(struct mlndr_stream *, unsigned long, unsigned long,
char *, int, struct ndr_reference *);
static int mlndo_put_pdu(struct mlndr_stream *, unsigned long, unsigned long,
char *, int, struct ndr_reference *);
static void mlndo_tattle(struct mlndr_stream *, char *, struct ndr_reference *);
static void mlndo_tattle_error(struct mlndr_stream *, struct ndr_reference *);
static int mlndo_reset(struct mlndr_stream *);
static void mlndo_destruct(struct mlndr_stream *);
static void mlndo_hexfmt(uint8_t *, int, int, char *, int);
static struct mlndr_stream_ops mlnds_ops = {
mlndo_malloc,
mlndo_free,
mlndo_grow_pdu,
mlndo_pad_pdu,
mlndo_get_pdu,
mlndo_put_pdu,
mlndo_tattle,
mlndo_tattle_error,
mlndo_reset,
mlndo_destruct
};
void
mlnds_bswap(const void *srcbuf, void *dstbuf, size_t len)
{
uint8_t *src = (uint8_t *)srcbuf;
uint8_t *dst = (uint8_t *)dstbuf;
if ((len != 0) && ((len & (len - 1)) == 0)) {
src += len;
while (len--)
*dst++ = *(--src);
}
}
int
mlnds_initialize(struct mlndr_stream *mlnds, unsigned pdu_size_hint,
int composite_op, mlrpc_heap_t *heap)
{
unsigned size;
assert(mlnds);
assert(heap);
bzero(mlnds, sizeof (*mlnds));
if (pdu_size_hint > NDR_PDU_MAX_SIZE)
return (0);
size = (pdu_size_hint == 0) ? NDR_PDU_BLOCK_SIZE : pdu_size_hint;
mlnds->pdu_base_addr = malloc(size);
assert(mlnds->pdu_base_addr);
mlnds->pdu_max_size = size;
mlnds->pdu_size = 0;
mlnds->mlndo = &mlnds_ops;
mlnds->heap = heap;
mlnds->m_op = composite_op & 0x0F;
mlnds->dir = composite_op & 0xF0;
mlnds->outer_queue_tailp = &mlnds->outer_queue_head;
return (1);
}
void
mlnds_destruct(struct mlndr_stream *mlnds)
{
MLNDS_DESTRUCT(mlnds);
}
static char *
mlndo_malloc(struct mlndr_stream *mlnds, size_t len,
struct ndr_reference *ref)
{
return (mlrpc_heap_malloc((mlrpc_heap_t *)mlnds->heap, len));
}
static int
mlndo_free(struct mlndr_stream *mlnds, char *p, struct ndr_reference *ref)
{
return (1);
}
static int
mlndo_grow_pdu(struct mlndr_stream *mlnds, unsigned long want_end_offset,
struct ndr_reference *ref)
{
unsigned char *pdu_addr;
unsigned pdu_max_size;
mlndo_printf(mlnds, ref, "grow %d", want_end_offset);
pdu_max_size = mlnds->pdu_max_size;
if (want_end_offset > pdu_max_size) {
pdu_max_size = NDR_PDU_ALIGN(want_end_offset);
if (pdu_max_size >= NDR_PDU_MAX_SIZE)
return (0);
pdu_addr = realloc(mlnds->pdu_base_addr, pdu_max_size);
if (pdu_addr == 0)
return (0);
mlnds->pdu_max_size = pdu_max_size;
mlnds->pdu_base_addr = pdu_addr;
}
return (1);
}
static int
mlndo_pad_pdu(struct mlndr_stream *mlnds, unsigned long pdu_offset,
unsigned long n_bytes, struct ndr_reference *ref)
{
unsigned char *data;
data = mlnds->pdu_base_addr;
data += pdu_offset;
mlndo_printf(mlnds, ref, "pad %d@%-3d", n_bytes, pdu_offset);
bzero(data, n_bytes);
return (1);
}
static int
mlndo_get_pdu(struct mlndr_stream *mlnds, unsigned long pdu_offset,
unsigned long n_bytes, char *buf, int swap_bytes,
struct ndr_reference *ref)
{
unsigned char *data;
char hexbuf[NDOBUFSZ];
data = mlnds->pdu_base_addr;
data += pdu_offset;
mlndo_hexfmt(data, n_bytes, swap_bytes, hexbuf, NDOBUFSZ);
mlndo_printf(mlnds, ref, "get %d@%-3d = %s",
n_bytes, pdu_offset, hexbuf);
if (!swap_bytes)
bcopy(data, buf, n_bytes);
else
mlnds_bswap(data, (unsigned char *)buf, n_bytes);
return (1);
}
static int
mlndo_put_pdu(struct mlndr_stream *mlnds, unsigned long pdu_offset,
unsigned long n_bytes, char *buf, int swap_bytes,
struct ndr_reference *ref)
{
unsigned char *data;
char hexbuf[NDOBUFSZ];
data = mlnds->pdu_base_addr;
data += pdu_offset;
mlndo_hexfmt((uint8_t *)buf, n_bytes, 0, hexbuf, NDOBUFSZ);
mlndo_printf(mlnds, ref, "put %d@%-3d = %s",
n_bytes, pdu_offset, hexbuf);
bcopy(buf, data, n_bytes);
return (1);
}
static void
mlndo_tattle(struct mlndr_stream *mlnds, char *what,
struct ndr_reference *ref)
{
mlndo_printf(mlnds, ref, what);
}
static void
mlndo_tattle_error(struct mlndr_stream *mlnds, struct ndr_reference *ref)
{
unsigned char *data;
char hexbuf[NDOBUFSZ];
data = mlnds->pdu_base_addr;
if (ref)
data += ref->pdu_offset;
else
data += mlnds->pdu_scan_offset;
mlndo_hexfmt(data, 16, 0, hexbuf, NDOBUFSZ);
mlndo_printf(mlnds, ref, "ERROR=%d REF=%d OFFSET=%d SIZE=%d/%d",
mlnds->error, mlnds->error_ref, mlnds->pdu_scan_offset,
mlnds->pdu_size, mlnds->pdu_max_size);
mlndo_printf(mlnds, ref, " %s", hexbuf);
}
static int
mlndo_reset(struct mlndr_stream *mlnds)
{
mlndo_printf(mlnds, 0, "reset");
mlnds->pdu_size = 0;
mlnds->pdu_scan_offset = 0;
mlnds->outer_queue_head = 0;
mlnds->outer_current = 0;
mlnds->outer_queue_tailp = &mlnds->outer_queue_head;
return (1);
}
static void
mlndo_destruct(struct mlndr_stream *mlnds)
{
mlndo_printf(mlnds, 0, "destruct");
if (mlnds->pdu_base_addr != 0) {
free(mlnds->pdu_base_addr);
mlnds->pdu_base_addr = 0;
}
mlnds->outer_queue_head = 0;
mlnds->outer_current = 0;
mlnds->outer_queue_tailp = &mlnds->outer_queue_head;
}
void
mlndo_printf(struct mlndr_stream *mlnds, struct ndr_reference *ref,
const char *fmt, ...)
{
va_list ap;
char buf[NDOBUFSZ];
va_start(ap, fmt);
(void) vsnprintf(buf, NDOBUFSZ, fmt, ap);
va_end(ap);
if (mlnds)
mlndo_fmt(mlnds, ref, buf);
else
mlndo_trace(buf);
}
void
mlndo_fmt(struct mlndr_stream *mlnds, struct ndr_reference *ref, char *note)
{
struct ndr_reference *p;
int indent;
char ref_name[NDOBUFSZ];
char buf[NDOBUFSZ];
int m_op_c = '?', dir_c = '?';
switch (mlnds->m_op) {
case 0: m_op_c = '-'; break;
case NDR_M_OP_MARSHALL: m_op_c = 'M'; break;
case NDR_M_OP_UNMARSHALL: m_op_c = 'U'; break;
default: m_op_c = '?'; break;
}
switch (mlnds->dir) {
case 0: dir_c = '-'; break;
case NDR_DIR_IN: dir_c = 'I'; break;
case NDR_DIR_OUT: dir_c = 'O'; break;
default: dir_c = '?'; break;
}
for (indent = 0, p = ref; p; p = p->enclosing)
indent++;
if (ref && ref->name) {
if (*ref->name == '[' && ref->enclosing) {
indent--;
(void) snprintf(ref_name, NDOBUFSZ, "%s%s",
ref->enclosing->name, ref->name);
} else {
(void) strlcpy(ref_name, ref->name, NDOBUFSZ);
}
} else {
(void) strlcpy(ref_name, "----", NDOBUFSZ);
}
(void) snprintf(buf, NDOBUFSZ, "%c%c %02d %-.*s %-*s %s",
m_op_c, dir_c, indent, indent,
"....+....+....+....+....+....",
20 - indent, ref_name, note);
mlndo_trace(buf);
}
void
mlndo_trace(const char *s)
{
syslog(LOG_DEBUG, "%s", s);
}
static void
mlndo_hexfmt(uint8_t *data, int size, int swap_bytes, char *buf, int len)
{
int interp = 1;
uint32_t c;
int n, i;
char tmp[16 + 1];
n = (size > 10) ? 10 : size;
if (n > len-1)
n = len-1;
switch (size) {
case 1:
c = *(uint8_t *)data;
break;
case 2:
if (swap_bytes == 0)
c = *(uint16_t *)data;
else
c = (data[0] << 8) | data[1];
break;
case 4:
if (swap_bytes == 0) {
c = *(uint32_t *)data;
} else {
c = (data[0] << 24) | (data[1] << 16)
| (data[2] << 8) | data[3];
}
break;
default:
c = 0;
interp = 0;
break;
}
if (interp) {
snprintf(tmp, sizeof (tmp), "%4u {", c);
} else {
snprintf(tmp, sizeof (tmp), " {");
}
strlcpy(buf, tmp, len);
snprintf(tmp, sizeof (tmp), "%02x", data[0]);
strlcat(buf, tmp, len);
for (i = 1; i < n; i++) {
snprintf(tmp, sizeof (tmp), " %02x", data[i]);
strlcat(buf, tmp, len);
}
if (size > 10)
strlcat(buf, " ...}", len);
else
strlcat(buf, "}", len);
if ((size < 4) && isprint((uint8_t)c)) {
snprintf(tmp, sizeof (tmp), " %c", (uint8_t)c);
strlcat(buf, tmp, len);
}
}