harvey/sys/src/cmd/cifs/netbios.c

/*
 * netbios dial, read, write
 */

#include <u.h>
#include <libc.h>
#include <ctype.h>
#include <fcall.h>
#include <thread.h>
#include <9p.h>
#include "cifs.h"

enum {
	MAXNBPKT		= 8096,		/* max netbios packet size */
	NBquery			= 0,		/* packet type - query */

	NBAdapterStatus		= 0x21,		/* get host interface info */
	NBInternet		= 1,		/* scope for info */

	NBmessage 		= 0x00,		/* Netbios packet types */
	NBrequest 		= 0x81,
	NBpositive,
	NBnegative,
	NBretarget,
	NBkeepalive,

	ISgroup			= 0x8000,
};


static char *NBerr[] = {
	[0]	"not listening on called name",
	[1]	"not listening for calling name",
	[2]	"called name not present",
	[3]	"insufficient resources",
	[15]	"unspecified error"
};


static ulong
GL32(uchar **p)
{
	ulong n;

	n  = *(*p)++;
	n |= *(*p)++ << 8;
	n |= *(*p)++ << 16;
	n |= *(*p)++ << 24;
	return n;
}

static ushort
GL16(uchar **p)
{
	ushort n;

	n  = *(*p)++;
	n |= *(*p)++ << 8;
	return n;
}

void
Gmem(uchar **p, void *v, int n)
{
	uchar *str = v;

	while(n--)
		*str++ = *(*p)++;
}


static ulong
GB32(uchar **p)
{
	ulong n;

	n  = *(*p)++ << 24;
	n |= *(*p)++ << 16;
	n |= *(*p)++ << 8;
	n |= *(*p)++;
	return n;
}

static ushort
GB16(uchar **p)
{
	ushort n;

	n  = *(*p)++ << 8;
	n |= *(*p)++;
	return n;
}

static uchar
G8(uchar **p)
{
	return *(*p)++;
}

static void
PB16(uchar **p, uint n)
{
	*(*p)++ = n >> 8;
	*(*p)++ = n;
}

static void
P8(uchar **p, uint n)
{
	*(*p)++ = n;
}


static void
nbname(uchar **p, char *name, char pad)
{
	char c;
	int i;
	int done = 0;

	*(*p)++ = 0x20;
	for(i = 0; i < 16; i++) {
		c = pad;
		if(!done && name[i] == '\0')
			done = 1;
		if(!done)
			c = toupper(name[i]);
		*(*p)++ = ((uchar)c >> 4) + 'A';
		*(*p)++ = (c & 0xf) + 'A';
	}
	*(*p)++ = 0;
}

int
calledname(char *host, char *name)
{
	char *addr;
	uchar buf[1024], *p;
	static char tmp[20];
	int num, flg, svs, j, i, fd, trn;

	trn = (getpid() ^ time(0)) & 0xffff;
	if((addr = netmkaddr(host, "udp", "137")) == nil)
		return -1;

	if((fd = dial(addr, "137", 0, 0)) < 0)
		return -1;
	p = buf;

	PB16(&p, trn);			/* TRNid */
	P8(&p, 0);			/* flags */
	P8(&p, 0x10);			/* type */
	PB16(&p, 1);			/* # questions */
	PB16(&p, 0);			/* # answers */
	PB16(&p, 0);			/* # authority RRs */
	PB16(&p, 0);			/* # Aditional RRs */
	nbname(&p, "*", 0);
	PB16(&p, NBAdapterStatus);
	PB16(&p, NBInternet);

	if(Debug && strstr(Debug, "dump"))
		xd(nil, buf, p-buf);

	if(write(fd, buf, p-buf) != p-buf)
		return -1;

	p = buf;
	for(i = 0; i < 3; i++){
		memset(buf, 0, sizeof(buf));
		alarm(NBNSTOUT);
		read(fd, buf, sizeof(buf));
		alarm(0);
		if(GB16(&p) == trn)
			break;
	}
	close(fd);
	if(i >= 3)
		return -1;

	p = buf +56;
	num = G8(&p);			/* number of names */

	for(i = 0; i < num; i++){
		memset(tmp, 0, sizeof(tmp));
		Gmem(&p, tmp, 15);
		svs = G8(&p);
		flg = GB16(&p);
		for(j = 14; j >= 0 && tmp[j] == ' '; j--)
			tmp[j] = 0;
		if(svs == 0 && !(flg & ISgroup))
			strcpy(name, tmp);
	}
	return 0;
}


