if_upl.c revision 1.47.2.1
1 /* $NetBSD: if_upl.c,v 1.47.2.1 2017/04/05 19:54:19 snj Exp $ */ 2 /* 3 * Copyright (c) 2000 The NetBSD Foundation, Inc. 4 * All rights reserved. 5 * 6 * This code is derived from software contributed to The NetBSD Foundation 7 * by Lennart Augustsson (lennart (at) augustsson.net) at 8 * Carlstedt Research & Technology. 9 * 10 * Redistribution and use in source and binary forms, with or without 11 * modification, are permitted provided that the following conditions 12 * are met: 13 * 1. Redistributions of source code must retain the above copyright 14 * notice, this list of conditions and the following disclaimer. 15 * 2. Redistributions in binary form must reproduce the above copyright 16 * notice, this list of conditions and the following disclaimer in the 17 * documentation and/or other materials provided with the distribution. 18 * 19 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 21 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 22 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 23 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 24 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 25 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 26 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 27 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 28 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 29 * POSSIBILITY OF SUCH DAMAGE. 30 */ 31 32 /* 33 * Prolific PL2301/PL2302 driver 34 */ 35 36 #include <sys/cdefs.h> 37 __KERNEL_RCSID(0, "$NetBSD: if_upl.c,v 1.47.2.1 2017/04/05 19:54:19 snj Exp $"); 38 39 #ifdef _KERNEL_OPT 40 #include "opt_inet.h" 41 #include "opt_usb.h" 42 #endif 43 44 #include <sys/param.h> 45 #include <sys/systm.h> 46 #include <sys/callout.h> 47 #include <sys/sockio.h> 48 #include <sys/mbuf.h> 49 #include <sys/kernel.h> 50 #include <sys/socket.h> 51 52 #include <sys/device.h> 53 #include <sys/rnd.h> 54 55 #include <net/if.h> 56 #include <net/if_types.h> 57 #include <net/if_dl.h> 58 #include <net/netisr.h> 59 60 #include <net/bpf.h> 61 62 #ifdef INET 63 #include <netinet/in.h> 64 #include <netinet/in_var.h> 65 #include <netinet/if_inarp.h> 66 #endif 67 68 69 #include <dev/usb/usb.h> 70 #include <dev/usb/usbdi.h> 71 #include <dev/usb/usbdi_util.h> 72 #include <dev/usb/usbdevs.h> 73 74 /* 75 * 7 6 5 4 3 2 1 0 76 * tx rx 1 0 77 * 1110 0000 rxdata 78 * 1010 0000 idle 79 * 0010 0000 tx over 80 * 0110 tx over + rxd 81 */ 82 83 #define UPL_RXDATA 0x40 84 #define UPL_TXOK 0x80 85 86 #define UPL_INTR_PKTLEN 1 87 88 #define UPL_CONFIG_NO 1 89 #define UPL_IFACE_IDX 0 90 91 /***/ 92 93 #define UPL_INTR_INTERVAL 20 94 95 #define UPL_BUFSZ 1024 96 97 #define UPL_RX_FRAMES 1 98 #define UPL_TX_FRAMES 1 99 100 #define UPL_RX_LIST_CNT 1 101 #define UPL_TX_LIST_CNT 1 102 103 #define UPL_ENDPT_RX 0x0 104 #define UPL_ENDPT_TX 0x1 105 #define UPL_ENDPT_INTR 0x2 106 #define UPL_ENDPT_MAX 0x3 107 108 struct upl_type { 109 uint16_t upl_vid; 110 uint16_t upl_did; 111 }; 112 113 struct upl_softc; 114 115 struct upl_chain { 116 struct upl_softc *upl_sc; 117 struct usbd_xfer *upl_xfer; 118 char *upl_buf; 119 struct mbuf *upl_mbuf; 120 int upl_idx; 121 }; 122 123 struct upl_cdata { 124 struct upl_chain upl_tx_chain[UPL_TX_LIST_CNT]; 125 struct upl_chain upl_rx_chain[UPL_RX_LIST_CNT]; 126 int upl_tx_prod; 127 int upl_tx_cons; 128 int upl_tx_cnt; 129 int upl_rx_prod; 130 }; 131 132 struct upl_softc { 133 device_t sc_dev; 134 135 struct ifnet sc_if; 136 krndsource_t sc_rnd_source; 137 138 struct callout sc_stat_ch; 139 140 struct usbd_device * sc_udev; 141 struct usbd_interface * sc_iface; 142 uint16_t sc_vendor; 143 uint16_t sc_product; 144 int sc_ed[UPL_ENDPT_MAX]; 145 struct usbd_pipe * sc_ep[UPL_ENDPT_MAX]; 146 struct upl_cdata sc_cdata; 147 148 uByte sc_ibuf; 149 150 char sc_dying; 151 char sc_attached; 152 u_int sc_rx_errs; 153 struct timeval sc_rx_notice; 154 u_int sc_intr_errs; 155 }; 156 157 #ifdef UPL_DEBUG 158 #define DPRINTF(x) if (upldebug) printf x 159 #define DPRINTFN(n,x) if (upldebug >= (n)) printf x 160 int upldebug = 0; 161 #else 162 #define DPRINTF(x) 163 #define DPRINTFN(n,x) 164 #endif 165 166 /* 167 * Various supported device vendors/products. 168 */ 169 Static struct upl_type sc_devs[] = { 170 { USB_VENDOR_PROLIFIC, USB_PRODUCT_PROLIFIC_PL2301 }, 171 { USB_VENDOR_PROLIFIC, USB_PRODUCT_PROLIFIC_PL2302 }, 172 { 0, 0 } 173 }; 174 175 int upl_match(device_t, cfdata_t, void *); 176 void upl_attach(device_t, device_t, void *); 177 int upl_detach(device_t, int); 178 int upl_activate(device_t, enum devact); 179 extern struct cfdriver upl_cd; 180 CFATTACH_DECL_NEW(upl, sizeof(struct upl_softc), upl_match, upl_attach, 181 upl_detach, upl_activate); 182 183 Static int upl_openpipes(struct upl_softc *); 184 Static int upl_tx_list_init(struct upl_softc *); 185 Static int upl_rx_list_init(struct upl_softc *); 186 Static int upl_newbuf(struct upl_softc *, struct upl_chain *, struct mbuf *); 187 Static int upl_send(struct upl_softc *, struct mbuf *, int); 188 Static void upl_intr(struct usbd_xfer *, void *, usbd_status); 189 Static void upl_rxeof(struct usbd_xfer *, void *, usbd_status); 190 Static void upl_txeof(struct usbd_xfer *, void *, usbd_status); 191 Static void upl_start(struct ifnet *); 192 Static int upl_ioctl(struct ifnet *, u_long, void *); 193 Static void upl_init(void *); 194 Static void upl_stop(struct upl_softc *); 195 Static void upl_watchdog(struct ifnet *); 196 197 Static int upl_output(struct ifnet *, struct mbuf *, const struct sockaddr *, 198 struct rtentry *); 199 Static void upl_input(struct ifnet *, struct mbuf *); 200 201 /* 202 * Probe for a Prolific chip. 203 */ 204 int 205 upl_match(device_t parent, cfdata_t match, void *aux) 206 { 207 struct usb_attach_arg *uaa = aux; 208 struct upl_type *t; 209 210 for (t = sc_devs; t->upl_vid != 0; t++) 211 if (uaa->uaa_vendor == t->upl_vid && uaa->uaa_product == t->upl_did) 212 return UMATCH_VENDOR_PRODUCT; 213 214 return UMATCH_NONE; 215 } 216 217 void 218 upl_attach(device_t parent, device_t self, void *aux) 219 { 220 struct upl_softc *sc = device_private(self); 221 struct usb_attach_arg *uaa = aux; 222 char *devinfop; 223 int s; 224 struct usbd_device * dev = uaa->uaa_device; 225 struct usbd_interface * iface; 226 usbd_status err; 227 struct ifnet *ifp; 228 usb_interface_descriptor_t *id; 229 usb_endpoint_descriptor_t *ed; 230 int i; 231 232 DPRINTFN(5,(" : upl_attach: sc=%p, dev=%p", sc, dev)); 233 234 sc->sc_dev = self; 235 236 aprint_naive("\n"); 237 aprint_normal("\n"); 238 239 devinfop = usbd_devinfo_alloc(dev, 0); 240 aprint_normal_dev(self, "%s\n", devinfop); 241 usbd_devinfo_free(devinfop); 242 243 err = usbd_set_config_no(dev, UPL_CONFIG_NO, 1); 244 if (err) { 245 aprint_error_dev(self, "failed to set configuration" 246 ", err=%s\n", usbd_errstr(err)); 247 return; 248 } 249 250 sc->sc_udev = dev; 251 sc->sc_product = uaa->uaa_product; 252 sc->sc_vendor = uaa->uaa_vendor; 253 254 err = usbd_device2interface_handle(dev, UPL_IFACE_IDX, &iface); 255 if (err) { 256 aprint_error_dev(self, "getting interface handle failed\n"); 257 return; 258 } 259 260 sc->sc_iface = iface; 261 id = usbd_get_interface_descriptor(iface); 262 263 /* Find endpoints. */ 264 for (i = 0; i < id->bNumEndpoints; i++) { 265 ed = usbd_interface2endpoint_descriptor(iface, i); 266 if (ed == NULL) { 267 aprint_error_dev(self, "couldn't get ep %d\n", i); 268 return; 269 } 270 if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN && 271 UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) { 272 sc->sc_ed[UPL_ENDPT_RX] = ed->bEndpointAddress; 273 } else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT && 274 UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) { 275 sc->sc_ed[UPL_ENDPT_TX] = ed->bEndpointAddress; 276 } else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN && 277 UE_GET_XFERTYPE(ed->bmAttributes) == UE_INTERRUPT) { 278 sc->sc_ed[UPL_ENDPT_INTR] = ed->bEndpointAddress; 279 } 280 } 281 282 if (sc->sc_ed[UPL_ENDPT_RX] == 0 || sc->sc_ed[UPL_ENDPT_TX] == 0 || 283 sc->sc_ed[UPL_ENDPT_INTR] == 0) { 284 aprint_error_dev(self, "missing endpoint\n"); 285 return; 286 } 287 288 s = splnet(); 289 290 /* Initialize interface info.*/ 291 ifp = &sc->sc_if; 292 ifp->if_softc = sc; 293 ifp->if_mtu = UPL_BUFSZ; 294 ifp->if_flags = IFF_POINTOPOINT | IFF_NOARP | IFF_SIMPLEX; 295 ifp->if_ioctl = upl_ioctl; 296 ifp->if_start = upl_start; 297 ifp->if_watchdog = upl_watchdog; 298 strncpy(ifp->if_xname, device_xname(sc->sc_dev), IFNAMSIZ); 299 300 ifp->if_type = IFT_OTHER; 301 ifp->if_addrlen = 0; 302 ifp->if_hdrlen = 0; 303 ifp->if_output = upl_output; 304 ifp->if_input = upl_input; 305 ifp->if_baudrate = 12000000; 306 ifp->if_dlt = DLT_RAW; 307 IFQ_SET_READY(&ifp->if_snd); 308 309 /* Attach the interface. */ 310 if_attach(ifp); 311 if_alloc_sadl(ifp); 312 313 bpf_attach(ifp, DLT_RAW, 0); 314 rnd_attach_source(&sc->sc_rnd_source, device_xname(sc->sc_dev), 315 RND_TYPE_NET, RND_FLAG_DEFAULT); 316 317 sc->sc_attached = 1; 318 splx(s); 319 320 usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev, sc->sc_dev); 321 322 return; 323 } 324 325 int 326 upl_detach(device_t self, int flags) 327 { 328 struct upl_softc *sc = device_private(self); 329 struct ifnet *ifp = &sc->sc_if; 330 int s; 331 332 DPRINTFN(2,("%s: %s: enter\n", device_xname(sc->sc_dev), __func__)); 333 334 s = splusb(); 335 336 if (!sc->sc_attached) { 337 /* Detached before attached finished, so just bail out. */ 338 splx(s); 339 return 0; 340 } 341 342 if (ifp->if_flags & IFF_RUNNING) 343 upl_stop(sc); 344 345 rnd_detach_source(&sc->sc_rnd_source); 346 bpf_detach(ifp); 347 348 if_detach(ifp); 349 350 #ifdef DIAGNOSTIC 351 if (sc->sc_ep[UPL_ENDPT_TX] != NULL || 352 sc->sc_ep[UPL_ENDPT_RX] != NULL || 353 sc->sc_ep[UPL_ENDPT_INTR] != NULL) 354 aprint_debug_dev(self, "detach has active endpoints\n"); 355 #endif 356 357 sc->sc_attached = 0; 358 splx(s); 359 360 usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev, sc->sc_dev); 361 362 return 0; 363 } 364 365 int 366 upl_activate(device_t self, enum devact act) 367 { 368 struct upl_softc *sc = device_private(self); 369 370 DPRINTFN(2,("%s: %s: enter\n", device_xname(sc->sc_dev), __func__)); 371 372 switch (act) { 373 case DVACT_DEACTIVATE: 374 /* Deactivate the interface. */ 375 if_deactivate(&sc->sc_if); 376 sc->sc_dying = 1; 377 return 0; 378 default: 379 return EOPNOTSUPP; 380 } 381 } 382 383 /* 384 * Initialize an RX descriptor and attach an MBUF cluster. 385 */ 386 Static int 387 upl_newbuf(struct upl_softc *sc, struct upl_chain *c, struct mbuf *m) 388 { 389 struct mbuf *m_new = NULL; 390 391 DPRINTFN(8,("%s: %s: enter\n", device_xname(sc->sc_dev), __func__)); 392 393 if (m == NULL) { 394 MGETHDR(m_new, M_DONTWAIT, MT_DATA); 395 if (m_new == NULL) { 396 printf("%s: no memory for rx list " 397 "-- packet dropped!\n", device_xname(sc->sc_dev)); 398 return ENOBUFS; 399 } 400 401 MCLGET(m_new, M_DONTWAIT); 402 if (!(m_new->m_flags & M_EXT)) { 403 printf("%s: no memory for rx list " 404 "-- packet dropped!\n", device_xname(sc->sc_dev)); 405 m_freem(m_new); 406 return ENOBUFS; 407 } 408 m_new->m_len = m_new->m_pkthdr.len = MCLBYTES; 409 } else { 410 m_new = m; 411 m_new->m_len = m_new->m_pkthdr.len = MCLBYTES; 412 m_new->m_data = m_new->m_ext.ext_buf; 413 } 414 415 c->upl_mbuf = m_new; 416 417 return 0; 418 } 419 420 Static int 421 upl_rx_list_init(struct upl_softc *sc) 422 { 423 struct upl_cdata *cd; 424 struct upl_chain *c; 425 int i; 426 427 DPRINTFN(5,("%s: %s: enter\n", device_xname(sc->sc_dev), __func__)); 428 429 cd = &sc->sc_cdata; 430 for (i = 0; i < UPL_RX_LIST_CNT; i++) { 431 c = &cd->upl_rx_chain[i]; 432 c->upl_sc = sc; 433 c->upl_idx = i; 434 if (upl_newbuf(sc, c, NULL) == ENOBUFS) 435 return ENOBUFS; 436 if (c->upl_xfer == NULL) { 437 int error = usbd_create_xfer(sc->sc_ep[UPL_ENDPT_RX], 438 UPL_BUFSZ, USBD_SHORT_XFER_OK, 0, &c->upl_xfer); 439 if (error) 440 return error; 441 c->upl_buf = usbd_get_buffer(c->upl_xfer); 442 } 443 } 444 445 return 0; 446 } 447 448 Static int 449 upl_tx_list_init(struct upl_softc *sc) 450 { 451 struct upl_cdata *cd; 452 struct upl_chain *c; 453 int i; 454 455 DPRINTFN(5,("%s: %s: enter\n", device_xname(sc->sc_dev), __func__)); 456 457 cd = &sc->sc_cdata; 458 for (i = 0; i < UPL_TX_LIST_CNT; i++) { 459 c = &cd->upl_tx_chain[i]; 460 c->upl_sc = sc; 461 c->upl_idx = i; 462 c->upl_mbuf = NULL; 463 if (c->upl_xfer == NULL) { 464 int error = usbd_create_xfer(sc->sc_ep[UPL_ENDPT_TX], 465 UPL_BUFSZ, 0, 0, &c->upl_xfer); 466 if (error) 467 return error; 468 c->upl_buf = usbd_get_buffer(c->upl_xfer); 469 } 470 } 471 472 return 0; 473 } 474 475 /* 476 * A frame has been uploaded: pass the resulting mbuf chain up to 477 * the higher level protocols. 478 */ 479 Static void 480 upl_rxeof(struct usbd_xfer *xfer, void *priv, usbd_status status) 481 { 482 struct upl_chain *c = priv; 483 struct upl_softc *sc = c->upl_sc; 484 struct ifnet *ifp = &sc->sc_if; 485 struct mbuf *m; 486 int total_len = 0; 487 int s; 488 489 if (sc->sc_dying) 490 return; 491 492 if (!(ifp->if_flags & IFF_RUNNING)) 493 return; 494 495 if (status != USBD_NORMAL_COMPLETION) { 496 if (status == USBD_NOT_STARTED || status == USBD_CANCELLED) 497 return; 498 sc->sc_rx_errs++; 499 if (usbd_ratecheck(&sc->sc_rx_notice)) { 500 printf("%s: %u usb errors on rx: %s\n", 501 device_xname(sc->sc_dev), sc->sc_rx_errs, 502 usbd_errstr(status)); 503 sc->sc_rx_errs = 0; 504 } 505 if (status == USBD_STALLED) 506 usbd_clear_endpoint_stall_async(sc->sc_ep[UPL_ENDPT_RX]); 507 goto done; 508 } 509 510 usbd_get_xfer_status(xfer, NULL, NULL, &total_len, NULL); 511 512 DPRINTFN(9,("%s: %s: enter status=%d length=%d\n", 513 device_xname(sc->sc_dev), __func__, status, total_len)); 514 515 m = c->upl_mbuf; 516 memcpy(mtod(c->upl_mbuf, char *), c->upl_buf, total_len); 517 518 ifp->if_ipackets++; 519 m->m_pkthdr.len = m->m_len = total_len; 520 521 m->m_pkthdr.rcvif = ifp; 522 523 s = splnet(); 524 525 /* XXX ugly */ 526 if (upl_newbuf(sc, c, NULL) == ENOBUFS) { 527 ifp->if_ierrors++; 528 goto done1; 529 } 530 531 /* 532 * Handle BPF listeners. Let the BPF user see the packet, but 533 * don't pass it up to the ether_input() layer unless it's 534 * a broadcast packet, multicast packet, matches our ethernet 535 * address or the interface is in promiscuous mode. 536 */ 537 bpf_mtap(ifp, m); 538 539 DPRINTFN(10,("%s: %s: deliver %d\n", device_xname(sc->sc_dev), 540 __func__, m->m_len)); 541 542 (*(ifp)->if_input)((ifp), (m)); 543 544 done1: 545 splx(s); 546 547 done: 548 #if 1 549 /* Setup new transfer. */ 550 usbd_setup_xfer(c->upl_xfer, c, c->upl_buf, UPL_BUFSZ, 551 USBD_SHORT_XFER_OK, USBD_NO_TIMEOUT, upl_rxeof); 552 usbd_transfer(c->upl_xfer); 553 554 DPRINTFN(10,("%s: %s: start rx\n", device_xname(sc->sc_dev), 555 __func__)); 556 #endif 557 } 558 559 /* 560 * A frame was downloaded to the chip. It's safe for us to clean up 561 * the list buffers. 562 */ 563 Static void 564 upl_txeof(struct usbd_xfer *xfer, void *priv, 565 usbd_status status) 566 { 567 struct upl_chain *c = priv; 568 struct upl_softc *sc = c->upl_sc; 569 struct ifnet *ifp = &sc->sc_if; 570 int s; 571 572 if (sc->sc_dying) 573 return; 574 575 s = splnet(); 576 577 DPRINTFN(10,("%s: %s: enter status=%d\n", device_xname(sc->sc_dev), 578 __func__, status)); 579 580 ifp->if_timer = 0; 581 ifp->if_flags &= ~IFF_OACTIVE; 582 583 if (status != USBD_NORMAL_COMPLETION) { 584 if (status == USBD_NOT_STARTED || status == USBD_CANCELLED) { 585 splx(s); 586 return; 587 } 588 ifp->if_oerrors++; 589 printf("%s: usb error on tx: %s\n", device_xname(sc->sc_dev), 590 usbd_errstr(status)); 591 if (status == USBD_STALLED) 592 usbd_clear_endpoint_stall_async(sc->sc_ep[UPL_ENDPT_TX]); 593 splx(s); 594 return; 595 } 596 597 ifp->if_opackets++; 598 599 m_freem(c->upl_mbuf); 600 c->upl_mbuf = NULL; 601 602 if (IFQ_IS_EMPTY(&ifp->if_snd) == 0) 603 upl_start(ifp); 604 605 splx(s); 606 } 607 608 Static int 609 upl_send(struct upl_softc *sc, struct mbuf *m, int idx) 610 { 611 int total_len; 612 struct upl_chain *c; 613 usbd_status err; 614 615 c = &sc->sc_cdata.upl_tx_chain[idx]; 616 617 /* 618 * Copy the mbuf data into a contiguous buffer, leaving two 619 * bytes at the beginning to hold the frame length. 620 */ 621 m_copydata(m, 0, m->m_pkthdr.len, c->upl_buf); 622 c->upl_mbuf = m; 623 624 total_len = m->m_pkthdr.len; 625 626 DPRINTFN(10,("%s: %s: total_len=%d\n", 627 device_xname(sc->sc_dev), __func__, total_len)); 628 629 usbd_setup_xfer(c->upl_xfer, c, c->upl_buf, total_len, 0, 630 USBD_DEFAULT_TIMEOUT, upl_txeof); 631 632 /* Transmit */ 633 err = usbd_transfer(c->upl_xfer); 634 if (err != USBD_IN_PROGRESS) { 635 printf("%s: upl_send error=%s\n", device_xname(sc->sc_dev), 636 usbd_errstr(err)); 637 upl_stop(sc); 638 return EIO; 639 } 640 641 sc->sc_cdata.upl_tx_cnt++; 642 643 return 0; 644 } 645 646 Static void 647 upl_start(struct ifnet *ifp) 648 { 649 struct upl_softc *sc = ifp->if_softc; 650 struct mbuf *m_head = NULL; 651 652 if (sc->sc_dying) 653 return; 654 655 DPRINTFN(10,("%s: %s: enter\n", device_xname(sc->sc_dev),__func__)); 656 657 if (ifp->if_flags & IFF_OACTIVE) 658 return; 659 660 IFQ_POLL(&ifp->if_snd, m_head); 661 if (m_head == NULL) 662 return; 663 664 if (upl_send(sc, m_head, 0)) { 665 ifp->if_flags |= IFF_OACTIVE; 666 return; 667 } 668 669 IFQ_DEQUEUE(&ifp->if_snd, m_head); 670 671 /* 672 * If there's a BPF listener, bounce a copy of this frame 673 * to him. 674 */ 675 bpf_mtap(ifp, m_head); 676 677 ifp->if_flags |= IFF_OACTIVE; 678 679 /* 680 * Set a timeout in case the chip goes out to lunch. 681 */ 682 ifp->if_timer = 5; 683 } 684 685 Static void 686 upl_init(void *xsc) 687 { 688 struct upl_softc *sc = xsc; 689 struct ifnet *ifp = &sc->sc_if; 690 int s; 691 692 if (sc->sc_dying) 693 return; 694 695 DPRINTFN(10,("%s: %s: enter\n", device_xname(sc->sc_dev),__func__)); 696 697 if (ifp->if_flags & IFF_RUNNING) 698 return; 699 700 s = splnet(); 701 702 if (sc->sc_ep[UPL_ENDPT_RX] == NULL) { 703 if (upl_openpipes(sc)) { 704 splx(s); 705 return; 706 } 707 } 708 /* Init TX ring. */ 709 if (upl_tx_list_init(sc)) { 710 printf("%s: tx list init failed\n", device_xname(sc->sc_dev)); 711 splx(s); 712 return; 713 } 714 715 /* Init RX ring. */ 716 if (upl_rx_list_init(sc)) { 717 printf("%s: rx list init failed\n", device_xname(sc->sc_dev)); 718 splx(s); 719 return; 720 } 721 722 /* Start up the receive pipe. */ 723 for (int i = 0; i < UPL_RX_LIST_CNT; i++) { 724 struct upl_chain *c = &sc->sc_cdata.upl_rx_chain[i]; 725 usbd_setup_xfer(c->upl_xfer, c, c->upl_buf, UPL_BUFSZ, 726 USBD_SHORT_XFER_OK, USBD_NO_TIMEOUT, 727 upl_rxeof); 728 usbd_transfer(c->upl_xfer); 729 } 730 731 ifp->if_flags |= IFF_RUNNING; 732 ifp->if_flags &= ~IFF_OACTIVE; 733 734 splx(s); 735 } 736 737 Static int 738 upl_openpipes(struct upl_softc *sc) 739 { 740 usbd_status err; 741 742 /* Open RX and TX pipes. */ 743 err = usbd_open_pipe(sc->sc_iface, sc->sc_ed[UPL_ENDPT_RX], 744 USBD_EXCLUSIVE_USE, &sc->sc_ep[UPL_ENDPT_RX]); 745 if (err) { 746 printf("%s: open rx pipe failed: %s\n", 747 device_xname(sc->sc_dev), usbd_errstr(err)); 748 return EIO; 749 } 750 err = usbd_open_pipe(sc->sc_iface, sc->sc_ed[UPL_ENDPT_TX], 751 USBD_EXCLUSIVE_USE, &sc->sc_ep[UPL_ENDPT_TX]); 752 if (err) { 753 printf("%s: open tx pipe failed: %s\n", 754 device_xname(sc->sc_dev), usbd_errstr(err)); 755 return EIO; 756 } 757 err = usbd_open_pipe_intr(sc->sc_iface, sc->sc_ed[UPL_ENDPT_INTR], 758 USBD_EXCLUSIVE_USE, &sc->sc_ep[UPL_ENDPT_INTR], sc, 759 &sc->sc_ibuf, UPL_INTR_PKTLEN, upl_intr, 760 UPL_INTR_INTERVAL); 761 if (err) { 762 printf("%s: open intr pipe failed: %s\n", 763 device_xname(sc->sc_dev), usbd_errstr(err)); 764 return EIO; 765 } 766 767 return 0; 768 } 769 770 Static void 771 upl_intr(struct usbd_xfer *xfer, void *priv, 772 usbd_status status) 773 { 774 struct upl_softc *sc = priv; 775 struct ifnet *ifp = &sc->sc_if; 776 uByte stat; 777 778 DPRINTFN(15,("%s: %s: enter\n", device_xname(sc->sc_dev),__func__)); 779 780 if (sc->sc_dying) 781 return; 782 783 if (!(ifp->if_flags & IFF_RUNNING)) 784 return; 785 786 if (status != USBD_NORMAL_COMPLETION) { 787 if (status == USBD_NOT_STARTED || status == USBD_CANCELLED) { 788 return; 789 } 790 sc->sc_intr_errs++; 791 if (usbd_ratecheck(&sc->sc_rx_notice)) { 792 printf("%s: %u usb errors on intr: %s\n", 793 device_xname(sc->sc_dev), sc->sc_rx_errs, 794 usbd_errstr(status)); 795 sc->sc_intr_errs = 0; 796 } 797 if (status == USBD_STALLED) 798 usbd_clear_endpoint_stall_async(sc->sc_ep[UPL_ENDPT_RX]); 799 return; 800 } 801 802 stat = sc->sc_ibuf; 803 804 if (stat == 0) 805 return; 806 807 DPRINTFN(10,("%s: %s: stat=0x%02x\n", device_xname(sc->sc_dev), 808 __func__, stat)); 809 810 } 811 812 Static int 813 upl_ioctl(struct ifnet *ifp, u_long command, void *data) 814 { 815 struct upl_softc *sc = ifp->if_softc; 816 struct ifaddr *ifa = (struct ifaddr *)data; 817 struct ifreq *ifr = (struct ifreq *)data; 818 int s, error = 0; 819 820 if (sc->sc_dying) 821 return EIO; 822 823 DPRINTFN(5,("%s: %s: cmd=0x%08lx\n", 824 device_xname(sc->sc_dev), __func__, command)); 825 826 s = splnet(); 827 828 switch(command) { 829 case SIOCINITIFADDR: 830 ifp->if_flags |= IFF_UP; 831 upl_init(sc); 832 833 switch (ifa->ifa_addr->sa_family) { 834 #ifdef INET 835 case AF_INET: 836 break; 837 #endif /* INET */ 838 } 839 break; 840 841 case SIOCSIFMTU: 842 if (ifr->ifr_mtu > UPL_BUFSZ) 843 error = EINVAL; 844 else if ((error = ifioctl_common(ifp, command, data)) == ENETRESET) 845 error = 0; 846 break; 847 848 case SIOCSIFFLAGS: 849 if ((error = ifioctl_common(ifp, command, data)) != 0) 850 break; 851 /* XXX re-use ether_ioctl() */ 852 switch (ifp->if_flags & (IFF_UP|IFF_RUNNING)) { 853 case IFF_UP: 854 upl_init(sc); 855 break; 856 case IFF_RUNNING: 857 upl_stop(sc); 858 break; 859 default: 860 break; 861 } 862 break; 863 default: 864 error = ifioctl_common(ifp, command, data); 865 break; 866 } 867 868 splx(s); 869 870 return error; 871 } 872 873 Static void 874 upl_watchdog(struct ifnet *ifp) 875 { 876 struct upl_softc *sc = ifp->if_softc; 877 878 DPRINTFN(5,("%s: %s: enter\n", device_xname(sc->sc_dev),__func__)); 879 880 if (sc->sc_dying) 881 return; 882 883 ifp->if_oerrors++; 884 printf("%s: watchdog timeout\n", device_xname(sc->sc_dev)); 885 886 upl_stop(sc); 887 upl_init(sc); 888 889 if (IFQ_IS_EMPTY(&ifp->if_snd) == 0) 890 upl_start(ifp); 891 } 892 893 /* 894 * Stop the adapter and free any mbufs allocated to the 895 * RX and TX lists. 896 */ 897 Static void 898 upl_stop(struct upl_softc *sc) 899 { 900 usbd_status err; 901 struct ifnet *ifp; 902 int i; 903 904 DPRINTFN(10,("%s: %s: enter\n", device_xname(sc->sc_dev),__func__)); 905 906 ifp = &sc->sc_if; 907 ifp->if_timer = 0; 908 909 /* Stop transfers. */ 910 if (sc->sc_ep[UPL_ENDPT_RX] != NULL) { 911 err = usbd_abort_pipe(sc->sc_ep[UPL_ENDPT_RX]); 912 if (err) { 913 printf("%s: abort rx pipe failed: %s\n", 914 device_xname(sc->sc_dev), usbd_errstr(err)); 915 } 916 } 917 918 if (sc->sc_ep[UPL_ENDPT_TX] != NULL) { 919 err = usbd_abort_pipe(sc->sc_ep[UPL_ENDPT_TX]); 920 if (err) { 921 printf("%s: abort tx pipe failed: %s\n", 922 device_xname(sc->sc_dev), usbd_errstr(err)); 923 } 924 } 925 926 if (sc->sc_ep[UPL_ENDPT_INTR] != NULL) { 927 err = usbd_abort_pipe(sc->sc_ep[UPL_ENDPT_INTR]); 928 if (err) { 929 printf("%s: abort intr pipe failed: %s\n", 930 device_xname(sc->sc_dev), usbd_errstr(err)); 931 } 932 } 933 934 /* Free RX resources. */ 935 for (i = 0; i < UPL_RX_LIST_CNT; i++) { 936 if (sc->sc_cdata.upl_rx_chain[i].upl_mbuf != NULL) { 937 m_freem(sc->sc_cdata.upl_rx_chain[i].upl_mbuf); 938 sc->sc_cdata.upl_rx_chain[i].upl_mbuf = NULL; 939 } 940 } 941 942 /* Free TX resources. */ 943 for (i = 0; i < UPL_TX_LIST_CNT; i++) { 944 if (sc->sc_cdata.upl_tx_chain[i].upl_mbuf != NULL) { 945 m_freem(sc->sc_cdata.upl_tx_chain[i].upl_mbuf); 946 sc->sc_cdata.upl_tx_chain[i].upl_mbuf = NULL; 947 } 948 if (sc->sc_cdata.upl_tx_chain[i].upl_xfer != NULL) { 949 usbd_destroy_xfer(sc->sc_cdata.upl_tx_chain[i].upl_xfer); 950 sc->sc_cdata.upl_tx_chain[i].upl_xfer = NULL; 951 } 952 } 953 954 /* Close pipes */ 955 if (sc->sc_ep[UPL_ENDPT_RX] != NULL) { 956 err = usbd_close_pipe(sc->sc_ep[UPL_ENDPT_RX]); 957 if (err) { 958 printf("%s: close rx pipe failed: %s\n", 959 device_xname(sc->sc_dev), usbd_errstr(err)); 960 } 961 sc->sc_ep[UPL_ENDPT_RX] = NULL; 962 } 963 964 if (sc->sc_ep[UPL_ENDPT_TX] != NULL) { 965 err = usbd_close_pipe(sc->sc_ep[UPL_ENDPT_TX]); 966 if (err) { 967 printf("%s: close tx pipe failed: %s\n", 968 device_xname(sc->sc_dev), usbd_errstr(err)); 969 } 970 sc->sc_ep[UPL_ENDPT_TX] = NULL; 971 } 972 973 if (sc->sc_ep[UPL_ENDPT_INTR] != NULL) { 974 err = usbd_close_pipe(sc->sc_ep[UPL_ENDPT_INTR]); 975 if (err) { 976 printf("%s: close intr pipe failed: %s\n", 977 device_xname(sc->sc_dev), usbd_errstr(err)); 978 } 979 sc->sc_ep[UPL_ENDPT_INTR] = NULL; 980 } 981 982 ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE); 983 } 984 985 Static int 986 upl_output(struct ifnet *ifp, struct mbuf *m, const struct sockaddr *dst, 987 struct rtentry *rt0) 988 { 989 int s, len, error; 990 ALTQ_DECL(struct altq_pktattr pktattr;) 991 992 DPRINTFN(10,("%s: %s: enter\n", 993 device_xname(((struct upl_softc *)ifp->if_softc)->sc_dev), 994 __func__)); 995 996 /* 997 * if the queueing discipline needs packet classification, 998 * do it now. 999 */ 1000 IFQ_CLASSIFY(&ifp->if_snd, m, dst->sa_family, &pktattr); 1001 1002 len = m->m_pkthdr.len; 1003 s = splnet(); 1004 /* 1005 * Queue message on interface, and start output if interface 1006 * not yet active. 1007 */ 1008 IFQ_ENQUEUE(&ifp->if_snd, m, &pktattr, error); 1009 if (error) { 1010 /* mbuf is already freed */ 1011 splx(s); 1012 return (error); 1013 } 1014 ifp->if_obytes += len; 1015 if ((ifp->if_flags & IFF_OACTIVE) == 0) 1016 (*ifp->if_start)(ifp); 1017 splx(s); 1018 1019 return (0); 1020 } 1021 1022 Static void 1023 upl_input(struct ifnet *ifp, struct mbuf *m) 1024 { 1025 #ifdef INET 1026 size_t pktlen = m->m_len; 1027 int s; 1028 1029 s = splnet(); 1030 if (__predict_false(!pktq_enqueue(ip_pktq, m, 0))) { 1031 ifp->if_iqdrops++; 1032 m_freem(m); 1033 } else { 1034 ifp->if_ipackets++; 1035 ifp->if_ibytes += pktlen; 1036 } 1037 splx(s); 1038 #endif 1039 } 1040
Indexes created Tue Sep 30 06:09:59 GMT 2025