code: plan9front

ref: 5622b0bbd878dbc34045cc6fd37cffa64461eabe
dir: /sys/src/cmd/nusb/lib/dump.c/

View raw version
#include <u.h>
#include <libc.h>
#include <thread.h>
#include "usb.h"

int usbdebug;

static char *edir[] = {"in", "out", "inout"};
static char *etype[] = {"ctl", "iso", "bulk", "intr"};
static char* cnames[] =
{
	"none", "audio", "comms", "hid", "",
	"", "", "printer", "storage", "hub", "data"
};
static char* devstates[] =
{
	"detached", "attached", "enabled", "assigned", "configured"
};

char*
classname(int c)
{
	static char buf[30];

	if(c >= 0 && c < nelem(cnames))
		return cnames[c];
	else{
		seprint(buf, buf+30, "%d", c);
		return buf;
	}
}

char *
hexstr(void *a, int n)
{
	int i;
	char *dbuff, *s, *e;
	uchar *b;

	b = a;
	dbuff = s = emallocz(1024, 0);
	*s = 0;
	e = s + 1024;
	for(i = 0; i < n; i++)
		s = seprint(s, e, " %.2ux", b[i]);
	if(s == e)
		fprint(2, "%s: usb/lib: hexdump: bug: small buffer\n", argv0);
	return dbuff;
}

static void
fmtprintiface(Fmt *f, Iface *i)
{
	int	j;
	Ep	*ep;
	char	*eds, *ets;

	fmtprint(f, "\t\tiface csp %s.%uld.%uld alt %d\n",
		classname(Class(i->csp)), Subclass(i->csp), Proto(i->csp), i->alt);
	for(j = 0; j < nelem(i->ep); j++){
		ep = i->ep[j];
		if(ep == nil)
			break;
		eds = ets = "";
		if(ep->dir <= nelem(edir))
			eds = edir[ep->dir];
		if(ep->type <= nelem(etype))
			ets = etype[ep->type];
		fmtprint(f, "\t\t  ep id %d addr %d dir %s type %s"
			"  attrib %x maxpkt %d ntds %d pollival %d\n",
			ep->id, ep->id & Epmax, eds, ets, ep->attrib,
			ep->maxpkt, ep->ntds, ep->pollival);
	}
}

static void
fmtprintconf(Fmt *f, Usbdev *d, int ci)
{
	int i;
	Conf *c;
	Iface *fc;
	char *hd;

	c = d->conf[ci];
	fmtprint(f, "\tconf: cval %d attrib %x %d mA\n",
		c->cval, c->attrib, c->milliamps);
	for(i = 0; i < Niface; i++){
		for(fc = c->iface[i]; fc != nil; fc = fc->next)
			fmtprintiface(f, fc);
	}
	for(i = 0; i < Nddesc; i++)
		if(d->ddesc[i] == nil)
			break;
		else if(d->ddesc[i]->conf == c){
			hd = hexstr((uchar*)&d->ddesc[i]->data,
				d->ddesc[i]->data.bLength);
			fmtprint(f, "\t\tdev desc %x[%d]: %s\n",
				d->ddesc[i]->data.bDescriptorType,
				d->ddesc[i]->data.bLength, hd);
			free(hd);
		}
}

int
Ufmt(Fmt *f)
{
	int i;
	Dev *d;
	Usbdev *ud;

	d = va_arg(f->args, Dev*);
	if(d == nil)
		return fmtprint(f, "<nildev>\n");
	fmtprint(f, "%s", d->dir);
	ud = d->usb;
	if(ud == nil)
		return fmtprint(f, " %ld refs\n", d->ref);
	fmtprint(f, " csp %s.%uld.%uld",
		classname(Class(ud->csp)), Subclass(ud->csp), Proto(ud->csp));
	fmtprint(f, " vid %#ux did %#ux", ud->vid, ud->did);
	fmtprint(f, " refs %ld\n", d->ref);
	fmtprint(f, "\t%s %s %s\n", ud->vendor, ud->product, ud->serial);
	for(i = 0; i < Nconf; i++){
		if(ud->conf[i] == nil)
			break;
		else
			fmtprintconf(f, ud, i);
	}
	return 0;
}

char*
estrdup(char *s)
{
	char *d;

	d = strdup(s);
	if(d == nil)
		sysfatal("strdup: %r");
	setmalloctag(d, getcallerpc(&s));
	return d;
}

void*
emallocz(ulong size, int zero)
{
	void *x;

	x = malloc(size);
	if(x == nil)
		sysfatal("malloc: %r");
	if(zero)
		memset(x, 0, size);
	setmalloctag(x, getcallerpc(&size));
	return x;
}