1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
|
#
# Copyright © 2002 Vita Nuova Holdings Limited.
#
implement UsbDriver;
include "sys.m";
sys: Sys;
include "usb.m";
usb: Usb;
readerpid: int;
kill(pid: int): int
{
fd := sys->open("/prog/"+string pid+"/ctl", Sys->OWRITE);
if (fd == nil)
return -1;
if (sys->write(fd, array of byte "kill", 4) != 4)
return -1;
return 0;
}
reader(pidc: chan of int, fd: ref Sys->FD)
{
pid := sys->pctl(0, nil);
pidc <-= pid;
buf := array [4] of byte;
while ((n := sys->read(fd, buf, len buf)) >= 0)
sys->print("%d: %d\n", sys->millisec(), n);
readerpid = -1;
}
init(usbmod: Usb, setupfd, ctlfd: ref Sys->FD,
nil: ref Usb->Device,
conf: array of ref Usb->Configuration, path: string): int
{
usb = usbmod;
sys = load Sys Sys->PATH;
rv := usb->set_configuration(setupfd, conf[0].id);
if (rv < 0)
return rv;
ep := (hd conf[0].iface[0].altiface).ep[0];
sys->print("maxpkt %d interval %d\n", ep.maxpkt, ep.interval);
rv = sys->fprint(ctlfd, "ep 1 %d r %d 32", ep.maxpkt, ep.interval);
if (rv < 0)
return rv;
datafd := sys->open(path + "ep1data", Sys->OREAD);
if (datafd == nil)
return -1;
pidc := chan of int;
spawn reader(pidc, datafd);
readerpid = <- pidc;
return 0;
}
shutdown()
{
if (readerpid >= 0)
kill(readerpid);
}
|