int
nbtdial(char *addr, char *called, char *sysname)
{
	char redir[20];
	uchar *p, *lenp, buf[1024];
	int type, len, err, fd, nkeepalive, nretarg;

	nretarg = 0;
	nkeepalive = 0;
Redial:
	if((addr = netmkaddr(addr, "tcp", "139")) == nil ||
	    (fd = dial(addr, 0, 0, 0)) < 0)
		return -1;

	memset(buf, 0, sizeof(buf));

	p = buf;
	P8(&p, NBrequest);		/* type */
	P8(&p, 0);			/* flags */
	lenp = p; PB16(&p, 0);		/* length placeholder */
	nbname(&p, called, ' ');	/* remote NetBios name */
	nbname(&p, sysname, ' ');	/* our machine name */
	PB16(&lenp, p-lenp -2);		/* length re-write */

	if(Debug && strstr(Debug, "dump"))
		xd(nil, buf, p-buf);
	if(write(fd, buf, p-buf) != p-buf)
		goto Error;
Reread:
	p = buf;
	memset(buf, 0, sizeof(buf));
	if(readn(fd, buf, 4) < 4)
		goto Error;

	type = G8(&p);
	G8(&p);				/* flags */
	len = GB16(&p);

	if(readn(fd, buf +4, len -4) < len -4)
		goto Error;

	if(Debug && strstr(Debug, "dump"))
		xd(nil, buf, len+4);

	switch(type) {
	case NBpositive:
		return fd;
	case NBnegative:
		if(len < 1) {
			werrstr("nbdial: bad error pkt");
			goto Error;
		}
		err = G8(&p);
		if(err < 0 || err > nelem(NBerr) || NBerr[err] == nil)
			werrstr("NBT: %d - unknown error", err);
		else
			werrstr("NBT: %s", NBerr[err]);

		goto Error;
	case NBkeepalive:
		if(++nkeepalive >= 16){
			werrstr("nbdial: too many keepalives");
			goto Error;
		}
		goto Reread;

	case NBretarget:
		if(++nretarg >= 16) {
			werrstr("nbdial: too many redirects");
			goto Error;
		}
		if(len < 4) {
			werrstr("nbdial: bad redirect pkt");
			goto Error;
		}
		sprint(redir, "%d.%d.%d.%d", p[0], p[1], p[2], p[3]);
		addr = redir;
		goto Redial;

	default:
		werrstr("nbdial: 0x%x - unknown packet in netbios handshake", type);
		goto Error;
	}
Error:
	close(fd);
	return -1;
}

void
nbthdr(Pkt *p)
{
	p->pos = p->buf;
	memset(p->buf, 0xa5, MTU);

	p8(p, NBmessage);		/* type */
	p8(p, 0);			/* flags */
	pb16(p, 0);			/* length (filled in later) */
}

int
nbtrpc(Pkt *p)
{
	int len, got, type, nkeep;

	len = p->pos - p->buf;

	p->pos = p->buf +2;
	pb16(p, len - NBHDRLEN);	/* length */

	if(Debug && strstr(Debug, "dump"))
		xd("tx", p->buf, len);

	alarm(NBRPCTOUT);
	if(write(p->s->fd, p->buf, len) != len){
		werrstr("nbtrpc: write failed - %r");
		alarm(0);
		return -1;
	}

	nkeep = 0;
retry:
	p->pos = p->buf;
	memset(p->buf, 0xa5, MTU);

	got = readn(p->s->fd, p->buf, NBHDRLEN);

	if(got < NBHDRLEN){
		werrstr("nbtrpc: short read - %r");
		alarm(0);
		return -1;
	}
	p->eop = p->buf + got;

	type = g8(p);			/* NBT type (session) */
	if(type == NBkeepalive){
		if(++nkeep > 16) {
			werrstr("nbtrpc: too many keepalives (%d attempts)", nkeep);
			alarm(0);
			return -1;
		}
		goto retry;
	}

	g8(p);				/* NBT flags (none) */

	len = gb16(p);			/* NBT payload length */
	if((len +NBHDRLEN) > MTU){
		werrstr("nbtrpc: packet bigger than MTU, (%d > %d)", len, MTU);
		alarm(0);
		return -1;
	}

	got = readn(p->s->fd, p->buf +NBHDRLEN, len);
	alarm(0);

	if(Debug && strstr(Debug, "dump"))
		xd("rx", p->buf, got +NBHDRLEN);

	if(got < 0)
		return -1;
	p->eop = p->buf + got +NBHDRLEN;
	return got+NBHDRLEN;
}


