ref: 38c0cf0737de03906729054ad7b7b011dd1ca475
dir: /appl/lib/usb/usb.b/
# # Copyright © 2002 Vita Nuova Holdings Limited # implement Usb; include "sys.m"; sys: Sys; include "usb.m"; include "string.m"; str: String; Proto: adt { proto: int; name: string; }; SubClass: adt { subclass: int; name: string; proto: array of Proto; }; Class: adt { class: int; name: string; subclass: array of SubClass; }; classes := array [] of { Class(Usb->CL_AUDIO, "audio", array [] of { SubClass(1, "control", nil), SubClass(2, "stream", nil), SubClass(3, "midi", nil), } ), Class(Usb->CL_COMMS, "comms", array [] of { SubClass(1, "abstract", array [] of { Proto(1, "AT"), } ) } ), Class(Usb->CL_HID, "hid", array [] of { SubClass(1, "boot", array [] of { Proto(1, "kbd"), Proto(2, "mouse"), } ) } ), Class(Usb->CL_PRINTER, "printer", array [] of { SubClass(1, "printer", array [] of { Proto(1, "uni"), Proto(2, "bi"), } ) } ), Class(Usb->CL_HUB, "hub", array [] of { SubClass(1, "hub", nil), } ), Class(Usb->CL_DATA, "data", nil), Class(Usb->CL_MASS, "mass", array [] of { SubClass(1, "rbc", array [] of { Proto(0, "cbi-cc"), Proto(1, "cbi-nocc"), Proto(16r50, "bulkonly"), } ), SubClass(2, "sff-8020i/mmc-2", array [] of { Proto(0, "cbi-cc"), Proto(1, "cbi-nocc"), Proto(16r50, "bulkonly"), } ), SubClass(3, "qic-157", array [] of { Proto(0, "cbi-cc"), Proto(1, "cbi-nocc"), Proto(16r50, "bulkonly"), } ), SubClass(4, "ufi", array [] of { Proto(0, "cbi-cc"), Proto(1, "cbi-nocc"), Proto(16r50, "bulkonly"), } ), SubClass(5, "sff-8070i", array [] of { Proto(0, "cbi-cc"), Proto(1, "cbi-nocc"), Proto(16r50, "bulkonly"), } ), SubClass(6, "scsi", array [] of { Proto(0, "cbi-cc"), Proto(1, "cbi-nocc"), Proto(16r50, "bulkonly"), } ), } ), }; get2(b: array of byte): int { return int b[0] | (int b[1] << 8); } put2(buf: array of byte, v: int) { buf[0] = byte v; buf[1] = byte (v >> 8); } get4(b: array of byte): int { return int b[0] | (int b[1] << 8) | (int b[2] << 16) | (int b[3] << 24); } put4(buf: array of byte, v: int) { buf[0] = byte v; buf[1] = byte (v >> 8); buf[2] = byte (v >> 16); buf[3] = byte (v >> 24); } bigget2(b: array of byte): int { return int b[1] | (int b[0] << 8); } bigput2(buf: array of byte, v: int) { buf[1] = byte v; buf[0] = byte (v >> 8); } bigget4(b: array of byte): int { return int b[3] | (int b[2] << 8) | (int b[1] << 16) | (int b[0] << 24); } bigput4(buf: array of byte, v: int) { buf[3] = byte v; buf[2] = byte (v >> 8); buf[1] = byte (v >> 16); buf[0] = byte (v >> 24); } strtol(s: string, base: int): (int, string) { if (str == nil) str = load String String->PATH; if (base != 0) return str->toint(s, base); if (len s >= 2 && (s[0:2] == "0X" || s[0:2] == "0x")) return str->toint(s[2:], 16); if (len s > 0 && s[0:1] == "0") return str->toint(s[1:], 8); return str->toint(s, 10); } memset(buf: array of byte, v: int) { for (x := 0; x < len buf; x++) buf[x] = byte v; } setupreq(setupfd: ref Sys->FD, typ, req, value, index: int, outbuf: array of byte, count: int): int { additional: int; if (outbuf != nil) { additional = len outbuf; # if there is an outbuf, then the count sent must be length of the payload # this assumes that RH2D is set count = additional; } else additional = 0; buf := array[8 + additional] of byte; buf[0] = byte typ; buf[1] = byte req; put2(buf[2:], value); put2(buf[4:], index); put2(buf[6:], count); if (additional) buf[8:] = outbuf; rv := sys->write(setupfd, buf, len buf); if (rv < 0) return -1; if (rv != len buf) return -1; return rv; } setupreply(setupfd: ref Sys->FD, buf: array of byte): int { nb := sys->read(setupfd, buf, len buf); return nb; } setup(setupfd: ref Sys->FD, typ, req, value, index: int, outbuf: array of byte, inbuf: array of byte): int { count: int; if (inbuf != nil) count = len inbuf; else count = 0; if (setupreq(setupfd, typ, req, value, index, outbuf, count) < 0) return -1; if (count == 0) return 0; return setupreply(setupfd, inbuf); } get_descriptor(fd: ref Sys->FD, rtyp: int, dtyp: int, dindex: int, langid: int, buf: array of byte): int { nr := -1; if (setupreq(fd, RD2H | rtyp | Rdevice, GET_DESCRIPTOR, (dtyp << 8) | dindex, langid, nil, len buf) < 0 || (nr = setupreply(fd, buf)) < 1) return -1; return nr; } get_standard_descriptor(fd: ref Sys->FD, dtyp: int, index: int, buf: array of byte): int { return get_descriptor(fd, Rstandard, dtyp, index, 0, buf); } get_class_descriptor(fd: ref Sys->FD, dtyp: int, index: int, buf: array of byte): int { return get_descriptor(fd, Rclass, dtyp, index, 0, buf); } get_vendor_descriptor(fd: ref Sys->FD, dtyp: int, index: int, buf: array of byte): int { return get_descriptor(fd, Rvendor, dtyp, index, 0, buf); } get_status(fd: ref Sys->FD, port: int): int { buf := array [4] of byte; if (setupreq(fd, RD2H | Rclass | Rother, GET_STATUS, 0, port, nil, len buf) < 0 || setupreply(fd, buf) < len buf) return -1; return get2(buf); } set_address(fd: ref Sys->FD, address: int): int { return setupreq(fd, RH2D | Rstandard | Rdevice, SET_ADDRESS, address, 0, nil, 0); } set_configuration(fd: ref Sys->FD, n: int): int { return setupreq(fd, RH2D | Rstandard | Rdevice, SET_CONFIGURATION, n, 0, nil, 0); } setclear_feature(fd: ref Sys->FD, rtyp: int, value: int, index: int, on: int): int { req: int; if (on) req = SET_FEATURE; else req = CLEAR_FEATURE; return setupreq(fd, RH2D | rtyp, req, value, index, nil, 0); } parse_conf(b: array of byte): ref Configuration { if (len b < DCONFLEN) return nil; conf := ref Configuration; conf.id = int b[5]; conf.iface = array[int b[4]] of Interface; conf.attr = int b[7]; conf.powerma = int b[8] * 2; return conf; } parse_iface(conf: ref Configuration, b: array of byte): ref AltInterface { if (len b < DINTERLEN || conf == nil) return nil; id := int b[2]; if (id >= len conf.iface) return nil; ai := ref AltInterface; ai.id = int b[3]; if (int b[4] != 0) ai.ep = array [int b[4]] of ref Endpt; ai.class = int b[5]; ai.subclass = int b[6]; ai.proto = int b[7]; conf.iface[id].altiface = ai :: conf.iface[id].altiface; return ai; } parse_endpt(conf: ref Configuration, ai: ref AltInterface, b: array of byte): ref Endpt { if (len b < DENDPLEN || conf == nil || ai == nil || ai.ep == nil) return nil; for (i := 0; i < len ai.ep; i++) if (ai.ep[i] == nil) break; if (i >= len ai.ep) return nil; ep := ref Endpt; ai.ep[i] = ep; ep.addr = int b[2]; ep.attr = int b[3]; ep.d2h = ep.addr & 16r80; ep.etype = int b[3] & 3; ep.isotype = (int b[3] >> 2) & 3; ep.maxpkt = get2(b[4:]); ep.interval = int b[6]; return ep; } get_parsed_configuration_descriptor(fd: ref Sys->FD, n: int): ref Configuration { conf: ref Configuration; altiface: ref AltInterface; b := array [256] of byte; nr := get_standard_descriptor(fd, CONFIGURATION, n, b); if (nr < 0) return nil; conf = nil; altiface = nil; for (i := 0; nr - i > 2 && b[i] > byte 0 && int b[i] <= nr - i; i += int b[i]) { ni := i + int b[i]; case int b[i + 1] { Usb->CONFIGURATION => conf = parse_conf(b[i: ni]); if (conf == nil) return nil; Usb->INTERFACE => altiface = parse_iface(conf, b[i: ni]); if (altiface == nil) return nil; Usb->ENDPOINT => if (parse_endpt(conf, altiface, b[i: ni]) == nil) return nil; } } if (i < nr) sys->print("usb: residue at end of descriptors\n"); return conf; } get_parsed_device_descriptor(fd: ref Sys->FD): ref Device { b := array [256] of byte; nr := get_standard_descriptor(fd, DEVICE, 0, b); if (nr < DDEVLEN) { if (nr == 8 || nr == 16) { memset(b[nr: DDEVLEN - 1], 0); b[DDEVLEN - 1] = byte 1; nr = DDEVLEN; } else return nil; } dev := ref Device; dev.usbmajor = int b[3]; dev.usbminor = int b[2]; dev.class = int b[4]; dev.subclass = int b[5]; dev.proto = int b[6]; dev.maxpkt0 = int b[7]; dev.vid = get2(b[8:]); dev.did = get2(b[10:]); dev.relmajor = int b[13]; dev.relminor = int b[12]; dev.nconf = int b[17]; return dev; } dump_configuration(fd: ref Sys->FD, conf: ref Configuration) { sys->fprint(fd, "configuration %d attr 0x%.x powerma %d\n", conf.id, conf.attr, conf.powerma); for (i := 0; i < len conf.iface; i++) { sys->fprint(fd, "\tinterface %d\n", i); ail := conf.iface[i].altiface; while (ail != nil) { ai := hd ail; sys->fprint(fd, "\t\t%d class %d subclass %d proto %d [%s]\n", ai.id, ai.class, ai.subclass, ai.proto, sclass(ai.class, ai.subclass, ai.proto)); for (e := 0; e < len ai.ep; e++) { if (ai.ep[e] == nil) { sys->fprint(fd, "\t\t\t missing descriptor\n"); continue; } sys->fprint(fd, "\t\t\t0x%.2ux attr 0x%.x maxpkt %d interval %d\n", ai.ep[e].addr, ai.ep[e].attr, ai.ep[e].maxpkt, ai.ep[e].interval); } ail = tl ail; } } sys->fprint(fd, "done dumping\n"); } sclass(class, subclass, proto: int): string { for (c := 0; c < len classes; c++) if (classes[c].class == class) break; if (c >= len classes) return sys->sprint("%d.%d.%d", class, subclass, proto); if (classes[c].subclass == nil) return sys->sprint("%s.%d.%d", classes[c].name, subclass, proto); for (sc := 0; sc < len classes[c].subclass; sc++) if (classes[c].subclass[sc].subclass == subclass) break; if (sc >= len classes[c].subclass) return sys->sprint("%s.%d.%d", classes[c].name, subclass, proto); if (classes[c].subclass[sc].proto == nil) return sys->sprint("%s.%s.%d", classes[c].name, classes[c].subclass[sc].name, proto); for (p := 0; p < len classes[c].subclass[sc].proto; p++) if (classes[c].subclass[sc].proto[p].proto == proto) break; if (p >= len classes[c].subclass[sc].proto) return sys->sprint("%s.%s.%d", classes[c].name, classes[c].subclass[sc].name, proto); return sys->sprint("%s.%s.%s", classes[c].name, classes[c].subclass[sc].name, classes[c].subclass[sc].proto[p].name); } init() { sys = load Sys Sys->PATH; }