sys/bus/u4b/net/if_udav.c

   1 /*      $NetBSD: if_udav.c,v 1.2 2003/09/04 15:17:38 tsutsui Exp $      */
   2 /*      $nabe: if_udav.c,v 1.3 2003/08/21 16:57:19 nabe Exp $   */
   3 /*      $FreeBSD$       */
   4 /*-
   5  * Copyright (c) 2003
   6  *     Shingo WATANABE <nabe@nabechan.org>.  All rights reserved.
   7  *
   8  * Redistribution and use in source and binary forms, with or without
   9  * modification, are permitted provided that the following conditions
  10  * are met:
  11  * 1. Redistributions of source code must retain the above copyright
  12  *    notice, this list of conditions and the following disclaimer.
  13  * 2. Redistributions in binary form must reproduce the above copyright
  14  *    notice, this list of conditions and the following disclaimer in the
  15  *    documentation and/or other materials provided with the distribution.
  16  * 3. Neither the name of the author nor the names of any co-contributors
  17  *    may be used to endorse or promote products derived from this software
  18  *    without specific prior written permission.
  19  *
  20  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  21  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  22  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  23  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  24  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  25  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  26  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  27  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  28  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  29  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  30  * SUCH DAMAGE.
  31  *
  32  */
  33
  34 /*
  35  * DM9601(DAVICOM USB to Ethernet MAC Controller with Integrated 10/100 PHY)
  36  * The spec can be found at the following url.
  37  *   http://www.davicom.com.tw/big5/download/Data%20Sheet/DM9601-DS-P01-930914.pdf
  38  */
  39
  40 /*
  41  * TODO:
  42  *      Interrupt Endpoint support
  43  *      External PHYs
  44  */
  45
  46 #include <sys/stdint.h>
  47 #include <sys/param.h>
  48 #include <sys/queue.h>
  49 #include <sys/types.h>
  50 #include <sys/systm.h>
  51 #include <sys/kernel.h>
  52 #include <sys/bus.h>
  53 #include <sys/module.h>
  54 #include <sys/lock.h>
  55 #include <sys/mutex.h>
  56 #include <sys/condvar.h>
  57 #include <sys/sysctl.h>
  58 #include <sys/unistd.h>
  59 #include <sys/callout.h>
  60 #include <sys/malloc.h>
  61 #include <sys/priv.h>
  62
  63 #include <net/ifq_var.h>
  64
  65 #include <bus/u4b/usb.h>
  66 #include <bus/u4b/usbdi.h>
  67 #include <bus/u4b/usbdi_util.h>
  68 #include "usbdevs.h"
  69
  70 #define USB_DEBUG_VAR udav_debug
  71 #include <bus/u4b/usb_debug.h>
  72 #include <bus/u4b/usb_process.h>
  73
  74 #include <bus/u4b/net/usb_ethernet.h>
  75 #include <bus/u4b/net/if_udavreg.h>
  76
  77 /* prototypes */
  78
  79 static device_probe_t udav_probe;
  80 static device_attach_t udav_attach;
  81 static device_detach_t udav_detach;
  82
  83 static usb_callback_t udav_bulk_write_callback;
  84 static usb_callback_t udav_bulk_read_callback;
  85 static usb_callback_t udav_intr_callback;
  86
  87 static uether_fn_t udav_attach_post;
  88 static uether_fn_t udav_init;
  89 static uether_fn_t udav_stop;
  90 static uether_fn_t udav_start;
  91 static uether_fn_t udav_tick;
  92 static uether_fn_t udav_setmulti;
  93 static uether_fn_t udav_setpromisc;
  94
  95 static int      udav_csr_read(struct udav_softc *, uint16_t, void *, int);
  96 static int      udav_csr_write(struct udav_softc *, uint16_t, void *, int);
  97 static uint8_t  udav_csr_read1(struct udav_softc *, uint16_t);
  98 static int      udav_csr_write1(struct udav_softc *, uint16_t, uint8_t);
  99 static void     udav_reset(struct udav_softc *);
 100 static int      udav_ifmedia_upd(struct ifnet *);
 101 static void     udav_ifmedia_status(struct ifnet *, struct ifmediareq *);
 102
 103 static miibus_readreg_t udav_miibus_readreg;
 104 static miibus_writereg_t udav_miibus_writereg;
 105 static miibus_statchg_t udav_miibus_statchg;
 106
 107 static const struct usb_config udav_config[UDAV_N_TRANSFER] = {
 108
 109         [UDAV_BULK_DT_WR] = {
 110                 .type = UE_BULK,
 111                 .endpoint = UE_ADDR_ANY,
 112                 .direction = UE_DIR_OUT,
 113                 .bufsize = (MCLBYTES + 2),
 114                 .flags = {.pipe_bof = 1,.force_short_xfer = 1,},
 115                 .callback = udav_bulk_write_callback,
 116                 .timeout = 10000,       /* 10 seconds */
 117         },
 118
 119         [UDAV_BULK_DT_RD] = {
 120                 .type = UE_BULK,
 121                 .endpoint = UE_ADDR_ANY,
 122                 .direction = UE_DIR_IN,
 123                 .bufsize = (MCLBYTES + 3),
 124                 .flags = {.pipe_bof = 1,.short_xfer_ok = 1,},
 125                 .callback = udav_bulk_read_callback,
 126                 .timeout = 0,   /* no timeout */
 127         },
 128
 129         [UDAV_INTR_DT_RD] = {
 130                 .type = UE_INTERRUPT,
 131                 .endpoint = UE_ADDR_ANY,
 132                 .direction = UE_DIR_IN,
 133                 .flags = {.pipe_bof = 1,.short_xfer_ok = 1,},
 134                 .bufsize = 0,   /* use wMaxPacketSize */
 135                 .callback = udav_intr_callback,
 136         },
 137 };
 138
 139 static device_method_t udav_methods[] = {
 140         /* Device interface */
 141         DEVMETHOD(device_probe, udav_probe),
 142         DEVMETHOD(device_attach, udav_attach),
 143         DEVMETHOD(device_detach, udav_detach),
 144
 145         /* MII interface */
 146         DEVMETHOD(miibus_readreg, udav_miibus_readreg),
 147         DEVMETHOD(miibus_writereg, udav_miibus_writereg),
 148         DEVMETHOD(miibus_statchg, udav_miibus_statchg),
 149
 150         DEVMETHOD_END
 151 };
 152
 153 static driver_t udav_driver = {
 154         .name = "udav",
 155         .methods = udav_methods,
 156         .size = sizeof(struct udav_softc),
 157 };
 158
 159 static devclass_t udav_devclass;
 160
 161 DRIVER_MODULE(udav, uhub, udav_driver, udav_devclass, NULL, NULL);
 162 DRIVER_MODULE(miibus, udav, miibus_driver, miibus_devclass, NULL, NULL);
 163 MODULE_DEPEND(udav, uether, 1, 1, 1);
 164 MODULE_DEPEND(udav, usb, 1, 1, 1);
 165 MODULE_DEPEND(udav, ether, 1, 1, 1);
 166 MODULE_DEPEND(udav, miibus, 1, 1, 1);
 167 MODULE_VERSION(udav, 1);
 168
 169 static const struct usb_ether_methods udav_ue_methods = {
 170         .ue_attach_post = udav_attach_post,
 171         .ue_start = udav_start,
 172         .ue_init = udav_init,
 173         .ue_stop = udav_stop,
 174         .ue_tick = udav_tick,
 175         .ue_setmulti = udav_setmulti,
 176         .ue_setpromisc = udav_setpromisc,
 177         .ue_mii_upd = udav_ifmedia_upd,
 178         .ue_mii_sts = udav_ifmedia_status,
 179 };
 180
 181 static const struct usb_ether_methods udav_ue_methods_nophy = {
 182         .ue_attach_post = udav_attach_post,
 183         .ue_start = udav_start,
 184         .ue_init = udav_init,
 185         .ue_stop = udav_stop,
 186         .ue_setmulti = udav_setmulti,
 187         .ue_setpromisc = udav_setpromisc,
 188 };
 189
 190 #ifdef USB_DEBUG
 191 static int udav_debug = 0;
 192
 193 static SYSCTL_NODE(_hw_usb, OID_AUTO, udav, CTLFLAG_RW, 0, "USB udav");
 194 SYSCTL_INT(_hw_usb_udav, OID_AUTO, debug, CTLFLAG_RW, &udav_debug, 0,
 195     "Debug level");
 196 #endif
 197
 198 #define UDAV_SETBIT(sc, reg, x) \
 199         udav_csr_write1(sc, reg, udav_csr_read1(sc, reg) | (x))
 200
 201 #define UDAV_CLRBIT(sc, reg, x) \
 202         udav_csr_write1(sc, reg, udav_csr_read1(sc, reg) & ~(x))
 203
 204 static const STRUCT_USB_HOST_ID udav_devs[] = {
 205         /* ShanTou DM9601 USB NIC */
 206         {USB_VPI(USB_VENDOR_SHANTOU, USB_PRODUCT_SHANTOU_DM9601, 0)},
 207         /* ShanTou ST268 USB NIC */
 208         {USB_VPI(USB_VENDOR_SHANTOU, USB_PRODUCT_SHANTOU_ST268, 0)},
 209         /* Corega USB-TXC */
 210         {USB_VPI(USB_VENDOR_COREGA, USB_PRODUCT_COREGA_FETHER_USB_TXC, 0)},
 211         /* ShanTou AMD8515 USB NIC */
 212         {USB_VPI(USB_VENDOR_SHANTOU, USB_PRODUCT_SHANTOU_ADM8515, 0)},
 213         /* Kontron AG USB Ethernet */
 214         {USB_VPI(USB_VENDOR_KONTRON, USB_PRODUCT_KONTRON_DM9601, 0)},
 215         {USB_VPI(USB_VENDOR_KONTRON, USB_PRODUCT_KONTRON_JP1082,
 216             UDAV_FLAG_NO_PHY)},
 217 };
 218
 219 static void
 220 udav_attach_post(struct usb_ether *ue)
 221 {
 222         struct udav_softc *sc = uether_getsc(ue);
 223
 224         /* reset the adapter */
 225         udav_reset(sc);
 226
 227         /* Get Ethernet Address */
 228         udav_csr_read(sc, UDAV_PAR, ue->ue_eaddr, ETHER_ADDR_LEN);
 229 }
 230
 231 static int
 232 udav_probe(device_t dev)
 233 {
 234         struct usb_attach_arg *uaa = device_get_ivars(dev);
 235
 236         if (uaa->usb_mode != USB_MODE_HOST)
 237                 return (ENXIO);
 238         if (uaa->info.bConfigIndex != UDAV_CONFIG_INDEX)
 239                 return (ENXIO);
 240         if (uaa->info.bIfaceIndex != UDAV_IFACE_INDEX)
 241                 return (ENXIO);
 242
 243         return (usbd_lookup_id_by_uaa(udav_devs, sizeof(udav_devs), uaa));
 244 }
 245
 246 static int
 247 udav_attach(device_t dev)
 248 {
 249         struct usb_attach_arg *uaa = device_get_ivars(dev);
 250         struct udav_softc *sc = device_get_softc(dev);
 251         struct usb_ether *ue = &sc->sc_ue;
 252         uint8_t iface_index;
 253         int error;
 254
 255         sc->sc_flags = USB_GET_DRIVER_INFO(uaa);
 256
 257         device_set_usb_desc(dev);
 258
 259         lockinit(&sc->sc_lock, device_get_nameunit(dev), 0, 0);
 260
 261         iface_index = UDAV_IFACE_INDEX;
 262         error = usbd_transfer_setup(uaa->device, &iface_index,
 263             sc->sc_xfer, udav_config, UDAV_N_TRANSFER, sc, &sc->sc_lock);
 264         if (error) {
 265                 device_printf(dev, "allocating USB transfers failed\n");
 266                 goto detach;
 267         }
 268
 269         /*
 270          * The JP1082 has an unusable PHY and provides no link information.
 271          */
 272         if (sc->sc_flags & UDAV_FLAG_NO_PHY) {
 273                 ue->ue_methods = &udav_ue_methods_nophy;
 274                 sc->sc_flags |= UDAV_FLAG_LINK;
 275         } else {
 276                 ue->ue_methods = &udav_ue_methods;
 277         }
 278
 279         ue->ue_sc = sc;
 280         ue->ue_dev = dev;
 281         ue->ue_udev = uaa->device;
 282         ue->ue_lock = &sc->sc_lock;
 283
 284         error = uether_ifattach(ue);
 285         if (error) {
 286                 device_printf(dev, "could not attach interface\n");
 287                 goto detach;
 288         }
 289
 290         return (0);                     /* success */
 291
 292 detach:
 293         udav_detach(dev);
 294         return (ENXIO);                 /* failure */
 295 }
 296
 297 static int
 298 udav_detach(device_t dev)
 299 {
 300         struct udav_softc *sc = device_get_softc(dev);
 301         struct usb_ether *ue = &sc->sc_ue;
 302
 303         usbd_transfer_unsetup(sc->sc_xfer, UDAV_N_TRANSFER);
 304         uether_ifdetach(ue);
 305         lockuninit(&sc->sc_lock);
 306
 307         return (0);
 308 }
 309
 310 #if 0
 311 static int
 312 udav_mem_read(struct udav_softc *sc, uint16_t offset, void *buf,
 313     int len)
 314 {
 315         struct usb_device_request req;
 316
 317         len &= 0xff;
 318
 319         req.bmRequestType = UT_READ_VENDOR_DEVICE;
 320         req.bRequest = UDAV_REQ_MEM_READ;
 321         USETW(req.wValue, 0x0000);
 322         USETW(req.wIndex, offset);
 323         USETW(req.wLength, len);
 324
 325         return (uether_do_request(&sc->sc_ue, &req, buf, 1000));
 326 }
 327
 328 static int
 329 udav_mem_write(struct udav_softc *sc, uint16_t offset, void *buf,
 330     int len)
 331 {
 332         struct usb_device_request req;
 333
 334         len &= 0xff;
 335
 336         req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
 337         req.bRequest = UDAV_REQ_MEM_WRITE;
 338         USETW(req.wValue, 0x0000);
 339         USETW(req.wIndex, offset);
 340         USETW(req.wLength, len);
 341
 342         return (uether_do_request(&sc->sc_ue, &req, buf, 1000));
 343 }
 344
 345 static int
 346 udav_mem_write1(struct udav_softc *sc, uint16_t offset,
 347     uint8_t ch)
 348 {
 349         struct usb_device_request req;
 350
 351         req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
 352         req.bRequest = UDAV_REQ_MEM_WRITE1;
 353         USETW(req.wValue, ch);
 354         USETW(req.wIndex, offset);
 355         USETW(req.wLength, 0x0000);
 356
 357         return (uether_do_request(&sc->sc_ue, &req, NULL, 1000));
 358 }
 359 #endif
 360
 361 static int
 362 udav_csr_read(struct udav_softc *sc, uint16_t offset, void *buf, int len)
 363 {
 364         struct usb_device_request req;
 365
 366         len &= 0xff;
 367
 368         req.bmRequestType = UT_READ_VENDOR_DEVICE;
 369         req.bRequest = UDAV_REQ_REG_READ;
 370         USETW(req.wValue, 0x0000);
 371         USETW(req.wIndex, offset);
 372         USETW(req.wLength, len);
 373
 374         return (uether_do_request(&sc->sc_ue, &req, buf, 1000));
 375 }
 376
 377 static int
 378 udav_csr_write(struct udav_softc *sc, uint16_t offset, void *buf, int len)
 379 {
 380         struct usb_device_request req;
 381
 382         offset &= 0xff;
 383         len &= 0xff;
 384
 385         req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
 386         req.bRequest = UDAV_REQ_REG_WRITE;
 387         USETW(req.wValue, 0x0000);
 388         USETW(req.wIndex, offset);
 389         USETW(req.wLength, len);
 390
 391         return (uether_do_request(&sc->sc_ue, &req, buf, 1000));
 392 }
 393
 394 static uint8_t
 395 udav_csr_read1(struct udav_softc *sc, uint16_t offset)
 396 {
 397         uint8_t val;
 398
 399         udav_csr_read(sc, offset, &val, 1);
 400         return (val);
 401 }
 402
 403 static int
 404 udav_csr_write1(struct udav_softc *sc, uint16_t offset,
 405     uint8_t ch)
 406 {
 407         struct usb_device_request req;
 408
 409         offset &= 0xff;
 410
 411         req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
 412         req.bRequest = UDAV_REQ_REG_WRITE1;
 413         USETW(req.wValue, ch);
 414         USETW(req.wIndex, offset);
 415         USETW(req.wLength, 0x0000);
 416
 417         return (uether_do_request(&sc->sc_ue, &req, NULL, 1000));
 418 }
 419
 420 static void
 421 udav_init(struct usb_ether *ue)
 422 {
 423         struct udav_softc *sc = ue->ue_sc;
 424         struct ifnet *ifp = uether_getifp(&sc->sc_ue);
 425
 426         UDAV_LOCK_ASSERT(sc);
 427
 428         /*
 429          * Cancel pending I/O
 430          */
 431         udav_stop(ue);
 432
 433         /* set MAC address */
 434         udav_csr_write(sc, UDAV_PAR, IF_LLADDR(ifp), ETHER_ADDR_LEN);
 435
 436         /* initialize network control register */
 437
 438         /* disable loopback  */
 439         UDAV_CLRBIT(sc, UDAV_NCR, UDAV_NCR_LBK0 | UDAV_NCR_LBK1);
 440
 441         /* Initialize RX control register */
 442         UDAV_SETBIT(sc, UDAV_RCR, UDAV_RCR_DIS_LONG | UDAV_RCR_DIS_CRC);
 443
 444         /* load multicast filter and update promiscious mode bit */
 445         udav_setpromisc(ue);
 446
 447         /* enable RX */
 448         UDAV_SETBIT(sc, UDAV_RCR, UDAV_RCR_RXEN);
 449
 450         /* clear POWER_DOWN state of internal PHY */
 451         UDAV_SETBIT(sc, UDAV_GPCR, UDAV_GPCR_GEP_CNTL0);
 452         UDAV_CLRBIT(sc, UDAV_GPR, UDAV_GPR_GEPIO0);
 453
 454         usbd_xfer_set_stall(sc->sc_xfer[UDAV_BULK_DT_WR]);
 455
 456 /* XXX  ifp->if_drv_flags |= IFF_DRV_RUNNING;
 457  */
 458         udav_start(ue);
 459 }
 460
 461 static void
 462 udav_reset(struct udav_softc *sc)
 463 {
 464         int i;
 465
 466         /* Select PHY */
 467 #if 1
 468         /*
 469          * XXX: force select internal phy.
 470          *      external phy routines are not tested.
 471          */
 472         UDAV_CLRBIT(sc, UDAV_NCR, UDAV_NCR_EXT_PHY);
 473 #else
 474         if (sc->sc_flags & UDAV_EXT_PHY)
 475                 UDAV_SETBIT(sc, UDAV_NCR, UDAV_NCR_EXT_PHY);
 476         else
 477                 UDAV_CLRBIT(sc, UDAV_NCR, UDAV_NCR_EXT_PHY);
 478 #endif
 479
 480         UDAV_SETBIT(sc, UDAV_NCR, UDAV_NCR_RST);
 481
 482         for (i = 0; i < UDAV_TX_TIMEOUT; i++) {
 483                 if (!(udav_csr_read1(sc, UDAV_NCR) & UDAV_NCR_RST))
 484                         break;
 485                 if (uether_pause(&sc->sc_ue, hz / 100))
 486                         break;
 487         }
 488
 489         uether_pause(&sc->sc_ue, hz / 100);
 490 }
 491
 492 #define UDAV_BITS       6
 493 static void
 494 udav_setmulti(struct usb_ether *ue)
 495 {
 496         struct udav_softc *sc = ue->ue_sc;
 497         struct ifnet *ifp = uether_getifp(&sc->sc_ue);
 498         struct ifmultiaddr *ifma;
 499         uint8_t hashtbl[8] = { 0, 0, 0, 0, 0, 0, 0, 0 };
 500         int h = 0;
 501
 502         UDAV_LOCK_ASSERT(sc);
 503
 504         if (ifp->if_flags & IFF_ALLMULTI || ifp->if_flags & IFF_PROMISC) {
 505                 UDAV_SETBIT(sc, UDAV_RCR, UDAV_RCR_ALL|UDAV_RCR_PRMSC);
 506                 return;
 507         }
 508
 509         /* first, zot all the existing hash bits */
 510         memset(hashtbl, 0x00, sizeof(hashtbl));
 511         hashtbl[7] |= 0x80;     /* broadcast address */
 512         udav_csr_write(sc, UDAV_MAR, hashtbl, sizeof(hashtbl));
 513
 514         /* now program new ones */
 515         TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link)
 516         {
 517                 if (ifma->ifma_addr->sa_family != AF_LINK)
 518                         continue;
 519                 h = ether_crc32_be(LLADDR((struct sockaddr_dl *)
 520                     ifma->ifma_addr), ETHER_ADDR_LEN) >> 26;
 521                 hashtbl[h / 8] |= 1 << (h % 8);
 522         }
 523
 524         /* disable all multicast */
 525         UDAV_CLRBIT(sc, UDAV_RCR, UDAV_RCR_ALL);
 526
 527         /* write hash value to the register */
 528         udav_csr_write(sc, UDAV_MAR, hashtbl, sizeof(hashtbl));
 529 }
 530
 531 static void
 532 udav_setpromisc(struct usb_ether *ue)
 533 {
 534         struct udav_softc *sc = ue->ue_sc;
 535         struct ifnet *ifp = uether_getifp(&sc->sc_ue);
 536         uint8_t rxmode;
 537
 538         rxmode = udav_csr_read1(sc, UDAV_RCR);
 539         rxmode &= ~(UDAV_RCR_ALL | UDAV_RCR_PRMSC);
 540
 541         if (ifp->if_flags & IFF_PROMISC)
 542                 rxmode |= UDAV_RCR_ALL | UDAV_RCR_PRMSC;
 543         else if (ifp->if_flags & IFF_ALLMULTI)
 544                 rxmode |= UDAV_RCR_ALL;
 545
 546         /* write new mode bits */
 547         udav_csr_write1(sc, UDAV_RCR, rxmode);
 548 }
 549
 550 static void
 551 udav_start(struct usb_ether *ue)
 552 {
 553         struct udav_softc *sc = ue->ue_sc;
 554
 555         /*
 556          * start the USB transfers, if not already started:
 557          */
 558         usbd_transfer_start(sc->sc_xfer[UDAV_INTR_DT_RD]);
 559         usbd_transfer_start(sc->sc_xfer[UDAV_BULK_DT_RD]);
 560         usbd_transfer_start(sc->sc_xfer[UDAV_BULK_DT_WR]);
 561 }
 562
 563 static void
 564 udav_bulk_write_callback(struct usb_xfer *xfer, usb_error_t error)
 565 {
 566         struct udav_softc *sc = usbd_xfer_softc(xfer);
 567         struct ifnet *ifp = uether_getifp(&sc->sc_ue);
 568         struct usb_page_cache *pc;
 569         struct mbuf *m;
 570         int extra_len;
 571         int temp_len;
 572         uint8_t buf[2];
 573
 574         switch (USB_GET_STATE(xfer)) {
 575         case USB_ST_TRANSFERRED:
 576                 DPRINTFN(11, "transfer complete\n");
 577                 IFNET_STAT_INC(ifp, opackets, 1);
 578
 579                 /* FALLTHROUGH */
 580         case USB_ST_SETUP:
 581 tr_setup:
 582                 if ((sc->sc_flags & UDAV_FLAG_LINK) == 0) {
 583                         /*
 584                          * don't send anything if there is no link !
 585                          */
 586                         return;
 587                 }
 588                 m = ifq_dequeue(&ifp->if_snd);
 589
 590                 if (m == NULL)
 591                         return;
 592                 if (m->m_pkthdr.len > MCLBYTES)
 593                         m->m_pkthdr.len = MCLBYTES;
 594                 if (m->m_pkthdr.len < UDAV_MIN_FRAME_LEN) {
 595                         extra_len = UDAV_MIN_FRAME_LEN - m->m_pkthdr.len;
 596                 } else {
 597                         extra_len = 0;
 598                 }
 599
 600                 temp_len = (m->m_pkthdr.len + extra_len);
 601
 602                 /*
 603                  * the frame length is specified in the first 2 bytes of the
 604                  * buffer
 605                  */
 606                 buf[0] = (uint8_t)(temp_len);
 607                 buf[1] = (uint8_t)(temp_len >> 8);
 608
 609                 temp_len += 2;
 610
 611                 pc = usbd_xfer_get_frame(xfer, 0);
 612                 usbd_copy_in(pc, 0, buf, 2);
 613                 usbd_m_copy_in(pc, 2, m, 0, m->m_pkthdr.len);
 614
 615                 if (extra_len)
 616                         usbd_frame_zero(pc, temp_len - extra_len, extra_len);
 617                 /*
 618                  * if there's a BPF listener, bounce a copy
 619                  * of this frame to him:
 620                  */
 621                 BPF_MTAP(ifp, m);
 622
 623                 m_freem(m);
 624
 625                 usbd_xfer_set_frame_len(xfer, 0, temp_len);
 626                 usbd_transfer_submit(xfer);
 627                 return;
 628
 629         default:                        /* Error */
 630                 DPRINTFN(11, "transfer error, %s\n",
 631                     usbd_errstr(error));
 632
 633                 IFNET_STAT_INC(ifp, oerrors, 1);
 634
 635                 if (error != USB_ERR_CANCELLED) {
 636                         /* try to clear stall first */
 637                         usbd_xfer_set_stall(xfer);
 638                         goto tr_setup;
 639                 }
 640                 return;
 641         }
 642 }
 643
 644 static void
 645 udav_bulk_read_callback(struct usb_xfer *xfer, usb_error_t error)
 646 {
 647         struct udav_softc *sc = usbd_xfer_softc(xfer);
 648         struct usb_ether *ue = &sc->sc_ue;
 649         struct ifnet *ifp = uether_getifp(ue);
 650         struct usb_page_cache *pc;
 651         struct udav_rxpkt stat;
 652         int len;
 653         int actlen;
 654
 655         usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
 656
 657         switch (USB_GET_STATE(xfer)) {
 658         case USB_ST_TRANSFERRED:
 659
 660                 if (actlen < sizeof(stat) + ETHER_CRC_LEN) {
 661                         IFNET_STAT_INC(ifp, ierrors, 1);
 662                         goto tr_setup;
 663                 }
 664                 pc = usbd_xfer_get_frame(xfer, 0);
 665                 usbd_copy_out(pc, 0, &stat, sizeof(stat));
 666                 actlen -= sizeof(stat);
 667                 len = min(actlen, le16toh(stat.pktlen));
 668                 len -= ETHER_CRC_LEN;
 669
 670                 if (stat.rxstat & UDAV_RSR_LCS) {
 671                         IFNET_STAT_INC(ifp, collisions, 1);
 672                         goto tr_setup;
 673                 }
 674                 if (stat.rxstat & UDAV_RSR_ERR) {
 675                         IFNET_STAT_INC(ifp, ierrors, 1);
 676                         goto tr_setup;
 677                 }
 678                 uether_rxbuf(ue, pc, sizeof(stat), len);
 679                 /* FALLTHROUGH */
 680         case USB_ST_SETUP:
 681 tr_setup:
 682                 usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer));
 683                 usbd_transfer_submit(xfer);
 684                 uether_rxflush(ue);
 685                 return;
 686
 687         default:                        /* Error */
 688                 DPRINTF("bulk read error, %s\n",
 689                     usbd_errstr(error));
 690
 691                 if (error != USB_ERR_CANCELLED) {
 692                         /* try to clear stall first */
 693                         usbd_xfer_set_stall(xfer);
 694                         goto tr_setup;
 695                 }
 696                 return;
 697         }
 698 }
 699
 700 static void
 701 udav_intr_callback(struct usb_xfer *xfer, usb_error_t error)
 702 {
 703         switch (USB_GET_STATE(xfer)) {
 704         case USB_ST_TRANSFERRED:
 705         case USB_ST_SETUP:
 706 tr_setup:
 707                 usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer));
 708                 usbd_transfer_submit(xfer);
 709                 return;
 710
 711         default:                        /* Error */
 712                 if (error != USB_ERR_CANCELLED) {
 713                         /* try to clear stall first */
 714                         usbd_xfer_set_stall(xfer);
 715                         goto tr_setup;
 716                 }
 717                 return;
 718         }
 719 }
 720
 721 static void
 722 udav_stop(struct usb_ether *ue)
 723 {
 724         struct udav_softc *sc = ue->ue_sc;
 725 #if 0 /* XXX */
 726         struct ifnet *ifp = uether_getifp(&sc->sc_ue);
 727 #endif
 728
 729         UDAV_LOCK_ASSERT(sc);
 730
 731 #if 0 /* XXX */
 732         ifp->if_drv_flags &= ~IFF_DRV_RUNNING;
 733 #endif
 734         if (!(sc->sc_flags & UDAV_FLAG_NO_PHY))
 735                 sc->sc_flags &= ~UDAV_FLAG_LINK;
 736
 737         /*
 738          * stop all the transfers, if not already stopped:
 739          */
 740         usbd_transfer_stop(sc->sc_xfer[UDAV_BULK_DT_WR]);
 741         usbd_transfer_stop(sc->sc_xfer[UDAV_BULK_DT_RD]);
 742         usbd_transfer_stop(sc->sc_xfer[UDAV_INTR_DT_RD]);
 743
 744         udav_reset(sc);
 745 }
 746
 747 static int
 748 udav_ifmedia_upd(struct ifnet *ifp)
 749 {
 750         struct udav_softc *sc = ifp->if_softc;
 751         struct mii_data *mii = GET_MII(sc);
 752         struct mii_softc *miisc;
 753         int error;
 754
 755         UDAV_LOCK_ASSERT(sc);
 756
 757         sc->sc_flags &= ~UDAV_FLAG_LINK;
 758         LIST_FOREACH(miisc, &mii->mii_phys, mii_list)
 759                 mii_phy_reset(miisc);
 760         error = mii_mediachg(mii);
 761         return (error);
 762 }
 763
 764 static void
 765 udav_ifmedia_status(struct ifnet *ifp, struct ifmediareq *ifmr)
 766 {
 767         struct udav_softc *sc = ifp->if_softc;
 768         struct mii_data *mii = GET_MII(sc);
 769
 770         UDAV_LOCK(sc);
 771         mii_pollstat(mii);
 772         ifmr->ifm_active = mii->mii_media_active;
 773         ifmr->ifm_status = mii->mii_media_status;
 774         UDAV_UNLOCK(sc);
 775 }
 776
 777 static void
 778 udav_tick(struct usb_ether *ue)
 779 {
 780         struct udav_softc *sc = ue->ue_sc;
 781         struct mii_data *mii = GET_MII(sc);
 782
 783         UDAV_LOCK_ASSERT(sc);
 784
 785         mii_tick(mii);
 786         if ((sc->sc_flags & UDAV_FLAG_LINK) == 0
 787             && mii->mii_media_status & IFM_ACTIVE &&
 788             IFM_SUBTYPE(mii->mii_media_active) != IFM_NONE) {
 789                 sc->sc_flags |= UDAV_FLAG_LINK;
 790                 udav_start(ue);
 791         }
 792 }
 793
 794 static int
 795 udav_miibus_readreg(device_t dev, int phy, int reg)
 796 {
 797         struct udav_softc *sc = device_get_softc(dev);
 798         uint16_t data16;
 799         uint8_t val[2];
 800         int locked;
 801
 802         /* XXX: one PHY only for the internal PHY */
 803         if (phy != 0)
 804                 return (0);
 805
 806         locked = lockowned(&sc->sc_lock);
 807         if (!locked)
 808                 UDAV_LOCK(sc);
 809
 810         /* select internal PHY and set PHY register address */
 811         udav_csr_write1(sc, UDAV_EPAR,
 812             UDAV_EPAR_PHY_ADR0 | (reg & UDAV_EPAR_EROA_MASK));
 813
 814         /* select PHY operation and start read command */
 815         udav_csr_write1(sc, UDAV_EPCR, UDAV_EPCR_EPOS | UDAV_EPCR_ERPRR);
 816
 817         /* XXX: should we wait? */
 818
 819         /* end read command */
 820         UDAV_CLRBIT(sc, UDAV_EPCR, UDAV_EPCR_ERPRR);
 821
 822         /* retrieve the result from data registers */
 823         udav_csr_read(sc, UDAV_EPDRL, val, 2);
 824
 825         data16 = (val[0] | (val[1] << 8));
 826
 827         DPRINTFN(11, "phy=%d reg=0x%04x => 0x%04x\n",
 828             phy, reg, data16);
 829
 830         if (!locked)
 831                 UDAV_UNLOCK(sc);
 832         return (data16);
 833 }
 834
 835 static int
 836 udav_miibus_writereg(device_t dev, int phy, int reg, int data)
 837 {
 838         struct udav_softc *sc = device_get_softc(dev);
 839         uint8_t val[2];
 840         int locked;
 841
 842         /* XXX: one PHY only for the internal PHY */
 843         if (phy != 0)
 844                 return (0);
 845
 846         locked = lockowned(&sc->sc_lock);
 847         if (!locked)
 848                 UDAV_LOCK(sc);
 849
 850         /* select internal PHY and set PHY register address */
 851         udav_csr_write1(sc, UDAV_EPAR,
 852             UDAV_EPAR_PHY_ADR0 | (reg & UDAV_EPAR_EROA_MASK));
 853
 854         /* put the value to the data registers */
 855         val[0] = (data & 0xff);
 856         val[1] = (data >> 8) & 0xff;
 857         udav_csr_write(sc, UDAV_EPDRL, val, 2);
 858
 859         /* select PHY operation and start write command */
 860         udav_csr_write1(sc, UDAV_EPCR, UDAV_EPCR_EPOS | UDAV_EPCR_ERPRW);
 861
 862         /* XXX: should we wait? */
 863
 864         /* end write command */
 865         UDAV_CLRBIT(sc, UDAV_EPCR, UDAV_EPCR_ERPRW);
 866
 867         if (!locked)
 868                 UDAV_UNLOCK(sc);
 869         return (0);
 870 }
 871
 872 static void
 873 udav_miibus_statchg(device_t dev)
 874 {
 875         /* nothing to do */
 876 }