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
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
|
// SPDX-License-Identifier: GPL-2.0+
/*
* Copyright (c) 2011 The Chromium OS Authors.
*/
#include <dm.h>
#include <errno.h>
#include <log.h>
#include <malloc.h>
#include <net.h>
#include <usb.h>
#include <asm/cache.h>
#include <dm/device-internal.h>
#include "usb_ether.h"
#define USB_BULK_RECV_TIMEOUT 500
int usb_ether_register(struct udevice *dev, struct ueth_data *ueth, int rxsize)
{
struct usb_device *udev = dev_get_parent_priv(dev);
struct usb_interface_descriptor *iface_desc;
bool ep_in_found = false, ep_out_found = false;
struct usb_interface *iface;
const int ifnum = 0; /* Always use interface 0 */
int ret, i;
iface = &udev->config.if_desc[ifnum];
iface_desc = &udev->config.if_desc[ifnum].desc;
/* Initialize the ueth_data structure with some useful info */
ueth->ifnum = ifnum;
ueth->subclass = iface_desc->bInterfaceSubClass;
ueth->protocol = iface_desc->bInterfaceProtocol;
/*
* We are expecting a minimum of 3 endpoints - in, out (bulk), and int.
* We will ignore any others.
*/
for (i = 0; i < iface_desc->bNumEndpoints; i++) {
int ep_addr = iface->ep_desc[i].bEndpointAddress;
/* is it an BULK endpoint? */
if ((iface->ep_desc[i].bmAttributes &
USB_ENDPOINT_XFERTYPE_MASK) == USB_ENDPOINT_XFER_BULK) {
if (ep_addr & USB_DIR_IN && !ep_in_found) {
ueth->ep_in = ep_addr &
USB_ENDPOINT_NUMBER_MASK;
ep_in_found = true;
} else if (!(ep_addr & USB_DIR_IN) && !ep_out_found) {
ueth->ep_out = ep_addr &
USB_ENDPOINT_NUMBER_MASK;
ep_out_found = true;
}
}
/* is it an interrupt endpoint? */
if ((iface->ep_desc[i].bmAttributes &
USB_ENDPOINT_XFERTYPE_MASK) == USB_ENDPOINT_XFER_INT) {
ueth->ep_int = iface->ep_desc[i].bEndpointAddress &
USB_ENDPOINT_NUMBER_MASK;
ueth->irqinterval = iface->ep_desc[i].bInterval;
}
}
debug("Endpoints In %d Out %d Int %d\n", ueth->ep_in, ueth->ep_out,
ueth->ep_int);
/* Do some basic sanity checks, and bail if we find a problem */
if (!ueth->ep_in || !ueth->ep_out || !ueth->ep_int) {
debug("%s: %s: Cannot find endpoints\n", __func__, dev->name);
return -ENXIO;
}
ueth->rxsize = rxsize;
ueth->rxbuf = memalign(ARCH_DMA_MINALIGN, rxsize);
if (!ueth->rxbuf)
return -ENOMEM;
ret = usb_set_interface(udev, iface_desc->bInterfaceNumber, ifnum);
if (ret) {
debug("%s: %s: Cannot set interface: %d\n", __func__, dev->name,
ret);
return ret;
}
ueth->pusb_dev = udev;
return 0;
}
int usb_ether_deregister(struct ueth_data *ueth)
{
return 0;
}
int usb_ether_receive(struct ueth_data *ueth, int rxsize)
{
int actual_len;
int ret;
if (rxsize > ueth->rxsize)
return -EINVAL;
ret = usb_bulk_msg(ueth->pusb_dev,
usb_rcvbulkpipe(ueth->pusb_dev, ueth->ep_in),
ueth->rxbuf, rxsize, &actual_len,
USB_BULK_RECV_TIMEOUT);
debug("Rx: len = %u, actual = %u, err = %d\n", rxsize, actual_len, ret);
if (ret) {
printf("Rx: failed to receive: %d\n", ret);
return ret;
}
if (actual_len > rxsize) {
debug("Rx: received too many bytes %d\n", actual_len);
return -ENOSPC;
}
ueth->rxlen = actual_len;
ueth->rxptr = 0;
return actual_len ? 0 : -EAGAIN;
}
void usb_ether_advance_rxbuf(struct ueth_data *ueth, int num_bytes)
{
ueth->rxptr += num_bytes;
if (num_bytes < 0 || ueth->rxptr >= ueth->rxlen)
ueth->rxlen = 0;
}
int usb_ether_get_rx_bytes(struct ueth_data *ueth, uint8_t **ptrp)
{
if (!ueth->rxlen)
return 0;
*ptrp = &ueth->rxbuf[ueth->rxptr];
return ueth->rxlen - ueth->rxptr;
}
|