void
xd(char *str, void *buf, int n)
{
	int fd, flg, flags2, cmd;
	uint sum;
	long err;
	uchar *p, *end;

	if(n == 0)
		return;

	p = buf;
	end = (uchar *)buf +n;

	if(Debug && strstr(Debug, "log") != nil){
		if((fd = open("pkt.log", ORDWR)) == -1)
			return;
		seek(fd, 0, 2);
		fprint(fd, "%d	", 0);
		while(p < end)
			fprint(fd, "%02x ", *p++);
		fprint(fd, "\n");
		close(fd);
		return;
	}

	if(!str)
		goto Raw;

	p = (uchar *)buf + 4;
	if(GL32(&p) == 0x424d53ff){
		buf = (uchar *)buf + 4;
		n -= 4;
	}
	end = (uchar *)buf + n;

	sum = 0;
	p = buf;
	while(p < end)
		sum += *p++;
	p = buf;

	fprint(2, "%s : len=%ud sum=%d\n", str, n, sum);

	fprint(2, "mag=0x%ulx ", GL32(&p));
	fprint(2, "cmd=0x%ux ", cmd = G8(&p));
	fprint(2, "err=0x%ulx ", err=GL32(&p));
	fprint(2, "flg=0x%02ux ", flg = G8(&p));
	fprint(2, "flg2=0x%04ux\n", flags2= GL16(&p));
	fprint(2, "dfs=%s\n", (flags2 & FL2_DFS)? "y": "n");

	fprint(2, "pidl=%ud ", GL16(&p));
	fprint(2, "res=%uld ", GL32(&p));
	fprint(2, "sid=%ud ", GL16(&p));
	fprint(2, "seq=0x%ux ", GL16(&p));
	fprint(2, "pad=%ud ", GL16(&p));

	fprint(2, "tid=%ud ", GL16(&p));
	fprint(2, "pid=%ud ", GL16(&p));
	fprint(2, "uid=%ud ", GL16(&p));
	fprint(2, "mid=%ud\n", GL16(&p));

	if(cmd == 0x32 && (flg & 0x80) == 0){		/* TRANS 2, TX */
		fprint(2, "words=%ud ", G8(&p));
		fprint(2, "totparams=%ud ", GL16(&p));
		fprint(2, "totdata=%ud ", GL16(&p));
		fprint(2, "maxparam=%ud ", GL16(&p));
		fprint(2, "maxdata=%ud\n", GL16(&p));
		fprint(2, "maxsetup=%ud ", G8(&p));
		fprint(2, "reserved=%ud ", G8(&p));
		fprint(2, "flags=%ud ", GL16(&p));
		fprint(2, "timeout=%uld\n", GL32(&p));
		fprint(2, "reserved=%ud ", GL16(&p));
		fprint(2, "paramcnt=%ud ", GL16(&p));
		fprint(2, "paramoff=%ud ", GL16(&p));
		fprint(2, "datacnt=%ud ", GL16(&p));
		fprint(2, "dataoff=%ud ", GL16(&p));
		fprint(2, "setupcnt=%ud ", G8(&p));
		fprint(2, "reserved=%ud\n", G8(&p));
		fprint(2, "trans2=0x%02x ", GL16(&p));
		fprint(2, "data-words=%d ", G8(&p));
		fprint(2, "padding=%d\n", G8(&p));
	}
	if(cmd == 0x32 && (flg & 0x80) == 0x80){	/* TRANS 2, RX */
		fprint(2, "words=%ud ", G8(&p));
		fprint(2, "totparams=%ud ", GL16(&p));
		fprint(2, "totdata=%ud ", GL16(&p));
		fprint(2, "reserved=%ud ", GL16(&p));
		fprint(2, "paramcnt=%ud\n", GL16(&p));
		fprint(2, "paramoff=%ud ", GL16(&p));
		fprint(2, "paramdisp=%ud ", GL16(&p));
		fprint(2, "datacnt=%ud\n", GL16(&p));
		fprint(2, "dataoff=%ud ", GL16(&p));
		fprint(2, "datadisp=%ud ", GL16(&p));
		fprint(2, "setupcnt=%ud ", G8(&p));
		fprint(2, "reserved=%ud\n", G8(&p));
	}
	if(err)
		if(flags2 & FL2_NT_ERRCODES)
			fprint(2, "err=%s\n", nterrstr(err));
		else
			fprint(2, "err=%s\n", doserrstr(err));
Raw:
	fprint(2, "\n");
	for(; p < end; p++){
		if((p - (uchar *)buf) % 16 == 0)
			fprint(2, "\n%06lx\t", p - (uchar *)buf);
		if(isprint((char)*p))
			fprint(2, "%c  ", (char )*p);
		else
			fprint(2, "%02ux ", *p);
	}
	fprint(2, "\n");
}