blob: 75f187b8d1093e77fccbf1b08e8afe5640288fc4 (
plain)
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
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
|
/*
* generic CDC
*/
#include <u.h>
#include <libc.h>
#include <thread.h>
#include "usb.h"
#include "dat.h"
#include <ip.h>
static int
cdcreceive(Dev *ep)
{
Block *b;
int n;
b = allocb(Maxpkt);
if((n = read(ep->dfd, b->wp, b->lim - b->base)) < 0){
freeb(b);
return -1;
}
b->wp += n;
etheriq(b);
return 0;
}
static void
cdctransmit(Dev *ep, Block *b)
{
int n;
n = BLEN(b);
if(write(ep->dfd, b->rp, n) < 0){
freeb(b);
return;
}
freeb(b);
/*
* this may not work with all CDC devices. the
* linux driver sends one more random byte
* instead of a zero byte transaction. maybe we
* should do the same?
*/
if((n % ep->maxpkt) == 0)
write(ep->dfd, "", 0);
}
int
cdcinit(Dev *d)
{
int i;
Usbdev *ud;
uchar *b;
Desc *dd;
char *mac;
ud = d->usb;
for(i = 0; i < nelem(ud->ddesc); i++)
if((dd = ud->ddesc[i]) != nil){
b = (uchar*)&dd->data;
if(b[1] == Dfunction && b[2] == Fnether){
mac = loaddevstr(d, b[3]);
if(mac != nil && strlen(mac) != 12){
free(mac);
mac = nil;
}
if(mac != nil){
parseether(macaddr, mac);
free(mac);
epreceive = cdcreceive;
eptransmit = cdctransmit;
return 0;
}
}
}
return -1;
}
|
