]> Git Repo - u-boot.git/blame - drivers/usb/gadget/ether.c
USB: Make non-bulk delay longer in OHCI
[u-boot.git] / drivers / usb / gadget / ether.c
CommitLineData
23cd1385
RB
1/*
2 * ether.c -- Ethernet gadget driver, with CDC and non-CDC options
3 *
4 * Copyright (C) 2003-2005,2008 David Brownell
5 * Copyright (C) 2003-2004 Robert Schwebel, Benedikt Spranger
6 * Copyright (C) 2008 Nokia Corporation
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 *
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
21 */
22
23#include <common.h>
24#include <asm/errno.h>
25#include <linux/usb/ch9.h>
26#include <linux/usb/cdc.h>
27#include <linux/usb/gadget.h>
28#include <net.h>
29#include <linux/ctype.h>
30
31#include "gadget_chips.h"
32
33#define USB_NET_NAME "usb0"
7de73185 34
23cd1385
RB
35#define atomic_read
36extern struct platform_data brd;
37#define spin_lock(x)
38#define spin_unlock(x)
39
40
41unsigned packet_received, packet_sent;
42
43#define DEV_CONFIG_CDC 1
44#define GFP_ATOMIC ((gfp_t) 0)
45#define GFP_KERNEL ((gfp_t) 0)
46
47/*
48 * Ethernet gadget driver -- with CDC and non-CDC options
49 * Builds on hardware support for a full duplex link.
50 *
51 * CDC Ethernet is the standard USB solution for sending Ethernet frames
52 * using USB. Real hardware tends to use the same framing protocol but look
53 * different for control features. This driver strongly prefers to use
54 * this USB-IF standard as its open-systems interoperability solution;
55 * most host side USB stacks (except from Microsoft) support it.
56 *
57 * This is sometimes called "CDC ECM" (Ethernet Control Model) to support
58 * TLA-soup. "CDC ACM" (Abstract Control Model) is for modems, and a new
59 * "CDC EEM" (Ethernet Emulation Model) is starting to spread.
60 *
61 * There's some hardware that can't talk CDC ECM. We make that hardware
62 * implement a "minimalist" vendor-agnostic CDC core: same framing, but
63 * link-level setup only requires activating the configuration. Only the
64 * endpoint descriptors, and product/vendor IDs, are relevant; no control
65 * operations are available. Linux supports it, but other host operating
66 * systems may not. (This is a subset of CDC Ethernet.)
67 *
68 * It turns out that if you add a few descriptors to that "CDC Subset",
69 * (Windows) host side drivers from MCCI can treat it as one submode of
70 * a proprietary scheme called "SAFE" ... without needing to know about
71 * specific product/vendor IDs. So we do that, making it easier to use
72 * those MS-Windows drivers. Those added descriptors make it resemble a
73 * CDC MDLM device, but they don't change device behavior at all. (See
74 * MCCI Engineering report 950198 "SAFE Networking Functions".)
75 *
76 * A third option is also in use. Rather than CDC Ethernet, or something
77 * simpler, Microsoft pushes their own approach: RNDIS. The published
78 * RNDIS specs are ambiguous and appear to be incomplete, and are also
79 * needlessly complex. They borrow more from CDC ACM than CDC ECM.
80 */
81#define ETH_ALEN 6 /* Octets in one ethernet addr */
82#define ETH_HLEN 14 /* Total octets in header. */
83#define ETH_ZLEN 60 /* Min. octets in frame sans FCS */
84#define ETH_DATA_LEN 1500 /* Max. octets in payload */
85#define ETH_FRAME_LEN PKTSIZE_ALIGN /* Max. octets in frame sans FCS */
86#define ETH_FCS_LEN 4 /* Octets in the FCS */
87
88#define DRIVER_DESC "Ethernet Gadget"
89/* Based on linux 2.6.27 version */
90#define DRIVER_VERSION "May Day 2005"
91
6142e0ae
VK
92static const char shortname[] = "ether";
93static const char driver_desc[] = DRIVER_DESC;
23cd1385
RB
94
95#define RX_EXTRA 20 /* guard against rx overflows */
96
97/* CDC support the same host-chosen outgoing packet filters. */
98#define DEFAULT_FILTER (USB_CDC_PACKET_TYPE_BROADCAST \
99 |USB_CDC_PACKET_TYPE_ALL_MULTICAST \
100 |USB_CDC_PACKET_TYPE_PROMISCUOUS \
101 |USB_CDC_PACKET_TYPE_DIRECTED)
102
103#define USB_CONNECT_TIMEOUT (3 * CONFIG_SYS_HZ)
104
105/*-------------------------------------------------------------------------*/
106static struct eth_dev l_ethdev;
107static struct eth_device l_netdev;
108static struct usb_gadget_driver eth_driver;
109
110/*-------------------------------------------------------------------------*/
111
112/* "main" config is either CDC, or its simple subset */
113static inline int is_cdc(struct eth_dev *dev)
114{
115#if !defined(DEV_CONFIG_SUBSET)
116 return 1; /* only cdc possible */
6142e0ae 117#elif !defined(DEV_CONFIG_CDC)
23cd1385
RB
118 return 0; /* only subset possible */
119#else
120 return dev->cdc; /* depends on what hardware we found */
121#endif
122}
123
124#define subset_active(dev) (!is_cdc(dev))
6142e0ae 125#define cdc_active(dev) (is_cdc(dev))
23cd1385
RB
126
127#define DEFAULT_QLEN 2 /* double buffering by default */
128
129/* peak bulk transfer bits-per-second */
130#define HS_BPS (13 * 512 * 8 * 1000 * 8)
131#define FS_BPS (19 * 64 * 1 * 1000 * 8)
132
133#ifdef CONFIG_USB_GADGET_DUALSPEED
134#define DEVSPEED USB_SPEED_HIGH
135
2721dbf1
VK
136#ifdef CONFIG_USB_ETH_QMULT
137#define qmult CONFIG_USB_ETH_QMULT
138#else
139#define qmult 5
140#endif
141
23cd1385
RB
142/* for dual-speed hardware, use deeper queues at highspeed */
143#define qlen(gadget) \
144 (DEFAULT_QLEN*((gadget->speed == USB_SPEED_HIGH) ? qmult : 1))
145
146static inline int BITRATE(struct usb_gadget *g)
147{
148 return (g->speed == USB_SPEED_HIGH) ? HS_BPS : FS_BPS;
149}
150
151#else /* full speed (low speed doesn't do bulk) */
152
153#define qmult 1
154
155#define DEVSPEED USB_SPEED_FULL
156
157#define qlen(gadget) DEFAULT_QLEN
158
159static inline int BITRATE(struct usb_gadget *g)
160{
161 return FS_BPS;
162}
163#endif
164
165struct eth_dev {
166 struct usb_gadget *gadget;
167 struct usb_request *req; /* for control responses */
168 struct usb_request *stat_req; /* for cdc status */
169
170 u8 config;
171 struct usb_ep *in_ep, *out_ep, *status_ep;
172 const struct usb_endpoint_descriptor
173 *in, *out, *status;
174
175 struct usb_request *tx_req, *rx_req;
176
177 struct eth_device *net;
178 unsigned int tx_qlen;
179
180 unsigned zlp:1;
181 unsigned cdc:1;
182 unsigned suspended:1;
6142e0ae 183 unsigned network_started:1;
23cd1385
RB
184 u16 cdc_filter;
185 unsigned long todo;
6142e0ae 186 int mtu;
23cd1385 187#define WORK_RX_MEMORY 0
6142e0ae 188 u8 host_mac[ETH_ALEN];
23cd1385
RB
189};
190
6142e0ae
VK
191/*
192 * This version autoconfigures as much as possible at run-time.
23cd1385
RB
193 *
194 * It also ASSUMES a self-powered device, without remote wakeup,
195 * although remote wakeup support would make sense.
196 */
197
198/*-------------------------------------------------------------------------*/
199
6142e0ae
VK
200/*
201 * DO NOT REUSE THESE IDs with a protocol-incompatible driver!! Ever!!
23cd1385
RB
202 * Instead: allocate your own, using normal USB-IF procedures.
203 */
204
6142e0ae
VK
205/*
206 * Thanks to NetChip Technologies for donating this product ID.
23cd1385
RB
207 * It's for devices with only CDC Ethernet configurations.
208 */
209#define CDC_VENDOR_NUM 0x0525 /* NetChip */
210#define CDC_PRODUCT_NUM 0xa4a1 /* Linux-USB Ethernet Gadget */
211
6142e0ae
VK
212/*
213 * For hardware that can't talk CDC, we use the same vendor ID that
23cd1385
RB
214 * ARM Linux has used for ethernet-over-usb, both with sa1100 and
215 * with pxa250. We're protocol-compatible, if the host-side drivers
216 * use the endpoint descriptors. bcdDevice (version) is nonzero, so
217 * drivers that need to hard-wire endpoint numbers have a hook.
218 *
219 * The protocol is a minimal subset of CDC Ether, which works on any bulk
220 * hardware that's not deeply broken ... even on hardware that can't talk
221 * RNDIS (like SA-1100, with no interrupt endpoint, or anything that
222 * doesn't handle control-OUT).
223 */
224#define SIMPLE_VENDOR_NUM 0x049f
225#define SIMPLE_PRODUCT_NUM 0x505a
226
6142e0ae
VK
227/*
228 * Some systems will want different product identifers published in the
23cd1385
RB
229 * device descriptor, either numbers or strings or both. These string
230 * parameters are in UTF-8 (superset of ASCII's 7 bit characters).
231 */
232
233static ushort bcdDevice;
234#if defined(CONFIG_USBNET_MANUFACTURER)
235static char *iManufacturer = CONFIG_USBNET_MANUFACTURER;
236#else
237static char *iManufacturer = "U-boot";
238#endif
239static char *iProduct;
240static char *iSerialNumber;
241static char dev_addr[18];
242static char host_addr[18];
243
244/*-------------------------------------------------------------------------*/
245
6142e0ae
VK
246/*
247 * USB DRIVER HOOKUP (to the hardware driver, below us), mostly
23cd1385
RB
248 * ep0 implementation: descriptors, config management, setup().
249 * also optional class-specific notification interrupt transfer.
250 */
251
252/*
253 * DESCRIPTORS ... most are static, but strings and (full) configuration
254 * descriptors are built on demand. For now we do either full CDC, or
255 * our simple subset.
256 */
257
258#define STRING_MANUFACTURER 1
259#define STRING_PRODUCT 2
260#define STRING_ETHADDR 3
261#define STRING_DATA 4
262#define STRING_CONTROL 5
263#define STRING_CDC 7
264#define STRING_SUBSET 8
265#define STRING_SERIALNUMBER 10
266
267/* holds our biggest descriptor */
268#define USB_BUFSIZ 256
269
270/*
271 * This device advertises one configuration, eth_config,
272 * on hardware supporting at least two configs.
273 *
274 * FIXME define some higher-powered configurations to make it easier
275 * to recharge batteries ...
276 */
277
278#define DEV_CONFIG_VALUE 1 /* cdc or subset */
279
280static struct usb_device_descriptor
281device_desc = {
282 .bLength = sizeof device_desc,
283 .bDescriptorType = USB_DT_DEVICE,
284
6142e0ae 285 .bcdUSB = __constant_cpu_to_le16(0x0200),
23cd1385
RB
286
287 .bDeviceClass = USB_CLASS_COMM,
288 .bDeviceSubClass = 0,
289 .bDeviceProtocol = 0,
290
6142e0ae
VK
291 .idVendor = __constant_cpu_to_le16(CDC_VENDOR_NUM),
292 .idProduct = __constant_cpu_to_le16(CDC_PRODUCT_NUM),
23cd1385
RB
293 .iManufacturer = STRING_MANUFACTURER,
294 .iProduct = STRING_PRODUCT,
295 .bNumConfigurations = 1,
296};
297
298static struct usb_otg_descriptor
299otg_descriptor = {
300 .bLength = sizeof otg_descriptor,
301 .bDescriptorType = USB_DT_OTG,
302
303 .bmAttributes = USB_OTG_SRP,
304};
305
306static struct usb_config_descriptor
307eth_config = {
308 .bLength = sizeof eth_config,
309 .bDescriptorType = USB_DT_CONFIG,
310
311 /* compute wTotalLength on the fly */
312 .bNumInterfaces = 2,
313 .bConfigurationValue = DEV_CONFIG_VALUE,
314 .iConfiguration = STRING_CDC,
315 .bmAttributes = USB_CONFIG_ATT_ONE | USB_CONFIG_ATT_SELFPOWER,
316 .bMaxPower = 1,
317};
318
319/*
320 * Compared to the simple CDC subset, the full CDC Ethernet model adds
321 * three class descriptors, two interface descriptors, optional status
322 * endpoint. Both have a "data" interface and two bulk endpoints.
323 * There are also differences in how control requests are handled.
324 */
325
326#ifdef DEV_CONFIG_CDC
327static struct usb_interface_descriptor
328control_intf = {
329 .bLength = sizeof control_intf,
330 .bDescriptorType = USB_DT_INTERFACE,
331
332 .bInterfaceNumber = 0,
333 /* status endpoint is optional; this may be patched later */
334 .bNumEndpoints = 1,
335 .bInterfaceClass = USB_CLASS_COMM,
336 .bInterfaceSubClass = USB_CDC_SUBCLASS_ETHERNET,
337 .bInterfaceProtocol = USB_CDC_PROTO_NONE,
338 .iInterface = STRING_CONTROL,
339};
340#endif
341
342static const struct usb_cdc_header_desc header_desc = {
343 .bLength = sizeof header_desc,
344 .bDescriptorType = USB_DT_CS_INTERFACE,
345 .bDescriptorSubType = USB_CDC_HEADER_TYPE,
346
6142e0ae 347 .bcdCDC = __constant_cpu_to_le16(0x0110),
23cd1385
RB
348};
349
350#if defined(DEV_CONFIG_CDC)
351
352static const struct usb_cdc_union_desc union_desc = {
353 .bLength = sizeof union_desc,
354 .bDescriptorType = USB_DT_CS_INTERFACE,
355 .bDescriptorSubType = USB_CDC_UNION_TYPE,
356
357 .bMasterInterface0 = 0, /* index of control interface */
358 .bSlaveInterface0 = 1, /* index of DATA interface */
359};
360
361#endif /* CDC */
362
363#ifndef DEV_CONFIG_CDC
364
6142e0ae
VK
365/*
366 * "SAFE" loosely follows CDC WMC MDLM, violating the spec in various
23cd1385
RB
367 * ways: data endpoints live in the control interface, there's no data
368 * interface, and it's not used to talk to a cell phone radio.
369 */
370
371static const struct usb_cdc_mdlm_desc mdlm_desc = {
372 .bLength = sizeof mdlm_desc,
373 .bDescriptorType = USB_DT_CS_INTERFACE,
374 .bDescriptorSubType = USB_CDC_MDLM_TYPE,
375
376 .bcdVersion = __constant_cpu_to_le16(0x0100),
377 .bGUID = {
378 0x5d, 0x34, 0xcf, 0x66, 0x11, 0x18, 0x11, 0xd6,
379 0xa2, 0x1a, 0x00, 0x01, 0x02, 0xca, 0x9a, 0x7f,
380 },
381};
382
6142e0ae
VK
383/*
384 * since "usb_cdc_mdlm_detail_desc" is a variable length structure, we
23cd1385
RB
385 * can't really use its struct. All we do here is say that we're using
386 * the submode of "SAFE" which directly matches the CDC Subset.
387 */
388static const u8 mdlm_detail_desc[] = {
389 6,
390 USB_DT_CS_INTERFACE,
391 USB_CDC_MDLM_DETAIL_TYPE,
392
393 0, /* "SAFE" */
394 0, /* network control capabilities (none) */
395 0, /* network data capabilities ("raw" encapsulation) */
396};
397
398#endif
399
23cd1385 400static const struct usb_cdc_ether_desc ether_desc = {
6142e0ae 401 .bLength = sizeof(ether_desc),
23cd1385
RB
402 .bDescriptorType = USB_DT_CS_INTERFACE,
403 .bDescriptorSubType = USB_CDC_ETHERNET_TYPE,
404
405 /* this descriptor actually adds value, surprise! */
406 .iMACAddress = STRING_ETHADDR,
6142e0ae
VK
407 .bmEthernetStatistics = __constant_cpu_to_le32(0), /* no statistics */
408 .wMaxSegmentSize = __constant_cpu_to_le16(ETH_FRAME_LEN),
409 .wNumberMCFilters = __constant_cpu_to_le16(0),
23cd1385
RB
410 .bNumberPowerFilters = 0,
411};
412
23cd1385
RB
413#if defined(DEV_CONFIG_CDC)
414
6142e0ae
VK
415/*
416 * include the status endpoint if we can, even where it's optional.
23cd1385
RB
417 * use wMaxPacketSize big enough to fit CDC_NOTIFY_SPEED_CHANGE in one
418 * packet, to simplify cancellation; and a big transfer interval, to
419 * waste less bandwidth.
420 *
421 * some drivers (like Linux 2.4 cdc-ether!) "need" it to exist even
422 * if they ignore the connect/disconnect notifications that real aether
423 * can provide. more advanced cdc configurations might want to support
424 * encapsulated commands (vendor-specific, using control-OUT).
425 */
426
427#define LOG2_STATUS_INTERVAL_MSEC 5 /* 1 << 5 == 32 msec */
428#define STATUS_BYTECOUNT 16 /* 8 byte header + data */
429
430static struct usb_endpoint_descriptor
431fs_status_desc = {
432 .bLength = USB_DT_ENDPOINT_SIZE,
433 .bDescriptorType = USB_DT_ENDPOINT,
434
435 .bEndpointAddress = USB_DIR_IN,
436 .bmAttributes = USB_ENDPOINT_XFER_INT,
6142e0ae 437 .wMaxPacketSize = __constant_cpu_to_le16(STATUS_BYTECOUNT),
23cd1385
RB
438 .bInterval = 1 << LOG2_STATUS_INTERVAL_MSEC,
439};
440#endif
441
442#ifdef DEV_CONFIG_CDC
443
444/* the default data interface has no endpoints ... */
445
446static const struct usb_interface_descriptor
447data_nop_intf = {
448 .bLength = sizeof data_nop_intf,
449 .bDescriptorType = USB_DT_INTERFACE,
450
451 .bInterfaceNumber = 1,
452 .bAlternateSetting = 0,
453 .bNumEndpoints = 0,
454 .bInterfaceClass = USB_CLASS_CDC_DATA,
455 .bInterfaceSubClass = 0,
456 .bInterfaceProtocol = 0,
457};
458
459/* ... but the "real" data interface has two bulk endpoints */
460
461static const struct usb_interface_descriptor
462data_intf = {
463 .bLength = sizeof data_intf,
464 .bDescriptorType = USB_DT_INTERFACE,
465
466 .bInterfaceNumber = 1,
467 .bAlternateSetting = 1,
468 .bNumEndpoints = 2,
469 .bInterfaceClass = USB_CLASS_CDC_DATA,
470 .bInterfaceSubClass = 0,
471 .bInterfaceProtocol = 0,
472 .iInterface = STRING_DATA,
473};
474
475#endif
476
477#ifdef DEV_CONFIG_SUBSET
478
479/*
480 * "Simple" CDC-subset option is a simple vendor-neutral model that most
481 * full speed controllers can handle: one interface, two bulk endpoints.
482 *
483 * To assist host side drivers, we fancy it up a bit, and add descriptors
484 * so some host side drivers will understand it as a "SAFE" variant.
485 */
486
487static const struct usb_interface_descriptor
488subset_data_intf = {
489 .bLength = sizeof subset_data_intf,
490 .bDescriptorType = USB_DT_INTERFACE,
491
492 .bInterfaceNumber = 0,
493 .bAlternateSetting = 0,
494 .bNumEndpoints = 2,
495 .bInterfaceClass = USB_CLASS_COMM,
496 .bInterfaceSubClass = USB_CDC_SUBCLASS_MDLM,
497 .bInterfaceProtocol = 0,
498 .iInterface = STRING_DATA,
499};
500
501#endif /* SUBSET */
502
23cd1385
RB
503static struct usb_endpoint_descriptor
504fs_source_desc = {
505 .bLength = USB_DT_ENDPOINT_SIZE,
506 .bDescriptorType = USB_DT_ENDPOINT,
507
508 .bEndpointAddress = USB_DIR_IN,
509 .bmAttributes = USB_ENDPOINT_XFER_BULK,
510};
511
512static struct usb_endpoint_descriptor
513fs_sink_desc = {
514 .bLength = USB_DT_ENDPOINT_SIZE,
515 .bDescriptorType = USB_DT_ENDPOINT,
516
517 .bEndpointAddress = USB_DIR_OUT,
518 .bmAttributes = USB_ENDPOINT_XFER_BULK,
519};
520
6142e0ae 521static const struct usb_descriptor_header *fs_eth_function[11] = {
23cd1385
RB
522 (struct usb_descriptor_header *) &otg_descriptor,
523#ifdef DEV_CONFIG_CDC
524 /* "cdc" mode descriptors */
525 (struct usb_descriptor_header *) &control_intf,
526 (struct usb_descriptor_header *) &header_desc,
527 (struct usb_descriptor_header *) &union_desc,
528 (struct usb_descriptor_header *) &ether_desc,
529 /* NOTE: status endpoint may need to be removed */
530 (struct usb_descriptor_header *) &fs_status_desc,
531 /* data interface, with altsetting */
532 (struct usb_descriptor_header *) &data_nop_intf,
533 (struct usb_descriptor_header *) &data_intf,
534 (struct usb_descriptor_header *) &fs_source_desc,
535 (struct usb_descriptor_header *) &fs_sink_desc,
536 NULL,
537#endif /* DEV_CONFIG_CDC */
538};
539
540static inline void fs_subset_descriptors(void)
541{
542#ifdef DEV_CONFIG_SUBSET
543 /* behavior is "CDC Subset"; extra descriptors say "SAFE" */
544 fs_eth_function[1] = (struct usb_descriptor_header *) &subset_data_intf;
545 fs_eth_function[2] = (struct usb_descriptor_header *) &header_desc;
546 fs_eth_function[3] = (struct usb_descriptor_header *) &mdlm_desc;
547 fs_eth_function[4] = (struct usb_descriptor_header *) &mdlm_detail_desc;
548 fs_eth_function[5] = (struct usb_descriptor_header *) &ether_desc;
549 fs_eth_function[6] = (struct usb_descriptor_header *) &fs_source_desc;
550 fs_eth_function[7] = (struct usb_descriptor_header *) &fs_sink_desc;
551 fs_eth_function[8] = NULL;
552#else
553 fs_eth_function[1] = NULL;
554#endif
555}
556
557/*
558 * usb 2.0 devices need to expose both high speed and full speed
559 * descriptors, unless they only run at full speed.
560 */
561
562#if defined(DEV_CONFIG_CDC)
563static struct usb_endpoint_descriptor
564hs_status_desc = {
565 .bLength = USB_DT_ENDPOINT_SIZE,
566 .bDescriptorType = USB_DT_ENDPOINT,
567
568 .bmAttributes = USB_ENDPOINT_XFER_INT,
6142e0ae 569 .wMaxPacketSize = __constant_cpu_to_le16(STATUS_BYTECOUNT),
23cd1385
RB
570 .bInterval = LOG2_STATUS_INTERVAL_MSEC + 4,
571};
572#endif /* DEV_CONFIG_CDC */
573
574static struct usb_endpoint_descriptor
575hs_source_desc = {
576 .bLength = USB_DT_ENDPOINT_SIZE,
577 .bDescriptorType = USB_DT_ENDPOINT,
578
579 .bmAttributes = USB_ENDPOINT_XFER_BULK,
6142e0ae 580 .wMaxPacketSize = __constant_cpu_to_le16(512),
23cd1385
RB
581};
582
583static struct usb_endpoint_descriptor
584hs_sink_desc = {
585 .bLength = USB_DT_ENDPOINT_SIZE,
586 .bDescriptorType = USB_DT_ENDPOINT,
587
588 .bmAttributes = USB_ENDPOINT_XFER_BULK,
6142e0ae 589 .wMaxPacketSize = __constant_cpu_to_le16(512),
23cd1385
RB
590};
591
592static struct usb_qualifier_descriptor
593dev_qualifier = {
594 .bLength = sizeof dev_qualifier,
595 .bDescriptorType = USB_DT_DEVICE_QUALIFIER,
596
6142e0ae 597 .bcdUSB = __constant_cpu_to_le16(0x0200),
23cd1385
RB
598 .bDeviceClass = USB_CLASS_COMM,
599
600 .bNumConfigurations = 1,
601};
602
6142e0ae 603static const struct usb_descriptor_header *hs_eth_function[11] = {
23cd1385
RB
604 (struct usb_descriptor_header *) &otg_descriptor,
605#ifdef DEV_CONFIG_CDC
606 /* "cdc" mode descriptors */
607 (struct usb_descriptor_header *) &control_intf,
608 (struct usb_descriptor_header *) &header_desc,
609 (struct usb_descriptor_header *) &union_desc,
610 (struct usb_descriptor_header *) &ether_desc,
611 /* NOTE: status endpoint may need to be removed */
612 (struct usb_descriptor_header *) &hs_status_desc,
613 /* data interface, with altsetting */
614 (struct usb_descriptor_header *) &data_nop_intf,
615 (struct usb_descriptor_header *) &data_intf,
616 (struct usb_descriptor_header *) &hs_source_desc,
617 (struct usb_descriptor_header *) &hs_sink_desc,
618 NULL,
619#endif /* DEV_CONFIG_CDC */
620};
621
622static inline void hs_subset_descriptors(void)
623{
624#ifdef DEV_CONFIG_SUBSET
625 /* behavior is "CDC Subset"; extra descriptors say "SAFE" */
626 hs_eth_function[1] = (struct usb_descriptor_header *) &subset_data_intf;
627 hs_eth_function[2] = (struct usb_descriptor_header *) &header_desc;
628 hs_eth_function[3] = (struct usb_descriptor_header *) &mdlm_desc;
629 hs_eth_function[4] = (struct usb_descriptor_header *) &mdlm_detail_desc;
630 hs_eth_function[5] = (struct usb_descriptor_header *) &ether_desc;
631 hs_eth_function[6] = (struct usb_descriptor_header *) &hs_source_desc;
632 hs_eth_function[7] = (struct usb_descriptor_header *) &hs_sink_desc;
633 hs_eth_function[8] = NULL;
634#else
635 hs_eth_function[1] = NULL;
636#endif
637}
638
639/* maxpacket and other transfer characteristics vary by speed. */
640static inline struct usb_endpoint_descriptor *
641ep_desc(struct usb_gadget *g, struct usb_endpoint_descriptor *hs,
642 struct usb_endpoint_descriptor *fs)
643{
644 if (gadget_is_dualspeed(g) && g->speed == USB_SPEED_HIGH)
645 return hs;
646 return fs;
647}
648
23cd1385
RB
649/*-------------------------------------------------------------------------*/
650
651/* descriptors that are built on-demand */
652
6142e0ae
VK
653static char manufacturer[50];
654static char product_desc[40] = DRIVER_DESC;
655static char serial_number[20];
23cd1385
RB
656
657/* address that the host will use ... usually assigned at random */
6142e0ae 658static char ethaddr[2 * ETH_ALEN + 1];
23cd1385
RB
659
660/* static strings, in UTF-8 */
6142e0ae 661static struct usb_string strings[] = {
23cd1385
RB
662 { STRING_MANUFACTURER, manufacturer, },
663 { STRING_PRODUCT, product_desc, },
664 { STRING_SERIALNUMBER, serial_number, },
665 { STRING_DATA, "Ethernet Data", },
666 { STRING_ETHADDR, ethaddr, },
667#ifdef DEV_CONFIG_CDC
668 { STRING_CDC, "CDC Ethernet", },
669 { STRING_CONTROL, "CDC Communications Control", },
670#endif
671#ifdef DEV_CONFIG_SUBSET
672 { STRING_SUBSET, "CDC Ethernet Subset", },
673#endif
674 { } /* end of list */
675};
676
677static struct usb_gadget_strings stringtab = {
678 .language = 0x0409, /* en-us */
679 .strings = strings,
680};
681
23cd1385
RB
682/*============================================================================*/
683static u8 control_req[USB_BUFSIZ];
80460772 684static u8 status_req[STATUS_BYTECOUNT] __attribute__ ((aligned(4)));
23cd1385
RB
685
686
23cd1385
RB
687/**
688 * strlcpy - Copy a %NUL terminated string into a sized buffer
689 * @dest: Where to copy the string to
690 * @src: Where to copy the string from
691 * @size: size of destination buffer
692 *
693 * Compatible with *BSD: the result is always a valid
694 * NUL-terminated string that fits in the buffer (unless,
695 * of course, the buffer size is zero). It does not pad
696 * out the result like strncpy() does.
697 */
698size_t strlcpy(char *dest, const char *src, size_t size)
699{
700 size_t ret = strlen(src);
701
702 if (size) {
703 size_t len = (ret >= size) ? size - 1 : ret;
704 memcpy(dest, src, len);
705 dest[len] = '\0';
706 }
707 return ret;
708}
709
23cd1385
RB
710/*============================================================================*/
711
712/*
713 * one config, two interfaces: control, data.
714 * complications: class descriptors, and an altsetting.
715 */
716static int
717config_buf(struct usb_gadget *g, u8 *buf, u8 type, unsigned index, int is_otg)
718{
719 int len;
720 const struct usb_config_descriptor *config;
721 const struct usb_descriptor_header **function;
722 int hs = 0;
723
724 if (gadget_is_dualspeed(g)) {
725 hs = (g->speed == USB_SPEED_HIGH);
726 if (type == USB_DT_OTHER_SPEED_CONFIG)
727 hs = !hs;
728 }
729#define which_fn(t) (hs ? hs_ ## t ## _function : fs_ ## t ## _function)
730
731 if (index >= device_desc.bNumConfigurations)
732 return -EINVAL;
733
734 config = &eth_config;
6142e0ae 735 function = which_fn(eth);
23cd1385
RB
736
737 /* for now, don't advertise srp-only devices */
738 if (!is_otg)
739 function++;
740
6142e0ae 741 len = usb_gadget_config_buf(config, buf, USB_BUFSIZ, function);
23cd1385
RB
742 if (len < 0)
743 return len;
744 ((struct usb_config_descriptor *) buf)->bDescriptorType = type;
745 return len;
746}
747
748/*-------------------------------------------------------------------------*/
749
6142e0ae 750static int alloc_requests(struct eth_dev *dev, unsigned n, gfp_t gfp_flags);
23cd1385
RB
751
752static int
6142e0ae 753set_ether_config(struct eth_dev *dev, gfp_t gfp_flags)
23cd1385
RB
754{
755 int result = 0;
756 struct usb_gadget *gadget = dev->gadget;
757
758#if defined(DEV_CONFIG_CDC)
759 /* status endpoint used for (optionally) CDC */
760 if (!subset_active(dev) && dev->status_ep) {
6142e0ae 761 dev->status = ep_desc(gadget, &hs_status_desc,
23cd1385
RB
762 &fs_status_desc);
763 dev->status_ep->driver_data = dev;
764
6142e0ae 765 result = usb_ep_enable(dev->status_ep, dev->status);
23cd1385 766 if (result != 0) {
7de73185 767 debug("enable %s --> %d\n",
23cd1385
RB
768 dev->status_ep->name, result);
769 goto done;
770 }
771 }
772#endif
773
774 dev->in = ep_desc(gadget, &hs_source_desc, &fs_source_desc);
775 dev->in_ep->driver_data = dev;
776
777 dev->out = ep_desc(gadget, &hs_sink_desc, &fs_sink_desc);
778 dev->out_ep->driver_data = dev;
779
6142e0ae
VK
780 /*
781 * With CDC, the host isn't allowed to use these two data
23cd1385
RB
782 * endpoints in the default altsetting for the interface.
783 * so we don't activate them yet. Reset from SET_INTERFACE.
784 */
785 if (!cdc_active(dev)) {
6142e0ae 786 result = usb_ep_enable(dev->in_ep, dev->in);
23cd1385 787 if (result != 0) {
7de73185 788 debug("enable %s --> %d\n",
23cd1385
RB
789 dev->in_ep->name, result);
790 goto done;
791 }
792
6142e0ae 793 result = usb_ep_enable(dev->out_ep, dev->out);
23cd1385 794 if (result != 0) {
7de73185 795 debug("enable %s --> %d\n",
23cd1385
RB
796 dev->out_ep->name, result);
797 goto done;
798 }
799 }
800
801done:
802 if (result == 0)
6142e0ae 803 result = alloc_requests(dev, qlen(gadget), gfp_flags);
23cd1385
RB
804
805 /* on error, disable any endpoints */
806 if (result < 0) {
d5292c16 807 if (!subset_active(dev) && dev->status_ep)
6142e0ae 808 (void) usb_ep_disable(dev->status_ep);
23cd1385 809 dev->status = NULL;
6142e0ae
VK
810 (void) usb_ep_disable(dev->in_ep);
811 (void) usb_ep_disable(dev->out_ep);
23cd1385
RB
812 dev->in = NULL;
813 dev->out = NULL;
814 }
815
816 /* caller is responsible for cleanup on error */
817 return result;
818}
819
6142e0ae 820static void eth_reset_config(struct eth_dev *dev)
23cd1385
RB
821{
822 if (dev->config == 0)
823 return;
824
7de73185
VK
825 debug("%s\n", __func__);
826
6142e0ae
VK
827 /*
828 * disable endpoints, forcing (synchronous) completion of
23cd1385
RB
829 * pending i/o. then free the requests.
830 */
831
832 if (dev->in) {
6142e0ae 833 usb_ep_disable(dev->in_ep);
23cd1385 834 if (dev->tx_req) {
6142e0ae
VK
835 usb_ep_free_request(dev->in_ep, dev->tx_req);
836 dev->tx_req = NULL;
23cd1385
RB
837 }
838 }
839 if (dev->out) {
6142e0ae 840 usb_ep_disable(dev->out_ep);
23cd1385 841 if (dev->rx_req) {
6142e0ae
VK
842 usb_ep_free_request(dev->out_ep, dev->rx_req);
843 dev->rx_req = NULL;
23cd1385
RB
844 }
845 }
6142e0ae
VK
846 if (dev->status)
847 usb_ep_disable(dev->status_ep);
848
23cd1385
RB
849 dev->cdc_filter = 0;
850 dev->config = 0;
851}
852
6142e0ae
VK
853/*
854 * change our operational config. must agree with the code
23cd1385
RB
855 * that returns config descriptors, and altsetting code.
856 */
6142e0ae
VK
857static int eth_set_config(struct eth_dev *dev, unsigned number,
858 gfp_t gfp_flags)
23cd1385
RB
859{
860 int result = 0;
861 struct usb_gadget *gadget = dev->gadget;
862
6142e0ae 863 if (gadget_is_sa1100(gadget)
23cd1385
RB
864 && dev->config
865 && dev->tx_qlen != 0) {
866 /* tx fifo is full, but we can't clear it...*/
7de73185 867 error("can't change configurations");
23cd1385
RB
868 return -ESPIPE;
869 }
6142e0ae 870 eth_reset_config(dev);
23cd1385
RB
871
872 switch (number) {
873 case DEV_CONFIG_VALUE:
6142e0ae 874 result = set_ether_config(dev, gfp_flags);
23cd1385
RB
875 break;
876 default:
877 result = -EINVAL;
878 /* FALL THROUGH */
879 case 0:
880 break;
881 }
882
883 if (result) {
884 if (number)
6142e0ae 885 eth_reset_config(dev);
23cd1385
RB
886 usb_gadget_vbus_draw(dev->gadget,
887 gadget_is_otg(dev->gadget) ? 8 : 100);
888 } else {
889 char *speed;
890 unsigned power;
891
892 power = 2 * eth_config.bMaxPower;
893 usb_gadget_vbus_draw(dev->gadget, power);
894
895 switch (gadget->speed) {
6142e0ae
VK
896 case USB_SPEED_FULL:
897 speed = "full"; break;
23cd1385 898#ifdef CONFIG_USB_GADGET_DUALSPEED
6142e0ae
VK
899 case USB_SPEED_HIGH:
900 speed = "high"; break;
23cd1385 901#endif
6142e0ae
VK
902 default:
903 speed = "?"; break;
23cd1385
RB
904 }
905
906 dev->config = number;
7de73185 907 printf("%s speed config #%d: %d mA, %s, using %s\n",
23cd1385 908 speed, number, power, driver_desc,
6142e0ae 909 (cdc_active(dev) ? "CDC Ethernet"
23cd1385
RB
910 : "CDC Ethernet Subset"));
911 }
912 return result;
913}
914
915/*-------------------------------------------------------------------------*/
916
917#ifdef DEV_CONFIG_CDC
918
6142e0ae
VK
919/*
920 * The interrupt endpoint is used in CDC networking models (Ethernet, ATM)
23cd1385
RB
921 * only to notify the host about link status changes (which we support) or
922 * report completion of some encapsulated command. Since
923 * we want this CDC Ethernet code to be vendor-neutral, we don't use that
924 * command mechanism; and only one status request is ever queued.
925 */
6142e0ae 926static void eth_status_complete(struct usb_ep *ep, struct usb_request *req)
23cd1385
RB
927{
928 struct usb_cdc_notification *event = req->buf;
929 int value = req->status;
930 struct eth_dev *dev = ep->driver_data;
931
932 /* issue the second notification if host reads the first */
933 if (event->bNotificationType == USB_CDC_NOTIFY_NETWORK_CONNECTION
934 && value == 0) {
935 __le32 *data = req->buf + sizeof *event;
936
937 event->bmRequestType = 0xA1;
938 event->bNotificationType = USB_CDC_NOTIFY_SPEED_CHANGE;
6142e0ae
VK
939 event->wValue = __constant_cpu_to_le16(0);
940 event->wIndex = __constant_cpu_to_le16(1);
941 event->wLength = __constant_cpu_to_le16(8);
23cd1385
RB
942
943 /* SPEED_CHANGE data is up/down speeds in bits/sec */
6142e0ae 944 data[0] = data[1] = cpu_to_le32(BITRATE(dev->gadget));
23cd1385
RB
945
946 req->length = STATUS_BYTECOUNT;
6142e0ae 947 value = usb_ep_queue(ep, req, GFP_ATOMIC);
7de73185 948 debug("send SPEED_CHANGE --> %d\n", value);
23cd1385
RB
949 if (value == 0)
950 return;
951 } else if (value != -ECONNRESET) {
7de73185 952 debug("event %02x --> %d\n",
23cd1385 953 event->bNotificationType, value);
6142e0ae
VK
954 if (event->bNotificationType ==
955 USB_CDC_NOTIFY_SPEED_CHANGE) {
956 l_ethdev.network_started = 1;
23cd1385
RB
957 printf("USB network up!\n");
958 }
959 }
960 req->context = NULL;
961}
962
6142e0ae 963static void issue_start_status(struct eth_dev *dev)
23cd1385
RB
964{
965 struct usb_request *req = dev->stat_req;
966 struct usb_cdc_notification *event;
967 int value;
968
6142e0ae
VK
969 /*
970 * flush old status
23cd1385
RB
971 *
972 * FIXME ugly idiom, maybe we'd be better with just
973 * a "cancel the whole queue" primitive since any
974 * unlink-one primitive has way too many error modes.
975 * here, we "know" toggle is already clear...
976 *
977 * FIXME iff req->context != null just dequeue it
978 */
6142e0ae
VK
979 usb_ep_disable(dev->status_ep);
980 usb_ep_enable(dev->status_ep, dev->status);
23cd1385 981
6142e0ae
VK
982 /*
983 * 3.8.1 says to issue first NETWORK_CONNECTION, then
23cd1385
RB
984 * a SPEED_CHANGE. could be useful in some configs.
985 */
986 event = req->buf;
987 event->bmRequestType = 0xA1;
988 event->bNotificationType = USB_CDC_NOTIFY_NETWORK_CONNECTION;
6142e0ae
VK
989 event->wValue = __constant_cpu_to_le16(1); /* connected */
990 event->wIndex = __constant_cpu_to_le16(1);
23cd1385
RB
991 event->wLength = 0;
992
993 req->length = sizeof *event;
994 req->complete = eth_status_complete;
995 req->context = dev;
996
6142e0ae 997 value = usb_ep_queue(dev->status_ep, req, GFP_ATOMIC);
23cd1385 998 if (value < 0)
7de73185 999 debug("status buf queue --> %d\n", value);
23cd1385
RB
1000}
1001
1002#endif
1003
1004/*-------------------------------------------------------------------------*/
1005
6142e0ae 1006static void eth_setup_complete(struct usb_ep *ep, struct usb_request *req)
23cd1385
RB
1007{
1008 if (req->status || req->actual != req->length)
7de73185 1009 debug("setup complete --> %d, %d/%d\n",
23cd1385
RB
1010 req->status, req->actual, req->length);
1011}
1012
1013/*
1014 * The setup() callback implements all the ep0 functionality that's not
1015 * handled lower down. CDC has a number of less-common features:
1016 *
1017 * - two interfaces: control, and ethernet data
1018 * - Ethernet data interface has two altsettings: default, and active
1019 * - class-specific descriptors for the control interface
1020 * - class-specific control requests
1021 */
1022static int
6142e0ae 1023eth_setup(struct usb_gadget *gadget, const struct usb_ctrlrequest *ctrl)
23cd1385 1024{
6142e0ae 1025 struct eth_dev *dev = get_gadget_data(gadget);
23cd1385
RB
1026 struct usb_request *req = dev->req;
1027 int value = -EOPNOTSUPP;
1028 u16 wIndex = le16_to_cpu(ctrl->wIndex);
1029 u16 wValue = le16_to_cpu(ctrl->wValue);
1030 u16 wLength = le16_to_cpu(ctrl->wLength);
1031
6142e0ae
VK
1032 /*
1033 * descriptors just go into the pre-allocated ep0 buffer,
23cd1385
RB
1034 * while config change events may enable network traffic.
1035 */
1036
7de73185 1037 debug("%s\n", __func__);
23cd1385
RB
1038
1039 req->complete = eth_setup_complete;
1040 switch (ctrl->bRequest) {
1041
1042 case USB_REQ_GET_DESCRIPTOR:
1043 if (ctrl->bRequestType != USB_DIR_IN)
1044 break;
1045 switch (wValue >> 8) {
1046
1047 case USB_DT_DEVICE:
6142e0ae
VK
1048 value = min(wLength, (u16) sizeof device_desc);
1049 memcpy(req->buf, &device_desc, value);
23cd1385
RB
1050 break;
1051 case USB_DT_DEVICE_QUALIFIER:
1052 if (!gadget_is_dualspeed(gadget))
1053 break;
6142e0ae
VK
1054 value = min(wLength, (u16) sizeof dev_qualifier);
1055 memcpy(req->buf, &dev_qualifier, value);
23cd1385
RB
1056 break;
1057
1058 case USB_DT_OTHER_SPEED_CONFIG:
1059 if (!gadget_is_dualspeed(gadget))
1060 break;
1061 /* FALLTHROUGH */
1062 case USB_DT_CONFIG:
1063 value = config_buf(gadget, req->buf,
1064 wValue >> 8,
1065 wValue & 0xff,
1066 gadget_is_otg(gadget));
1067 if (value >= 0)
6142e0ae 1068 value = min(wLength, (u16) value);
23cd1385
RB
1069 break;
1070
1071 case USB_DT_STRING:
6142e0ae 1072 value = usb_gadget_get_string(&stringtab,
23cd1385
RB
1073 wValue & 0xff, req->buf);
1074
1075 if (value >= 0)
6142e0ae 1076 value = min(wLength, (u16) value);
23cd1385
RB
1077
1078 break;
1079 }
1080 break;
1081
1082 case USB_REQ_SET_CONFIGURATION:
1083 if (ctrl->bRequestType != 0)
1084 break;
1085 if (gadget->a_hnp_support)
7de73185 1086 debug("HNP available\n");
23cd1385 1087 else if (gadget->a_alt_hnp_support)
7de73185 1088 debug("HNP needs a different root port\n");
6142e0ae 1089 value = eth_set_config(dev, wValue, GFP_ATOMIC);
23cd1385
RB
1090 break;
1091 case USB_REQ_GET_CONFIGURATION:
1092 if (ctrl->bRequestType != USB_DIR_IN)
1093 break;
1094 *(u8 *)req->buf = dev->config;
6142e0ae 1095 value = min(wLength, (u16) 1);
23cd1385
RB
1096 break;
1097
1098 case USB_REQ_SET_INTERFACE:
1099 if (ctrl->bRequestType != USB_RECIP_INTERFACE
1100 || !dev->config
1101 || wIndex > 1)
1102 break;
1103 if (!cdc_active(dev) && wIndex != 0)
1104 break;
1105
6142e0ae
VK
1106 /*
1107 * PXA hardware partially handles SET_INTERFACE;
23cd1385
RB
1108 * we need to kluge around that interference.
1109 */
6142e0ae
VK
1110 if (gadget_is_pxa(gadget)) {
1111 value = eth_set_config(dev, DEV_CONFIG_VALUE,
23cd1385
RB
1112 GFP_ATOMIC);
1113 goto done_set_intf;
1114 }
1115
1116#ifdef DEV_CONFIG_CDC
1117 switch (wIndex) {
1118 case 0: /* control/master intf */
1119 if (wValue != 0)
1120 break;
1121 if (dev->status) {
6142e0ae
VK
1122 usb_ep_disable(dev->status_ep);
1123 usb_ep_enable(dev->status_ep, dev->status);
23cd1385
RB
1124 }
1125 value = 0;
1126 break;
1127 case 1: /* data intf */
1128 if (wValue > 1)
1129 break;
6142e0ae
VK
1130 usb_ep_disable(dev->in_ep);
1131 usb_ep_disable(dev->out_ep);
23cd1385 1132
6142e0ae
VK
1133 /*
1134 * CDC requires the data transfers not be done from
23cd1385
RB
1135 * the default interface setting ... also, setting
1136 * the non-default interface resets filters etc.
1137 */
1138 if (wValue == 1) {
6142e0ae 1139 if (!cdc_active(dev))
23cd1385 1140 break;
6142e0ae
VK
1141 usb_ep_enable(dev->in_ep, dev->in);
1142 usb_ep_enable(dev->out_ep, dev->out);
23cd1385
RB
1143 dev->cdc_filter = DEFAULT_FILTER;
1144 if (dev->status)
6142e0ae 1145 issue_start_status(dev);
23cd1385
RB
1146 }
1147
1148 value = 0;
1149 break;
1150 }
1151#else
6142e0ae
VK
1152 /*
1153 * FIXME this is wrong, as is the assumption that
23cd1385
RB
1154 * all non-PXA hardware talks real CDC ...
1155 */
7de73185 1156 debug("set_interface ignored!\n");
23cd1385
RB
1157#endif /* DEV_CONFIG_CDC */
1158
1159done_set_intf:
1160 break;
1161 case USB_REQ_GET_INTERFACE:
1162 if (ctrl->bRequestType != (USB_DIR_IN|USB_RECIP_INTERFACE)
1163 || !dev->config
1164 || wIndex > 1)
1165 break;
1166 if (!(cdc_active(dev)) && wIndex != 0)
1167 break;
1168
1169 /* for CDC, iff carrier is on, data interface is active. */
1170 if (wIndex != 1)
1171 *(u8 *)req->buf = 0;
1172 else {
1173 /* *(u8 *)req->buf = netif_carrier_ok (dev->net) ? 1 : 0; */
1174 /* carrier always ok ...*/
1175 *(u8 *)req->buf = 1 ;
1176 }
6142e0ae 1177 value = min(wLength, (u16) 1);
23cd1385
RB
1178 break;
1179
1180#ifdef DEV_CONFIG_CDC
1181 case USB_CDC_SET_ETHERNET_PACKET_FILTER:
6142e0ae
VK
1182 /*
1183 * see 6.2.30: no data, wIndex = interface,
23cd1385
RB
1184 * wValue = packet filter bitmap
1185 */
1186 if (ctrl->bRequestType != (USB_TYPE_CLASS|USB_RECIP_INTERFACE)
1187 || !cdc_active(dev)
1188 || wLength != 0
1189 || wIndex > 1)
1190 break;
7de73185 1191 debug("packet filter %02x\n", wValue);
23cd1385
RB
1192 dev->cdc_filter = wValue;
1193 value = 0;
1194 break;
1195
6142e0ae
VK
1196 /*
1197 * and potentially:
23cd1385
RB
1198 * case USB_CDC_SET_ETHERNET_MULTICAST_FILTERS:
1199 * case USB_CDC_SET_ETHERNET_PM_PATTERN_FILTER:
1200 * case USB_CDC_GET_ETHERNET_PM_PATTERN_FILTER:
1201 * case USB_CDC_GET_ETHERNET_STATISTIC:
1202 */
1203
1204#endif /* DEV_CONFIG_CDC */
1205
1206 default:
7de73185 1207 debug("unknown control req%02x.%02x v%04x i%04x l%d\n",
23cd1385
RB
1208 ctrl->bRequestType, ctrl->bRequest,
1209 wValue, wIndex, wLength);
1210 }
1211
1212 /* respond with data transfer before status phase? */
1213 if (value >= 0) {
7de73185 1214 debug("respond with data transfer before status phase\n");
23cd1385
RB
1215 req->length = value;
1216 req->zero = value < wLength
1217 && (value % gadget->ep0->maxpacket) == 0;
6142e0ae 1218 value = usb_ep_queue(gadget->ep0, req, GFP_ATOMIC);
23cd1385 1219 if (value < 0) {
7de73185 1220 debug("ep_queue --> %d\n", value);
23cd1385 1221 req->status = 0;
6142e0ae 1222 eth_setup_complete(gadget->ep0, req);
23cd1385
RB
1223 }
1224 }
1225
1226 /* host either stalls (value < 0) or reports success */
1227 return value;
1228}
1229
23cd1385
RB
1230/*-------------------------------------------------------------------------*/
1231
6142e0ae 1232static void rx_complete(struct usb_ep *ep, struct usb_request *req);
23cd1385 1233
6142e0ae 1234static int rx_submit(struct eth_dev *dev, struct usb_request *req,
23cd1385
RB
1235 gfp_t gfp_flags)
1236{
1237 int retval = -ENOMEM;
1238 size_t size;
1239
6142e0ae
VK
1240 /*
1241 * Padding up to RX_EXTRA handles minor disagreements with host.
23cd1385
RB
1242 * Normally we use the USB "terminate on short read" convention;
1243 * so allow up to (N*maxpacket), since that memory is normally
1244 * already allocated. Some hardware doesn't deal well with short
1245 * reads (e.g. DMA must be N*maxpacket), so for now don't trim a
1246 * byte off the end (to force hardware errors on overflow).
1247 */
1248
7de73185 1249 debug("%s\n", __func__);
23cd1385
RB
1250
1251 size = (ETHER_HDR_SIZE + dev->mtu + RX_EXTRA);
1252 size += dev->out_ep->maxpacket - 1;
1253 size -= size % dev->out_ep->maxpacket;
1254
6142e0ae
VK
1255 /*
1256 * Some platforms perform better when IP packets are aligned,
23cd1385
RB
1257 * but on at least one, checksumming fails otherwise.
1258 */
1259
1260 req->buf = (u8 *) NetRxPackets[0];
1261 req->length = size;
1262 req->complete = rx_complete;
1263
6142e0ae 1264 retval = usb_ep_queue(dev->out_ep, req, gfp_flags);
23cd1385 1265
6142e0ae 1266 if (retval)
7de73185 1267 error("rx submit --> %d", retval);
6142e0ae 1268
23cd1385
RB
1269 return retval;
1270}
1271
6142e0ae 1272static void rx_complete(struct usb_ep *ep, struct usb_request *req)
23cd1385
RB
1273{
1274 struct eth_dev *dev = ep->driver_data;
1275
7de73185 1276 debug("%s: status %d\n", __func__, req->status);
23cd1385 1277
6142e0ae 1278 packet_received = 1;
23cd1385
RB
1279
1280 if (req)
6142e0ae 1281 dev->rx_req = req;
23cd1385
RB
1282}
1283
6142e0ae 1284static int alloc_requests(struct eth_dev *dev, unsigned n, gfp_t gfp_flags)
23cd1385
RB
1285{
1286
6142e0ae 1287 dev->tx_req = usb_ep_alloc_request(dev->in_ep, 0);
23cd1385
RB
1288
1289 if (!dev->tx_req)
1290 goto fail;
1291
6142e0ae 1292 dev->rx_req = usb_ep_alloc_request(dev->out_ep, 0);
23cd1385
RB
1293
1294 if (!dev->rx_req)
1295 goto fail;
1296
1297 return 0;
1298
1299fail:
7de73185 1300 error("can't alloc requests");
23cd1385
RB
1301 return -1;
1302}
1303
6142e0ae 1304static void tx_complete(struct usb_ep *ep, struct usb_request *req)
23cd1385 1305{
6142e0ae
VK
1306 debug("%s: status %s\n", __func__, (req->status) ? "failed" : "ok");
1307 packet_sent = 1;
23cd1385
RB
1308}
1309
6142e0ae 1310static inline int eth_is_promisc(struct eth_dev *dev)
23cd1385
RB
1311{
1312 /* no filters for the CDC subset; always promisc */
6142e0ae 1313 if (subset_active(dev))
23cd1385
RB
1314 return 1;
1315 return dev->cdc_filter & USB_CDC_PACKET_TYPE_PROMISCUOUS;
1316}
1317
1318#if 0
1319static int eth_start_xmit (struct sk_buff *skb, struct net_device *net)
1320{
1321 struct eth_dev *dev = netdev_priv(net);
1322 int length = skb->len;
1323 int retval;
1324 struct usb_request *req = NULL;
1325 unsigned long flags;
1326
1327 /* apply outgoing CDC or RNDIS filters */
1328 if (!eth_is_promisc (dev)) {
1329 u8 *dest = skb->data;
1330
1331 if (is_multicast_ether_addr(dest)) {
1332 u16 type;
1333
1334 /* ignores USB_CDC_PACKET_TYPE_MULTICAST and host
1335 * SET_ETHERNET_MULTICAST_FILTERS requests
1336 */
1337 if (is_broadcast_ether_addr(dest))
1338 type = USB_CDC_PACKET_TYPE_BROADCAST;
1339 else
1340 type = USB_CDC_PACKET_TYPE_ALL_MULTICAST;
1341 if (!(dev->cdc_filter & type)) {
1342 dev_kfree_skb_any (skb);
1343 return 0;
1344 }
1345 }
1346 /* ignores USB_CDC_PACKET_TYPE_DIRECTED */
1347 }
1348
1349 spin_lock_irqsave(&dev->req_lock, flags);
1350 /*
1351 * this freelist can be empty if an interrupt triggered disconnect()
1352 * and reconfigured the gadget (shutting down this queue) after the
1353 * network stack decided to xmit but before we got the spinlock.
1354 */
1355 if (list_empty(&dev->tx_reqs)) {
1356 spin_unlock_irqrestore(&dev->req_lock, flags);
1357 return 1;
1358 }
1359
1360 req = container_of (dev->tx_reqs.next, struct usb_request, list);
1361 list_del (&req->list);
1362
1363 /* temporarily stop TX queue when the freelist empties */
1364 if (list_empty (&dev->tx_reqs))
1365 netif_stop_queue (net);
1366 spin_unlock_irqrestore(&dev->req_lock, flags);
1367
1368 /* no buffer copies needed, unless the network stack did it
1369 * or the hardware can't use skb buffers.
1370 * or there's not enough space for any RNDIS headers we need
1371 */
1372 if (rndis_active(dev)) {
1373 struct sk_buff *skb_rndis;
1374
1375 skb_rndis = skb_realloc_headroom (skb,
1376 sizeof (struct rndis_packet_msg_type));
1377 if (!skb_rndis)
1378 goto drop;
1379
1380 dev_kfree_skb_any (skb);
1381 skb = skb_rndis;
1382 rndis_add_hdr (skb);
1383 length = skb->len;
1384 }
1385 req->buf = skb->data;
1386 req->context = skb;
1387 req->complete = tx_complete;
1388
1389 /* use zlp framing on tx for strict CDC-Ether conformance,
1390 * though any robust network rx path ignores extra padding.
1391 * and some hardware doesn't like to write zlps.
1392 */
1393 req->zero = 1;
1394 if (!dev->zlp && (length % dev->in_ep->maxpacket) == 0)
1395 length++;
1396
1397 req->length = length;
1398
1399 /* throttle highspeed IRQ rate back slightly */
1400 if (gadget_is_dualspeed(dev->gadget))
1401 req->no_interrupt = (dev->gadget->speed == USB_SPEED_HIGH)
1402 ? ((atomic_read(&dev->tx_qlen) % qmult) != 0)
1403 : 0;
1404
1405 retval = usb_ep_queue (dev->in_ep, req, GFP_ATOMIC);
1406 switch (retval) {
1407 default:
1408 DEBUG (dev, "tx queue err %d\n", retval);
1409 break;
1410 case 0:
1411 net->trans_start = jiffies;
1412 atomic_inc (&dev->tx_qlen);
1413 }
1414
1415 if (retval) {
1416drop:
1417 dev->stats.tx_dropped++;
1418 dev_kfree_skb_any (skb);
1419 spin_lock_irqsave(&dev->req_lock, flags);
1420 if (list_empty (&dev->tx_reqs))
1421 netif_start_queue (net);
1422 list_add (&req->list, &dev->tx_reqs);
1423 spin_unlock_irqrestore(&dev->req_lock, flags);
1424 }
1425 return 0;
1426}
1427
1428/*-------------------------------------------------------------------------*/
1429#endif
1430
6142e0ae 1431static void eth_unbind(struct usb_gadget *gadget)
23cd1385 1432{
6142e0ae 1433 struct eth_dev *dev = get_gadget_data(gadget);
23cd1385 1434
7de73185 1435 debug("%s...\n", __func__);
23cd1385 1436
0129e327
VK
1437 /* we've already been disconnected ... no i/o is active */
1438 if (dev->req) {
6142e0ae 1439 usb_ep_free_request(gadget->ep0, dev->req);
0129e327
VK
1440 dev->req = NULL;
1441 }
23cd1385 1442 if (dev->stat_req) {
6142e0ae 1443 usb_ep_free_request(dev->status_ep, dev->stat_req);
23cd1385
RB
1444 dev->stat_req = NULL;
1445 }
1446
1447 if (dev->tx_req) {
6142e0ae
VK
1448 usb_ep_free_request(dev->in_ep, dev->tx_req);
1449 dev->tx_req = NULL;
23cd1385
RB
1450 }
1451
1452 if (dev->rx_req) {
6142e0ae
VK
1453 usb_ep_free_request(dev->out_ep, dev->rx_req);
1454 dev->rx_req = NULL;
23cd1385
RB
1455 }
1456
1457/* unregister_netdev (dev->net);*/
1458/* free_netdev(dev->net);*/
1459
6142e0ae 1460 set_gadget_data(gadget, NULL);
23cd1385
RB
1461}
1462
6142e0ae 1463static void eth_disconnect(struct usb_gadget *gadget)
23cd1385 1464{
6142e0ae 1465 eth_reset_config(get_gadget_data(gadget));
23cd1385
RB
1466}
1467
6142e0ae 1468static void eth_suspend(struct usb_gadget *gadget)
23cd1385
RB
1469{
1470 /* Not used */
1471}
1472
6142e0ae 1473static void eth_resume(struct usb_gadget *gadget)
23cd1385
RB
1474{
1475 /* Not used */
1476}
1477
1478/*-------------------------------------------------------------------------*/
1479
1480static int is_eth_addr_valid(char *str)
1481{
1482 if (strlen(str) == 17) {
1483 int i;
1484 char *p, *q;
1485 uchar ea[6];
1486
1487 /* see if it looks like an ethernet address */
1488
1489 p = str;
1490
1491 for (i = 0; i < 6; i++) {
1492 char term = (i == 5 ? '\0' : ':');
1493
1494 ea[i] = simple_strtol(p, &q, 16);
1495
1496 if ((q - p) != 2 || *q++ != term)
1497 break;
1498
1499 p = q;
1500 }
1501
1502 if (i == 6) /* it looks ok */
1503 return 1;
1504 }
1505 return 0;
1506}
1507
6142e0ae 1508static u8 nibble(unsigned char c)
23cd1385 1509{
6142e0ae 1510 if (likely(isdigit(c)))
23cd1385 1511 return c - '0';
6142e0ae
VK
1512 c = toupper(c);
1513 if (likely(isxdigit(c)))
23cd1385
RB
1514 return 10 + c - 'A';
1515 return 0;
1516}
1517
1518static int get_ether_addr(const char *str, u8 *dev_addr)
1519{
1520 if (str) {
1521 unsigned i;
1522
1523 for (i = 0; i < 6; i++) {
1524 unsigned char num;
1525
6142e0ae 1526 if ((*str == '.') || (*str == ':'))
23cd1385
RB
1527 str++;
1528 num = nibble(*str++) << 4;
1529 num |= (nibble(*str++));
6142e0ae 1530 dev_addr[i] = num;
23cd1385 1531 }
6142e0ae 1532 if (is_valid_ether_addr(dev_addr))
23cd1385
RB
1533 return 0;
1534 }
1535 return 1;
1536}
1537
1538static int eth_bind(struct usb_gadget *gadget)
1539{
1540 struct eth_dev *dev = &l_ethdev;
1541 u8 cdc = 1, zlp = 1;
1542 struct usb_ep *in_ep, *out_ep, *status_ep = NULL;
1543 int gcnum;
6142e0ae 1544 u8 tmp[7];
23cd1385
RB
1545
1546 /* these flags are only ever cleared; compiler take note */
1547#ifndef DEV_CONFIG_CDC
1548 cdc = 0;
1549#endif
6142e0ae
VK
1550 /*
1551 * Because most host side USB stacks handle CDC Ethernet, that
23cd1385
RB
1552 * standard protocol is _strongly_ preferred for interop purposes.
1553 * (By everyone except Microsoft.)
1554 */
6142e0ae 1555 if (gadget_is_pxa(gadget)) {
23cd1385
RB
1556 /* pxa doesn't support altsettings */
1557 cdc = 0;
1558 } else if (gadget_is_musbhdrc(gadget)) {
1559 /* reduce tx dma overhead by avoiding special cases */
1560 zlp = 0;
1561 } else if (gadget_is_sh(gadget)) {
1562 /* sh doesn't support multiple interfaces or configs */
1563 cdc = 0;
6142e0ae 1564 } else if (gadget_is_sa1100(gadget)) {
23cd1385
RB
1565 /* hardware can't write zlps */
1566 zlp = 0;
6142e0ae
VK
1567 /*
1568 * sa1100 CAN do CDC, without status endpoint ... we use
23cd1385
RB
1569 * non-CDC to be compatible with ARM Linux-2.4 "usb-eth".
1570 */
1571 cdc = 0;
1572 }
1573
6142e0ae 1574 gcnum = usb_gadget_controller_number(gadget);
23cd1385 1575 if (gcnum >= 0)
6142e0ae 1576 device_desc.bcdDevice = cpu_to_le16(0x0300 + gcnum);
23cd1385 1577 else {
6142e0ae
VK
1578 /*
1579 * can't assume CDC works. don't want to default to
23cd1385
RB
1580 * anything less functional on CDC-capable hardware,
1581 * so we fail in this case.
1582 */
7de73185 1583 error("controller '%s' not recognized",
23cd1385
RB
1584 gadget->name);
1585 return -ENODEV;
1586 }
1587
6142e0ae
VK
1588 /*
1589 * CDC subset ... recognized by Linux since 2.4.10, but Windows
23cd1385
RB
1590 * drivers aren't widely available. (That may be improved by
1591 * supporting one submode of the "SAFE" variant of MDLM.)
1592 */
1593 if (!cdc) {
1594 device_desc.idVendor =
1595 __constant_cpu_to_le16(SIMPLE_VENDOR_NUM);
1596 device_desc.idProduct =
1597 __constant_cpu_to_le16(SIMPLE_PRODUCT_NUM);
1598 }
1599
1600 /* support optional vendor/distro customization */
1601#if defined(CONFIG_USB_CDC_VENDOR_ID) && defined(CONFIG_USB_CDC_PRODUCT_ID)
1602 device_desc.idVendor = cpu_to_le16(CONFIG_USB_CDC_VENDOR_ID);
1603 device_desc.idProduct = cpu_to_le16(CONFIG_USB_CDC_PRODUCT_ID);
1604#endif
1605 if (bcdDevice)
1606 device_desc.bcdDevice = cpu_to_le16(bcdDevice);
1607 if (iManufacturer)
6142e0ae 1608 strlcpy(manufacturer, iManufacturer, sizeof manufacturer);
23cd1385 1609 if (iProduct)
6142e0ae 1610 strlcpy(product_desc, iProduct, sizeof product_desc);
23cd1385
RB
1611 if (iSerialNumber) {
1612 device_desc.iSerialNumber = STRING_SERIALNUMBER,
2e12abe6 1613 strlcpy(serial_number, iSerialNumber, sizeof serial_number);
23cd1385
RB
1614 }
1615
1616 /* all we really need is bulk IN/OUT */
6142e0ae
VK
1617 usb_ep_autoconfig_reset(gadget);
1618 in_ep = usb_ep_autoconfig(gadget, &fs_source_desc);
23cd1385
RB
1619 if (!in_ep) {
1620autoconf_fail:
7de73185 1621 error("can't autoconfigure on %s\n",
23cd1385
RB
1622 gadget->name);
1623 return -ENODEV;
1624 }
1625 in_ep->driver_data = in_ep; /* claim */
1626
6142e0ae 1627 out_ep = usb_ep_autoconfig(gadget, &fs_sink_desc);
23cd1385
RB
1628 if (!out_ep)
1629 goto autoconf_fail;
1630 out_ep->driver_data = out_ep; /* claim */
1631
1632#if defined(DEV_CONFIG_CDC)
6142e0ae
VK
1633 /*
1634 * CDC Ethernet control interface doesn't require a status endpoint.
23cd1385
RB
1635 * Since some hosts expect one, try to allocate one anyway.
1636 */
1637 if (cdc) {
6142e0ae 1638 status_ep = usb_ep_autoconfig(gadget, &fs_status_desc);
23cd1385
RB
1639 if (status_ep) {
1640 status_ep->driver_data = status_ep; /* claim */
1641 } else if (cdc) {
1642 control_intf.bNumEndpoints = 0;
1643 /* FIXME remove endpoint from descriptor list */
1644 }
1645 }
1646#endif
1647
1648 /* one config: cdc, else minimal subset */
1649 if (!cdc) {
1650 eth_config.bNumInterfaces = 1;
1651 eth_config.iConfiguration = STRING_SUBSET;
1652
6142e0ae
VK
1653 /*
1654 * use functions to set these up, in case we're built to work
23cd1385
RB
1655 * with multiple controllers and must override CDC Ethernet.
1656 */
1657 fs_subset_descriptors();
1658 hs_subset_descriptors();
1659 }
1660
1661 device_desc.bMaxPacketSize0 = gadget->ep0->maxpacket;
6142e0ae 1662 usb_gadget_set_selfpowered(gadget);
23cd1385
RB
1663
1664 if (gadget_is_dualspeed(gadget)) {
1665 if (!cdc)
1666 dev_qualifier.bDeviceClass = USB_CLASS_VENDOR_SPEC;
1667
1668 /* assumes ep0 uses the same value for both speeds ... */
1669 dev_qualifier.bMaxPacketSize0 = device_desc.bMaxPacketSize0;
1670
1671 /* and that all endpoints are dual-speed */
1672 hs_source_desc.bEndpointAddress =
1673 fs_source_desc.bEndpointAddress;
1674 hs_sink_desc.bEndpointAddress =
1675 fs_sink_desc.bEndpointAddress;
1676#if defined(DEV_CONFIG_CDC)
1677 if (status_ep)
1678 hs_status_desc.bEndpointAddress =
1679 fs_status_desc.bEndpointAddress;
1680#endif
1681 }
1682
1683 if (gadget_is_otg(gadget)) {
1684 otg_descriptor.bmAttributes |= USB_OTG_HNP,
1685 eth_config.bmAttributes |= USB_CONFIG_ATT_WAKEUP;
1686 eth_config.bMaxPower = 4;
1687 }
1688
1689 dev->net = &l_netdev;
6142e0ae 1690 strcpy(dev->net->name, USB_NET_NAME);
23cd1385
RB
1691
1692 dev->cdc = cdc;
1693 dev->zlp = zlp;
1694
1695 dev->in_ep = in_ep;
1696 dev->out_ep = out_ep;
1697 dev->status_ep = status_ep;
1698
6142e0ae
VK
1699 /*
1700 * Module params for these addresses should come from ID proms.
23cd1385
RB
1701 * The host side address is used with CDC, and commonly
1702 * ends up in a persistent config database. It's not clear if
1703 * host side code for the SAFE thing cares -- its original BLAN
1704 * thing didn't, Sharp never assigned those addresses on Zaurii.
1705 */
1706 get_ether_addr(dev_addr, dev->net->enetaddr);
1707
1708 memset(tmp, 0, sizeof(tmp));
1709 memcpy(tmp, dev->net->enetaddr, sizeof(dev->net->enetaddr));
1710
1711 get_ether_addr(host_addr, dev->host_mac);
1712
6142e0ae
VK
1713 sprintf(ethaddr, "%02X%02X%02X%02X%02X%02X",
1714 dev->host_mac[0], dev->host_mac[1],
1715 dev->host_mac[2], dev->host_mac[3],
1716 dev->host_mac[4], dev->host_mac[5]);
23cd1385 1717
7de73185 1718 printf("using %s, OUT %s IN %s%s%s\n", gadget->name,
23cd1385
RB
1719 out_ep->name, in_ep->name,
1720 status_ep ? " STATUS " : "",
1721 status_ep ? status_ep->name : ""
1722 );
7de73185 1723 printf("MAC %02x:%02x:%02x:%02x:%02x:%02x\n",
6142e0ae
VK
1724 dev->net->enetaddr[0], dev->net->enetaddr[1],
1725 dev->net->enetaddr[2], dev->net->enetaddr[3],
1726 dev->net->enetaddr[4], dev->net->enetaddr[5]);
23cd1385
RB
1727
1728 if (cdc) {
7de73185 1729 printf("HOST MAC %02x:%02x:%02x:%02x:%02x:%02x\n",
6142e0ae
VK
1730 dev->host_mac[0], dev->host_mac[1],
1731 dev->host_mac[2], dev->host_mac[3],
1732 dev->host_mac[4], dev->host_mac[5]);
23cd1385
RB
1733 }
1734
6142e0ae
VK
1735 /*
1736 * use PKTSIZE (or aligned... from u-boot) and set
1737 * wMaxSegmentSize accordingly
1738 */
23cd1385
RB
1739 dev->mtu = PKTSIZE_ALIGN; /* RNDIS does not like this, only 1514, TODO*/
1740
1741 /* preallocate control message data and buffer */
6142e0ae 1742 dev->req = usb_ep_alloc_request(gadget->ep0, GFP_KERNEL);
23cd1385
RB
1743 if (!dev->req)
1744 goto fail;
1745 dev->req->buf = control_req;
1746 dev->req->complete = eth_setup_complete;
1747
1748 /* ... and maybe likewise for status transfer */
1749#if defined(DEV_CONFIG_CDC)
1750 if (dev->status_ep) {
6142e0ae
VK
1751 dev->stat_req = usb_ep_alloc_request(dev->status_ep,
1752 GFP_KERNEL);
23cd1385 1753 if (!dev->stat_req) {
6142e0ae 1754 usb_ep_free_request(dev->status_ep, dev->req);
23cd1385
RB
1755
1756 goto fail;
1757 }
df559c1d 1758 dev->stat_req->buf = status_req;
23cd1385
RB
1759 dev->stat_req->context = NULL;
1760 }
1761#endif
1762
1763 /* finish hookup to lower layer ... */
1764 dev->gadget = gadget;
6142e0ae 1765 set_gadget_data(gadget, dev);
23cd1385
RB
1766 gadget->ep0->driver_data = dev;
1767
6142e0ae
VK
1768 /*
1769 * two kinds of host-initiated state changes:
23cd1385
RB
1770 * - iff DATA transfer is active, carrier is "on"
1771 * - tx queueing enabled if open *and* carrier is "on"
1772 */
1773 return 0;
1774
1775fail:
7de73185 1776 error("%s failed", __func__);
6142e0ae 1777 eth_unbind(gadget);
23cd1385
RB
1778 return -ENOMEM;
1779}
1780
6142e0ae 1781static int usb_eth_init(struct eth_device *netdev, bd_t *bd)
23cd1385 1782{
6142e0ae 1783 struct eth_dev *dev = &l_ethdev;
23cd1385
RB
1784 struct usb_gadget *gadget;
1785 unsigned long ts;
1786 unsigned long timeout = USB_CONNECT_TIMEOUT;
1787
1788 if (!netdev) {
7de73185 1789 error("received NULL ptr");
23cd1385
RB
1790 goto fail;
1791 }
1792
1793 dev->network_started = 0;
1794 dev->tx_req = NULL;
1795 dev->rx_req = NULL;
1796
1797 packet_received = 0;
1798 packet_sent = 0;
1799
1800 gadget = dev->gadget;
1801 usb_gadget_connect(gadget);
1802
1803 if (getenv("cdc_connect_timeout"))
1804 timeout = simple_strtoul(getenv("cdc_connect_timeout"),
1805 NULL, 10) * CONFIG_SYS_HZ;
1806 ts = get_timer(0);
6142e0ae 1807 while (!l_ethdev.network_started) {
23cd1385
RB
1808 /* Handle control-c and timeouts */
1809 if (ctrlc() || (get_timer(ts) > timeout)) {
7de73185 1810 error("The remote end did not respond in time.");
23cd1385
RB
1811 goto fail;
1812 }
1813 usb_gadget_handle_interrupts();
1814 }
1815
6142e0ae 1816 rx_submit(dev, dev->rx_req, 0);
23cd1385
RB
1817 return 0;
1818fail:
1819 return -1;
1820}
1821
6142e0ae
VK
1822static int usb_eth_send(struct eth_device *netdev,
1823 volatile void *packet, int length)
23cd1385
RB
1824{
1825 int retval;
1826 struct usb_request *req = NULL;
7de73185 1827 struct eth_dev *dev = &l_ethdev;
6142e0ae
VK
1828 unsigned long ts;
1829 unsigned long timeout = USB_CONNECT_TIMEOUT;
23cd1385 1830
7de73185 1831 debug("%s:...\n", __func__);
23cd1385
RB
1832
1833 req = dev->tx_req;
1834
1835 req->buf = (void *)packet;
1836 req->context = NULL;
1837 req->complete = tx_complete;
1838
6142e0ae
VK
1839 /*
1840 * use zlp framing on tx for strict CDC-Ether conformance,
23cd1385
RB
1841 * though any robust network rx path ignores extra padding.
1842 * and some hardware doesn't like to write zlps.
1843 */
1844 req->zero = 1;
1845 if (!dev->zlp && (length % dev->in_ep->maxpacket) == 0)
1846 length++;
1847
1848 req->length = length;
1849#if 0
1850 /* throttle highspeed IRQ rate back slightly */
1851 if (gadget_is_dualspeed(dev->gadget))
1852 req->no_interrupt = (dev->gadget->speed == USB_SPEED_HIGH)
1853 ? ((dev->tx_qlen % qmult) != 0) : 0;
1854#endif
6142e0ae
VK
1855 dev->tx_qlen = 1;
1856 ts = get_timer(0);
1857 packet_sent = 0;
23cd1385 1858
6142e0ae 1859 retval = usb_ep_queue(dev->in_ep, req, GFP_ATOMIC);
23cd1385
RB
1860
1861 if (!retval)
7de73185 1862 debug("%s: packet queued\n", __func__);
6142e0ae
VK
1863 while (!packet_sent) {
1864 if (get_timer(ts) > timeout) {
1865 printf("timeout sending packets to usb ethernet\n");
1866 return -1;
1867 }
1868 usb_gadget_handle_interrupts();
23cd1385
RB
1869 }
1870
1871 return 0;
1872}
1873
6142e0ae 1874static int usb_eth_recv(struct eth_device *netdev)
23cd1385
RB
1875{
1876 struct eth_dev *dev = &l_ethdev;
1877
1878 usb_gadget_handle_interrupts();
1879
6142e0ae
VK
1880 if (packet_received) {
1881 debug("%s: packet received\n", __func__);
1882 if (dev->rx_req) {
1883 NetReceive(NetRxPackets[0], dev->rx_req->length);
1884 packet_received = 0;
23cd1385
RB
1885
1886 if (dev->rx_req)
6142e0ae
VK
1887 rx_submit(dev, dev->rx_req, 0);
1888 } else
1889 error("dev->rx_req invalid");
23cd1385
RB
1890 }
1891 return 0;
1892}
1893
6142e0ae 1894void usb_eth_halt(struct eth_device *netdev)
23cd1385 1895{
6142e0ae 1896 struct eth_dev *dev = &l_ethdev;
23cd1385 1897
6142e0ae 1898 if (!netdev) {
7de73185 1899 error("received NULL ptr");
23cd1385
RB
1900 return;
1901 }
1902
1903 usb_gadget_disconnect(dev->gadget);
1904}
1905
1906static struct usb_gadget_driver eth_driver = {
1907 .speed = DEVSPEED,
1908
1909 .bind = eth_bind,
1910 .unbind = eth_unbind,
1911
1912 .setup = eth_setup,
1913 .disconnect = eth_disconnect,
1914
1915 .suspend = eth_suspend,
1916 .resume = eth_resume,
1917};
1918
1919int usb_eth_initialize(bd_t *bi)
1920{
1921 int status = 0;
6142e0ae 1922 struct eth_device *netdev = &l_netdev;
23cd1385 1923
6142e0ae 1924 sprintf(netdev->name, "usb_ether");
23cd1385
RB
1925
1926 netdev->init = usb_eth_init;
1927 netdev->send = usb_eth_send;
1928 netdev->recv = usb_eth_recv;
1929 netdev->halt = usb_eth_halt;
1930
1931#ifdef CONFIG_MCAST_TFTP
1932 #error not supported
1933#endif
1934 /* Configure default mac-addresses for the USB ethernet device */
1935#ifdef CONFIG_USBNET_DEV_ADDR
1936 strncpy(dev_addr, CONFIG_USBNET_DEV_ADDR, sizeof(dev_addr));
1937#endif
1938#ifdef CONFIG_USBNET_HOST_ADDR
1939 strncpy(host_addr, CONFIG_USBNET_HOST_ADDR, sizeof(host_addr));
1940#endif
1941 /* Check if the user overruled the MAC addresses */
1942 if (getenv("usbnet_devaddr"))
1943 strncpy(dev_addr, getenv("usbnet_devaddr"),
1944 sizeof(dev_addr));
1945
1946 if (getenv("usbnet_hostaddr"))
1947 strncpy(host_addr, getenv("usbnet_hostaddr"),
1948 sizeof(host_addr));
1949
1950 /* Make sure both strings are terminated */
1951 dev_addr[sizeof(dev_addr)-1] = '\0';
1952 host_addr[sizeof(host_addr)-1] = '\0';
1953
1954 if (!is_eth_addr_valid(dev_addr)) {
7de73185 1955 error("Need valid 'usbnet_devaddr' to be set");
23cd1385
RB
1956 status = -1;
1957 }
1958 if (!is_eth_addr_valid(host_addr)) {
7de73185 1959 error("Need valid 'usbnet_hostaddr' to be set");
23cd1385
RB
1960 status = -1;
1961 }
1962 if (status)
1963 goto fail;
1964
1965 status = usb_gadget_register_driver(&eth_driver);
1966 if (status < 0)
1967 goto fail;
1968
1969 eth_register(netdev);
1970 return 0;
1971
1972fail:
7de73185 1973 error("%s failed. error = %d", __func__, status);
23cd1385
RB
1974 return status;
1975}
1976
This page took 0.257749 seconds and 4 git commands to generate.