if_cdce.c revision 1.33 1 /* $NetBSD: if_cdce.c,v 1.33 2011/06/07 05:46:00 msaitoh Exp $ */
2
3 /*
4 * Copyright (c) 1997, 1998, 1999, 2000-2003 Bill Paul <wpaul (at) windriver.com>
5 * Copyright (c) 2003 Craig Boston
6 * Copyright (c) 2004 Daniel Hartmeier
7 * All rights reserved.
8 *
9 * Redistribution and use in source and binary forms, with or without
10 * modification, are permitted provided that the following conditions
11 * are met:
12 * 1. Redistributions of source code must retain the above copyright
13 * notice, this list of conditions and the following disclaimer.
14 * 2. Redistributions in binary form must reproduce the above copyright
15 * notice, this list of conditions and the following disclaimer in the
16 * documentation and/or other materials provided with the distribution.
17 * 3. All advertising materials mentioning features or use of this software
18 * must display the following acknowledgement:
19 * This product includes software developed by Bill Paul.
20 * 4. Neither the name of the author nor the names of any co-contributors
21 * may be used to endorse or promote products derived from this software
22 * without specific prior written permission.
23 *
24 * THIS SOFTWARE IS PROVIDED BY Bill Paul AND CONTRIBUTORS ``AS IS'' AND
25 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
26 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
27 * ARE DISCLAIMED. IN NO EVENT SHALL Bill Paul, THE VOICES IN HIS HEAD OR
28 * THE CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
29 * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
30 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
31 * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
32 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
33 * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
34 * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
35 */
36
37 /*
38 * USB Communication Device Class (Ethernet Networking Control Model)
39 * http://www.usb.org/developers/devclass_docs/usbcdc11.pdf
40 *
41 */
42
43 #include <sys/cdefs.h>
44 __KERNEL_RCSID(0, "$NetBSD: if_cdce.c,v 1.33 2011/06/07 05:46:00 msaitoh Exp $");
45 #ifdef __NetBSD__
46 #include "opt_inet.h"
47 #endif
48
49 #include <sys/param.h>
50 #include <sys/systm.h>
51 #include <sys/sockio.h>
52 #include <sys/mbuf.h>
53 #include <sys/kernel.h>
54 #include <sys/socket.h>
55 #include <sys/device.h>
56
57 #if NRND > 0
58 #include <sys/rnd.h>
59 #endif
60
61 #include <net/if.h>
62 #include <net/if_arp.h>
63 #include <net/if_dl.h>
64 #include <net/if_media.h>
65
66 #include <net/bpf.h>
67
68 #include <net/if_ether.h>
69 #ifdef INET
70 #include <netinet/in.h>
71 #include <netinet/if_inarp.h>
72 #endif
73
74
75
76 #include <dev/usb/usb.h>
77 #include <dev/usb/usbdi.h>
78 #include <dev/usb/usbdi_util.h>
79 #include <dev/usb/usbdevs.h>
80 #include <dev/usb/usbcdc.h>
81
82 #include <dev/usb/if_cdcereg.h>
83
84 Static int cdce_tx_list_init(struct cdce_softc *);
85 Static int cdce_rx_list_init(struct cdce_softc *);
86 Static int cdce_newbuf(struct cdce_softc *, struct cdce_chain *,
87 struct mbuf *);
88 Static int cdce_encap(struct cdce_softc *, struct mbuf *, int);
89 Static void cdce_rxeof(usbd_xfer_handle, usbd_private_handle, usbd_status);
90 Static void cdce_txeof(usbd_xfer_handle, usbd_private_handle, usbd_status);
91 Static void cdce_start(struct ifnet *);
92 Static int cdce_ioctl(struct ifnet *, u_long, void *);
93 Static void cdce_init(void *);
94 Static void cdce_watchdog(struct ifnet *);
95 Static void cdce_stop(struct cdce_softc *);
96
97 Static const struct cdce_type cdce_devs[] = {
98 {{ USB_VENDOR_ACERLABS, USB_PRODUCT_ACERLABS_M5632 }, CDCE_NO_UNION },
99 {{ USB_VENDOR_COMPAQ, USB_PRODUCT_COMPAQ_IPAQLINUX }, CDCE_NO_UNION },
100 {{ USB_VENDOR_GMATE, USB_PRODUCT_GMATE_YP3X00 }, CDCE_NO_UNION },
101 {{ USB_VENDOR_MOTOROLA2, USB_PRODUCT_MOTOROLA2_USBLAN }, CDCE_ZAURUS | CDCE_NO_UNION },
102 {{ USB_VENDOR_MOTOROLA2, USB_PRODUCT_MOTOROLA2_USBLAN2 }, CDCE_ZAURUS | CDCE_NO_UNION },
103 {{ USB_VENDOR_NETCHIP, USB_PRODUCT_NETCHIP_ETHERNETGADGET }, CDCE_NO_UNION },
104 {{ USB_VENDOR_PROLIFIC, USB_PRODUCT_PROLIFIC_PL2501 }, CDCE_NO_UNION },
105 {{ USB_VENDOR_SHARP, USB_PRODUCT_SHARP_SL5500 }, CDCE_ZAURUS },
106 {{ USB_VENDOR_SHARP, USB_PRODUCT_SHARP_A300 }, CDCE_ZAURUS | CDCE_NO_UNION },
107 {{ USB_VENDOR_SHARP, USB_PRODUCT_SHARP_SL5600 }, CDCE_ZAURUS | CDCE_NO_UNION },
108 {{ USB_VENDOR_SHARP, USB_PRODUCT_SHARP_C700 }, CDCE_ZAURUS | CDCE_NO_UNION },
109 {{ USB_VENDOR_SHARP, USB_PRODUCT_SHARP_C750 }, CDCE_ZAURUS | CDCE_NO_UNION },
110 };
111 #define cdce_lookup(v, p) \
112 ((const struct cdce_type *)usb_lookup(cdce_devs, v, p))
113
114 int cdce_match(device_t, cfdata_t, void *);
115 void cdce_attach(device_t, device_t, void *);
116 int cdce_detach(device_t, int);
117 int cdce_activate(device_t, enum devact);
118 extern struct cfdriver cdce_cd;
119 CFATTACH_DECL_NEW(cdce, sizeof(struct cdce_softc), cdce_match, cdce_attach,
120 cdce_detach, cdce_activate);
121
122 int
123 cdce_match(device_t parent, cfdata_t match, void *aux)
124 {
125 struct usbif_attach_arg *uaa = aux;
126
127 if (cdce_lookup(uaa->vendor, uaa->product) != NULL)
128 return (UMATCH_VENDOR_PRODUCT);
129
130 if (uaa->class == UICLASS_CDC && uaa->subclass ==
131 UISUBCLASS_ETHERNET_NETWORKING_CONTROL_MODEL)
132 return (UMATCH_IFACECLASS_GENERIC);
133
134 return (UMATCH_NONE);
135 }
136
137 void
138 cdce_attach(device_t parent, device_t self, void *aux)
139 {
140 struct cdce_softc *sc = device_private(self);
141 struct usbif_attach_arg *uaa = aux;
142 char *devinfop;
143 int s;
144 struct ifnet *ifp;
145 usbd_device_handle dev = uaa->device;
146 const struct cdce_type *t;
147 usb_interface_descriptor_t *id;
148 usb_endpoint_descriptor_t *ed;
149 const usb_cdc_union_descriptor_t *ud;
150 usb_config_descriptor_t *cd;
151 int data_ifcno;
152 int i, j, numalts;
153 u_char eaddr[ETHER_ADDR_LEN];
154 const usb_cdc_ethernet_descriptor_t *ue;
155 char eaddr_str[USB_MAX_ENCODED_STRING_LEN];
156
157 sc->cdce_dev = self;
158
159 aprint_naive("\n");
160 aprint_normal("\n");
161
162 devinfop = usbd_devinfo_alloc(dev, 0);
163 aprint_normal_dev(self, "%s\n", devinfop);
164 usbd_devinfo_free(devinfop);
165
166 sc->cdce_udev = uaa->device;
167 sc->cdce_ctl_iface = uaa->iface;
168
169 t = cdce_lookup(uaa->vendor, uaa->product);
170 if (t)
171 sc->cdce_flags = t->cdce_flags;
172
173 if (sc->cdce_flags & CDCE_NO_UNION)
174 sc->cdce_data_iface = sc->cdce_ctl_iface;
175 else {
176 ud = (const usb_cdc_union_descriptor_t *)usb_find_desc(sc->cdce_udev,
177 UDESC_CS_INTERFACE, UDESCSUB_CDC_UNION);
178 if (ud == NULL) {
179 aprint_error_dev(self, "no union descriptor\n");
180 return;
181 }
182 data_ifcno = ud->bSlaveInterface[0];
183
184 for (i = 0; i < uaa->nifaces; i++) {
185 if (uaa->ifaces[i] != NULL) {
186 id = usbd_get_interface_descriptor(
187 uaa->ifaces[i]);
188 if (id != NULL && id->bInterfaceNumber ==
189 data_ifcno) {
190 sc->cdce_data_iface = uaa->ifaces[i];
191 uaa->ifaces[i] = NULL;
192 }
193 }
194 }
195 }
196
197 if (sc->cdce_data_iface == NULL) {
198 aprint_error_dev(self, "no data interface\n");
199 return;
200 }
201
202 /*
203 * <quote>
204 * The Data Class interface of a networking device shall have a minimum
205 * of two interface settings. The first setting (the default interface
206 * setting) includes no endpoints and therefore no networking traffic is
207 * exchanged whenever the default interface setting is selected. One or
208 * more additional interface settings are used for normal operation, and
209 * therefore each includes a pair of endpoints (one IN, and one OUT) to
210 * exchange network traffic. Select an alternate interface setting to
211 * initialize the network aspects of the device and to enable the
212 * exchange of network traffic.
213 * </quote>
214 *
215 * Some devices, most notably cable modems, include interface settings
216 * that have no IN or OUT endpoint, therefore loop through the list of all
217 * available interface settings looking for one with both IN and OUT
218 * endpoints.
219 */
220 id = usbd_get_interface_descriptor(sc->cdce_data_iface);
221 cd = usbd_get_config_descriptor(sc->cdce_udev);
222 numalts = usbd_get_no_alts(cd, id->bInterfaceNumber);
223
224 for (j = 0; j < numalts; j++) {
225 if (usbd_set_interface(sc->cdce_data_iface, j)) {
226 aprint_error_dev(sc->cdce_dev,
227 "setting alternate interface failed\n");
228 return;
229 }
230 /* Find endpoints. */
231 id = usbd_get_interface_descriptor(sc->cdce_data_iface);
232 sc->cdce_bulkin_no = sc->cdce_bulkout_no = -1;
233 for (i = 0; i < id->bNumEndpoints; i++) {
234 ed = usbd_interface2endpoint_descriptor(sc->cdce_data_iface, i);
235 if (!ed) {
236 aprint_error_dev(self,
237 "could not read endpoint descriptor\n");
238 return;
239 }
240 if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
241 UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
242 sc->cdce_bulkin_no = ed->bEndpointAddress;
243 } else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT &&
244 UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
245 sc->cdce_bulkout_no = ed->bEndpointAddress;
246 } else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
247 UE_GET_XFERTYPE(ed->bmAttributes) == UE_INTERRUPT) {
248 /* XXX: CDC spec defines an interrupt pipe, but it is not
249 * needed for simple host-to-host applications. */
250 } else {
251 aprint_error_dev(self, "unexpected endpoint\n");
252 }
253 }
254 /* If we found something, try and use it... */
255 if ((sc->cdce_bulkin_no != -1) && (sc->cdce_bulkout_no != -1))
256 break;
257 }
258
259 if (sc->cdce_bulkin_no == -1) {
260 aprint_error_dev(self, "could not find data bulk in\n");
261 return;
262 }
263 if (sc->cdce_bulkout_no == -1 ) {
264 aprint_error_dev(self, "could not find data bulk out\n");
265 return;
266 }
267
268 ue = (const usb_cdc_ethernet_descriptor_t *)usb_find_desc(dev,
269 UDESC_CS_INTERFACE, UDESCSUB_CDC_ENF);
270 if (!ue || usbd_get_string(dev, ue->iMacAddress, eaddr_str) ||
271 ether_aton_r(eaddr, sizeof(eaddr), eaddr_str)) {
272 aprint_normal_dev(self, "faking address\n");
273 eaddr[0]= 0x2a;
274 memcpy(&eaddr[1], &hardclock_ticks, sizeof(uint32_t));
275 eaddr[5] = (uint8_t)(device_unit(sc->cdce_dev));
276 }
277
278 s = splnet();
279
280 aprint_normal_dev(self, "address %s\n", ether_sprintf(eaddr));
281
282 ifp = GET_IFP(sc);
283 ifp->if_softc = sc;
284 ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
285 ifp->if_ioctl = cdce_ioctl;
286 ifp->if_start = cdce_start;
287 ifp->if_watchdog = cdce_watchdog;
288 strncpy(ifp->if_xname, device_xname(sc->cdce_dev), IFNAMSIZ);
289
290 IFQ_SET_READY(&ifp->if_snd);
291
292 if_attach(ifp);
293 ether_ifattach(ifp, eaddr);
294
295 sc->cdce_attached = 1;
296 splx(s);
297
298 usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->cdce_udev,
299 sc->cdce_dev);
300
301 if (!pmf_device_register(self, NULL, NULL))
302 aprint_error_dev(self, "couldn't establish power handler\n");
303
304 return;
305 }
306
307 int
308 cdce_detach(device_t self, int flags)
309 {
310 struct cdce_softc *sc = device_private(self);
311 struct ifnet *ifp = GET_IFP(sc);
312 int s;
313
314 if (device_pmf_is_registered(self))
315 pmf_device_deregister(self);
316
317 s = splusb();
318
319 if (!sc->cdce_attached) {
320 splx(s);
321 return (0);
322 }
323
324 if (ifp->if_flags & IFF_RUNNING)
325 cdce_stop(sc);
326
327 ether_ifdetach(ifp);
328
329 if_detach(ifp);
330
331 sc->cdce_attached = 0;
332 splx(s);
333
334 return (0);
335 }
336
337 Static void
338 cdce_start(struct ifnet *ifp)
339 {
340 struct cdce_softc *sc = ifp->if_softc;
341 struct mbuf *m_head = NULL;
342
343 if (sc->cdce_dying || (ifp->if_flags & IFF_OACTIVE))
344 return;
345
346 IFQ_POLL(&ifp->if_snd, m_head);
347 if (m_head == NULL)
348 return;
349
350 if (cdce_encap(sc, m_head, 0)) {
351 ifp->if_flags |= IFF_OACTIVE;
352 return;
353 }
354
355 IFQ_DEQUEUE(&ifp->if_snd, m_head);
356
357 bpf_mtap(ifp, m_head);
358
359 ifp->if_flags |= IFF_OACTIVE;
360
361 ifp->if_timer = 6;
362 }
363
364 Static int
365 cdce_encap(struct cdce_softc *sc, struct mbuf *m, int idx)
366 {
367 struct cdce_chain *c;
368 usbd_status err;
369 int extra = 0;
370
371 c = &sc->cdce_cdata.cdce_tx_chain[idx];
372
373 m_copydata(m, 0, m->m_pkthdr.len, c->cdce_buf);
374 if (sc->cdce_flags & CDCE_ZAURUS) {
375 /* Zaurus wants a 32-bit CRC appended to every frame */
376 uint32_t crc;
377
378 crc = htole32(~ether_crc32_le(c->cdce_buf, m->m_pkthdr.len));
379 memcpy(c->cdce_buf + m->m_pkthdr.len, &crc, sizeof(crc));
380 extra = sizeof(crc);
381 }
382 c->cdce_mbuf = m;
383
384 usbd_setup_xfer(c->cdce_xfer, sc->cdce_bulkout_pipe, c, c->cdce_buf,
385 m->m_pkthdr.len + extra, USBD_FORCE_SHORT_XFER | USBD_NO_COPY,
386 10000, cdce_txeof);
387 err = usbd_transfer(c->cdce_xfer);
388 if (err != USBD_IN_PROGRESS) {
389 cdce_stop(sc);
390 return (EIO);
391 }
392
393 sc->cdce_cdata.cdce_tx_cnt++;
394
395 return (0);
396 }
397
398 Static void
399 cdce_stop(struct cdce_softc *sc)
400 {
401 usbd_status err;
402 struct ifnet *ifp = GET_IFP(sc);
403 int i;
404
405 ifp->if_timer = 0;
406
407 if (sc->cdce_bulkin_pipe != NULL) {
408 err = usbd_abort_pipe(sc->cdce_bulkin_pipe);
409 if (err)
410 printf("%s: abort rx pipe failed: %s\n",
411 device_xname(sc->cdce_dev), usbd_errstr(err));
412 err = usbd_close_pipe(sc->cdce_bulkin_pipe);
413 if (err)
414 printf("%s: close rx pipe failed: %s\n",
415 device_xname(sc->cdce_dev), usbd_errstr(err));
416 sc->cdce_bulkin_pipe = NULL;
417 }
418
419 if (sc->cdce_bulkout_pipe != NULL) {
420 err = usbd_abort_pipe(sc->cdce_bulkout_pipe);
421 if (err)
422 printf("%s: abort tx pipe failed: %s\n",
423 device_xname(sc->cdce_dev), usbd_errstr(err));
424 err = usbd_close_pipe(sc->cdce_bulkout_pipe);
425 if (err)
426 printf("%s: close tx pipe failed: %s\n",
427 device_xname(sc->cdce_dev), usbd_errstr(err));
428 sc->cdce_bulkout_pipe = NULL;
429 }
430
431 for (i = 0; i < CDCE_RX_LIST_CNT; i++) {
432 if (sc->cdce_cdata.cdce_rx_chain[i].cdce_mbuf != NULL) {
433 m_freem(sc->cdce_cdata.cdce_rx_chain[i].cdce_mbuf);
434 sc->cdce_cdata.cdce_rx_chain[i].cdce_mbuf = NULL;
435 }
436 if (sc->cdce_cdata.cdce_rx_chain[i].cdce_xfer != NULL) {
437 usbd_free_xfer
438 (sc->cdce_cdata.cdce_rx_chain[i].cdce_xfer);
439 sc->cdce_cdata.cdce_rx_chain[i].cdce_xfer = NULL;
440 }
441 }
442
443 for (i = 0; i < CDCE_TX_LIST_CNT; i++) {
444 if (sc->cdce_cdata.cdce_tx_chain[i].cdce_mbuf != NULL) {
445 m_freem(sc->cdce_cdata.cdce_tx_chain[i].cdce_mbuf);
446 sc->cdce_cdata.cdce_tx_chain[i].cdce_mbuf = NULL;
447 }
448 if (sc->cdce_cdata.cdce_tx_chain[i].cdce_xfer != NULL) {
449 usbd_free_xfer(
450 sc->cdce_cdata.cdce_tx_chain[i].cdce_xfer);
451 sc->cdce_cdata.cdce_tx_chain[i].cdce_xfer = NULL;
452 }
453 }
454
455 ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
456 }
457
458 Static int
459 cdce_ioctl(struct ifnet *ifp, u_long command, void *data)
460 {
461 struct cdce_softc *sc = ifp->if_softc;
462 struct ifaddr *ifa = (struct ifaddr *)data;
463 struct ifreq *ifr = (struct ifreq *)data;
464 int s, error = 0;
465
466 if (sc->cdce_dying)
467 return (EIO);
468
469 s = splnet();
470
471 switch(command) {
472 case SIOCINITIFADDR:
473 ifp->if_flags |= IFF_UP;
474 cdce_init(sc);
475 switch (ifa->ifa_addr->sa_family) {
476 #ifdef INET
477 case AF_INET:
478 arp_ifinit(ifp, ifa);
479 break;
480 #endif /* INET */
481 }
482 break;
483
484 case SIOCSIFMTU:
485 if (ifr->ifr_mtu < ETHERMIN || ifr->ifr_mtu > ETHERMTU)
486 error = EINVAL;
487 else if ((error = ifioctl_common(ifp, command, data)) == ENETRESET)
488 error = 0;
489 break;
490
491 case SIOCSIFFLAGS:
492 if ((error = ifioctl_common(ifp, command, data)) != 0)
493 break;
494 /* XXX re-use ether_ioctl() */
495 switch (ifp->if_flags & (IFF_UP|IFF_RUNNING)) {
496 case IFF_UP:
497 cdce_init(sc);
498 break;
499 case IFF_RUNNING:
500 cdce_stop(sc);
501 break;
502 default:
503 break;
504 }
505 break;
506
507 default:
508 error = ether_ioctl(ifp, command, data);
509 break;
510 }
511
512 splx(s);
513
514 if (error == ENETRESET)
515 error = 0;
516
517 return (error);
518 }
519
520 Static void
521 cdce_watchdog(struct ifnet *ifp)
522 {
523 struct cdce_softc *sc = ifp->if_softc;
524
525 if (sc->cdce_dying)
526 return;
527
528 ifp->if_oerrors++;
529 printf("%s: watchdog timeout\n", device_xname(sc->cdce_dev));
530 }
531
532 Static void
533 cdce_init(void *xsc)
534 {
535 struct cdce_softc *sc = xsc;
536 struct ifnet *ifp = GET_IFP(sc);
537 struct cdce_chain *c;
538 usbd_status err;
539 int s, i;
540
541 if (ifp->if_flags & IFF_RUNNING)
542 return;
543
544 s = splnet();
545
546 if (cdce_tx_list_init(sc) == ENOBUFS) {
547 printf("%s: tx list init failed\n", device_xname(sc->cdce_dev));
548 splx(s);
549 return;
550 }
551
552 if (cdce_rx_list_init(sc) == ENOBUFS) {
553 printf("%s: rx list init failed\n", device_xname(sc->cdce_dev));
554 splx(s);
555 return;
556 }
557
558 /* Maybe set multicast / broadcast here??? */
559
560 err = usbd_open_pipe(sc->cdce_data_iface, sc->cdce_bulkin_no,
561 USBD_EXCLUSIVE_USE, &sc->cdce_bulkin_pipe);
562 if (err) {
563 printf("%s: open rx pipe failed: %s\n", device_xname(sc->cdce_dev),
564 usbd_errstr(err));
565 splx(s);
566 return;
567 }
568
569 err = usbd_open_pipe(sc->cdce_data_iface, sc->cdce_bulkout_no,
570 USBD_EXCLUSIVE_USE, &sc->cdce_bulkout_pipe);
571 if (err) {
572 printf("%s: open tx pipe failed: %s\n",
573 device_xname(sc->cdce_dev), usbd_errstr(err));
574 splx(s);
575 return;
576 }
577
578 for (i = 0; i < CDCE_RX_LIST_CNT; i++) {
579 c = &sc->cdce_cdata.cdce_rx_chain[i];
580 usbd_setup_xfer(c->cdce_xfer, sc->cdce_bulkin_pipe, c,
581 c->cdce_buf, CDCE_BUFSZ, USBD_SHORT_XFER_OK | USBD_NO_COPY,
582 USBD_NO_TIMEOUT, cdce_rxeof);
583 usbd_transfer(c->cdce_xfer);
584 }
585
586 ifp->if_flags |= IFF_RUNNING;
587 ifp->if_flags &= ~IFF_OACTIVE;
588
589 splx(s);
590 }
591
592 Static int
593 cdce_newbuf(struct cdce_softc *sc, struct cdce_chain *c, struct mbuf *m)
594 {
595 struct mbuf *m_new = NULL;
596
597 if (m == NULL) {
598 MGETHDR(m_new, M_DONTWAIT, MT_DATA);
599 if (m_new == NULL) {
600 printf("%s: no memory for rx list "
601 "-- packet dropped!\n", device_xname(sc->cdce_dev));
602 return (ENOBUFS);
603 }
604 MCLGET(m_new, M_DONTWAIT);
605 if (!(m_new->m_flags & M_EXT)) {
606 printf("%s: no memory for rx list "
607 "-- packet dropped!\n", device_xname(sc->cdce_dev));
608 m_freem(m_new);
609 return (ENOBUFS);
610 }
611 m_new->m_len = m_new->m_pkthdr.len = MCLBYTES;
612 } else {
613 m_new = m;
614 m_new->m_len = m_new->m_pkthdr.len = MCLBYTES;
615 m_new->m_data = m_new->m_ext.ext_buf;
616 }
617 c->cdce_mbuf = m_new;
618 return (0);
619 }
620
621 Static int
622 cdce_rx_list_init(struct cdce_softc *sc)
623 {
624 struct cdce_cdata *cd;
625 struct cdce_chain *c;
626 int i;
627
628 cd = &sc->cdce_cdata;
629 for (i = 0; i < CDCE_RX_LIST_CNT; i++) {
630 c = &cd->cdce_rx_chain[i];
631 c->cdce_sc = sc;
632 c->cdce_idx = i;
633 if (cdce_newbuf(sc, c, NULL) == ENOBUFS)
634 return (ENOBUFS);
635 if (c->cdce_xfer == NULL) {
636 c->cdce_xfer = usbd_alloc_xfer(sc->cdce_udev);
637 if (c->cdce_xfer == NULL)
638 return (ENOBUFS);
639 c->cdce_buf = usbd_alloc_buffer(c->cdce_xfer,
640 CDCE_BUFSZ);
641 if (c->cdce_buf == NULL)
642 return (ENOBUFS);
643 }
644 }
645
646 return (0);
647 }
648
649 Static int
650 cdce_tx_list_init(struct cdce_softc *sc)
651 {
652 struct cdce_cdata *cd;
653 struct cdce_chain *c;
654 int i;
655
656 cd = &sc->cdce_cdata;
657 for (i = 0; i < CDCE_TX_LIST_CNT; i++) {
658 c = &cd->cdce_tx_chain[i];
659 c->cdce_sc = sc;
660 c->cdce_idx = i;
661 c->cdce_mbuf = NULL;
662 if (c->cdce_xfer == NULL) {
663 c->cdce_xfer = usbd_alloc_xfer(sc->cdce_udev);
664 if (c->cdce_xfer == NULL)
665 return (ENOBUFS);
666 c->cdce_buf = usbd_alloc_buffer(c->cdce_xfer, CDCE_BUFSZ);
667 if (c->cdce_buf == NULL)
668 return (ENOBUFS);
669 }
670 }
671
672 return (0);
673 }
674
675 Static void
676 cdce_rxeof(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status)
677 {
678 struct cdce_chain *c = priv;
679 struct cdce_softc *sc = c->cdce_sc;
680 struct ifnet *ifp = GET_IFP(sc);
681 struct mbuf *m;
682 int total_len = 0;
683 int s;
684
685 if (sc->cdce_dying || !(ifp->if_flags & IFF_RUNNING))
686 return;
687
688 if (status != USBD_NORMAL_COMPLETION) {
689 if (status == USBD_NOT_STARTED || status == USBD_CANCELLED)
690 return;
691 if (sc->cdce_rxeof_errors == 0)
692 printf("%s: usb error on rx: %s\n",
693 device_xname(sc->cdce_dev), usbd_errstr(status));
694 if (status == USBD_STALLED)
695 usbd_clear_endpoint_stall_async(sc->cdce_bulkin_pipe);
696 DELAY(sc->cdce_rxeof_errors * 10000);
697 sc->cdce_rxeof_errors++;
698 goto done;
699 }
700
701 sc->cdce_rxeof_errors = 0;
702
703 usbd_get_xfer_status(xfer, NULL, NULL, &total_len, NULL);
704 if (sc->cdce_flags & CDCE_ZAURUS)
705 total_len -= 4; /* Strip off CRC added by Zaurus */
706 if (total_len <= 1)
707 goto done;
708
709 m = c->cdce_mbuf;
710 memcpy(mtod(m, char *), c->cdce_buf, total_len);
711
712 if (total_len < sizeof(struct ether_header)) {
713 ifp->if_ierrors++;
714 goto done;
715 }
716
717 ifp->if_ipackets++;
718 m->m_pkthdr.len = m->m_len = total_len;
719 m->m_pkthdr.rcvif = ifp;
720
721 s = splnet();
722
723 if (cdce_newbuf(sc, c, NULL) == ENOBUFS) {
724 ifp->if_ierrors++;
725 goto done1;
726 }
727
728 bpf_mtap(ifp, m);
729
730 (*(ifp)->if_input)((ifp), (m));
731
732 done1:
733 splx(s);
734
735 done:
736 /* Setup new transfer. */
737 usbd_setup_xfer(c->cdce_xfer, sc->cdce_bulkin_pipe, c, c->cdce_buf,
738 CDCE_BUFSZ, USBD_SHORT_XFER_OK | USBD_NO_COPY, USBD_NO_TIMEOUT,
739 cdce_rxeof);
740 usbd_transfer(c->cdce_xfer);
741 }
742
743 Static void
744 cdce_txeof(usbd_xfer_handle xfer, usbd_private_handle priv,
745 usbd_status status)
746 {
747 struct cdce_chain *c = priv;
748 struct cdce_softc *sc = c->cdce_sc;
749 struct ifnet *ifp = GET_IFP(sc);
750 usbd_status err;
751 int s;
752
753 if (sc->cdce_dying)
754 return;
755
756 s = splnet();
757
758 ifp->if_timer = 0;
759 ifp->if_flags &= ~IFF_OACTIVE;
760
761 if (status != USBD_NORMAL_COMPLETION) {
762 if (status == USBD_NOT_STARTED || status == USBD_CANCELLED) {
763 splx(s);
764 return;
765 }
766 ifp->if_oerrors++;
767 printf("%s: usb error on tx: %s\n", device_xname(sc->cdce_dev),
768 usbd_errstr(status));
769 if (status == USBD_STALLED)
770 usbd_clear_endpoint_stall_async(sc->cdce_bulkout_pipe);
771 splx(s);
772 return;
773 }
774
775 usbd_get_xfer_status(c->cdce_xfer, NULL, NULL, NULL, &err);
776
777 if (c->cdce_mbuf != NULL) {
778 m_freem(c->cdce_mbuf);
779 c->cdce_mbuf = NULL;
780 }
781
782 if (err)
783 ifp->if_oerrors++;
784 else
785 ifp->if_opackets++;
786
787 if (IFQ_IS_EMPTY(&ifp->if_snd) == 0)
788 cdce_start(ifp);
789
790 splx(s);
791 }
792
793 int
794 cdce_activate(device_t self, enum devact act)
795 {
796 struct cdce_softc *sc = device_private(self);
797
798 switch (act) {
799 case DVACT_DEACTIVATE:
800 if_deactivate(GET_IFP(sc));
801 sc->cdce_dying = 1;
802 return 0;
803 default:
804 return EOPNOTSUPP;
805 }
806 }
807