The Design and Implementation of the FreeBSD Operating System, Second Edition
Now available: The Design and Implementation of the FreeBSD Operating System (Second Edition)


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]

FreeBSD/Linux Kernel Cross Reference
sys/dev/netif/vr/if_vr.c

Version: -  FREEBSD  -  FREEBSD-13-STABLE  -  FREEBSD-13-0  -  FREEBSD-12-STABLE  -  FREEBSD-12-0  -  FREEBSD-11-STABLE  -  FREEBSD-11-0  -  FREEBSD-10-STABLE  -  FREEBSD-10-0  -  FREEBSD-9-STABLE  -  FREEBSD-9-0  -  FREEBSD-8-STABLE  -  FREEBSD-8-0  -  FREEBSD-7-STABLE  -  FREEBSD-7-0  -  FREEBSD-6-STABLE  -  FREEBSD-6-0  -  FREEBSD-5-STABLE  -  FREEBSD-5-0  -  FREEBSD-4-STABLE  -  FREEBSD-3-STABLE  -  FREEBSD22  -  l41  -  OPENBSD  -  linux-2.6  -  MK84  -  PLAN9  -  xnu-8792 
SearchContext: -  none  -  3  -  10 

    1 /*
    2  * Copyright (c) 1997, 1998
    3  *      Bill Paul <wpaul@ctr.columbia.edu>.  All rights reserved.
    4  *
    5  * Redistribution and use in source and binary forms, with or without
    6  * modification, are permitted provided that the following conditions
    7  * are met:
    8  * 1. Redistributions of source code must retain the above copyright
    9  *    notice, this list of conditions and the following disclaimer.
   10  * 2. Redistributions in binary form must reproduce the above copyright
   11  *    notice, this list of conditions and the following disclaimer in the
   12  *    documentation and/or other materials provided with the distribution.
   13  * 3. All advertising materials mentioning features or use of this software
   14  *    must display the following acknowledgement:
   15  *      This product includes software developed by Bill Paul.
   16  * 4. 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 Bill Paul 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 Bill Paul OR THE VOICES IN HIS HEAD
   24  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
   25  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
   26  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
   27  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
   28  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
   29  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
   30  * THE POSSIBILITY OF SUCH DAMAGE.
   31  *
   32  * $FreeBSD: src/sys/pci/if_vr.c,v 1.26.2.13 2003/02/06 04:46:20 silby Exp $
   33  */
   34 
   35 /*
   36  * VIA Rhine fast ethernet PCI NIC driver
   37  *
   38  * Supports various network adapters based on the VIA Rhine
   39  * and Rhine II PCI controllers, including the D-Link DFE530TX.
   40  * Datasheets are available at http://www.via.com.tw.
   41  *
   42  * Written by Bill Paul <wpaul@ctr.columbia.edu>
   43  * Electrical Engineering Department
   44  * Columbia University, New York City
   45  */
   46 
   47 /*
   48  * The VIA Rhine controllers are similar in some respects to the
   49  * the DEC tulip chips, except less complicated. The controller
   50  * uses an MII bus and an external physical layer interface. The
   51  * receiver has a one entry perfect filter and a 64-bit hash table
   52  * multicast filter. Transmit and receive descriptors are similar
   53  * to the tulip.
   54  *
   55  * The Rhine has a serious flaw in its transmit DMA mechanism:
   56  * transmit buffers must be longword aligned. Unfortunately,
   57  * FreeBSD doesn't guarantee that mbufs will be filled in starting
   58  * at longword boundaries, so we have to do a buffer copy before
   59  * transmission.
   60  */
   61 
   62 #include "opt_ifpoll.h"
   63 
   64 #include <sys/param.h>
   65 #include <sys/systm.h>
   66 #include <sys/sockio.h>
   67 #include <sys/mbuf.h>
   68 #include <sys/malloc.h>
   69 #include <sys/kernel.h>
   70 #include <sys/socket.h>
   71 #include <sys/serialize.h>
   72 #include <sys/bus.h>
   73 #include <sys/rman.h>
   74 #include <sys/thread2.h>
   75 #include <sys/interrupt.h>
   76 
   77 #include <net/if.h>
   78 #include <net/ifq_var.h>
   79 #include <net/if_arp.h>
   80 #include <net/ethernet.h>
   81 #include <net/if_dl.h>
   82 #include <net/if_media.h>
   83 #include <net/if_poll.h>
   84 
   85 #include <net/bpf.h>
   86 
   87 #include <vm/vm.h>              /* for vtophys */
   88 #include <vm/pmap.h>            /* for vtophys */
   89 
   90 #include <dev/netif/mii_layer/mii.h>
   91 #include <dev/netif/mii_layer/miivar.h>
   92 
   93 #include "pcidevs.h"
   94 #include <bus/pci/pcireg.h>
   95 #include <bus/pci/pcivar.h>
   96 
   97 #define VR_USEIOSPACE
   98 
   99 #include <dev/netif/vr/if_vrreg.h>
  100 
  101 /* "controller miibus0" required.  See GENERIC if you get errors here. */
  102 #include "miibus_if.h"
  103 
  104 #undef VR_USESWSHIFT
  105 
  106 /*
  107  * Various supported device vendors/types and their names.
  108  */
  109 static struct vr_type vr_devs[] = {
  110         { PCI_VENDOR_VIATECH, PCI_PRODUCT_VIATECH_VT3043,
  111                 "VIA VT3043 Rhine I 10/100BaseTX" },
  112         { PCI_VENDOR_VIATECH, PCI_PRODUCT_VIATECH_VT86C100A,
  113                 "VIA VT86C100A Rhine II 10/100BaseTX" },
  114         { PCI_VENDOR_VIATECH, PCI_PRODUCT_VIATECH_VT6102,
  115                 "VIA VT6102 Rhine II 10/100BaseTX" },
  116         { PCI_VENDOR_VIATECH, PCI_PRODUCT_VIATECH_VT6105,
  117                 "VIA VT6105 Rhine III 10/100BaseTX" },
  118         { PCI_VENDOR_VIATECH, PCI_PRODUCT_VIATECH_VT6105M,
  119                 "VIA VT6105M Rhine III 10/100BaseTX" },
  120         { PCI_VENDOR_DELTA, PCI_PRODUCT_DELTA_RHINEII,
  121                 "Delta Electronics Rhine II 10/100BaseTX" },
  122         { PCI_VENDOR_ADDTRON, PCI_PRODUCT_ADDTRON_RHINEII,
  123                 "Addtron Technology Rhine II 10/100BaseTX" },
  124         { 0, 0, NULL }
  125 };
  126 
  127 static int      vr_probe(device_t);
  128 static int      vr_attach(device_t);
  129 static int      vr_detach(device_t);
  130 
  131 static int      vr_newbuf(struct vr_softc *, struct vr_chain_onefrag *,
  132                           struct mbuf *);
  133 static int      vr_encap(struct vr_softc *, int, struct mbuf * );
  134 
  135 static void     vr_rxeof(struct vr_softc *);
  136 static void     vr_rxeoc(struct vr_softc *);
  137 static void     vr_txeof(struct vr_softc *);
  138 static void     vr_txeoc(struct vr_softc *);
  139 static void     vr_tick(void *);
  140 static void     vr_intr(void *);
  141 static void     vr_start(struct ifnet *, struct ifaltq_subque *);
  142 static int      vr_ioctl(struct ifnet *, u_long, caddr_t, struct ucred *);
  143 static void     vr_init(void *);
  144 static void     vr_stop(struct vr_softc *);
  145 static void     vr_watchdog(struct ifnet *);
  146 static void     vr_shutdown(device_t);
  147 static int      vr_ifmedia_upd(struct ifnet *);
  148 static void     vr_ifmedia_sts(struct ifnet *, struct ifmediareq *);
  149 
  150 #ifdef VR_USESWSHIFT
  151 static void     vr_mii_sync(struct vr_softc *);
  152 static void     vr_mii_send(struct vr_softc *, uint32_t, int);
  153 #endif
  154 static int      vr_mii_readreg(struct vr_softc *, struct vr_mii_frame *);
  155 static int      vr_mii_writereg(struct vr_softc *, struct vr_mii_frame *);
  156 static int      vr_miibus_readreg(device_t, int, int);
  157 static int      vr_miibus_writereg(device_t, int, int, int);
  158 static void     vr_miibus_statchg(device_t);
  159 
  160 static void     vr_setcfg(struct vr_softc *, int);
  161 static void     vr_setmulti(struct vr_softc *);
  162 static void     vr_reset(struct vr_softc *);
  163 static int      vr_list_rx_init(struct vr_softc *);
  164 static int      vr_list_tx_init(struct vr_softc *);
  165 #ifdef IFPOLL_ENABLE
  166 static void     vr_npoll(struct ifnet *, struct ifpoll_info *);
  167 static void     vr_npoll_compat(struct ifnet *, void *, int);
  168 #endif
  169 
  170 #ifdef VR_USEIOSPACE
  171 #define VR_RES                  SYS_RES_IOPORT
  172 #define VR_RID                  VR_PCI_LOIO
  173 #else
  174 #define VR_RES                  SYS_RES_MEMORY
  175 #define VR_RID                  VR_PCI_LOMEM
  176 #endif
  177 
  178 static device_method_t vr_methods[] = {
  179         /* Device interface */
  180         DEVMETHOD(device_probe,         vr_probe),
  181         DEVMETHOD(device_attach,        vr_attach),
  182         DEVMETHOD(device_detach,        vr_detach),
  183         DEVMETHOD(device_shutdown,      vr_shutdown),
  184 
  185         /* bus interface */
  186         DEVMETHOD(bus_print_child,      bus_generic_print_child),
  187         DEVMETHOD(bus_driver_added,     bus_generic_driver_added),
  188 
  189         /* MII interface */
  190         DEVMETHOD(miibus_readreg,       vr_miibus_readreg),
  191         DEVMETHOD(miibus_writereg,      vr_miibus_writereg),
  192         DEVMETHOD(miibus_statchg,       vr_miibus_statchg),
  193 
  194         DEVMETHOD_END
  195 };
  196 
  197 static driver_t vr_driver = {
  198         "vr",
  199         vr_methods,
  200         sizeof(struct vr_softc)
  201 };
  202 
  203 static devclass_t vr_devclass;
  204 
  205 DECLARE_DUMMY_MODULE(if_vr);
  206 DRIVER_MODULE(if_vr, pci, vr_driver, vr_devclass, NULL, NULL);
  207 DRIVER_MODULE(miibus, vr, miibus_driver, miibus_devclass, NULL, NULL);
  208 
  209 #define VR_SETBIT(sc, reg, x)                           \
  210         CSR_WRITE_1(sc, reg,                            \
  211                 CSR_READ_1(sc, reg) | (x))
  212 
  213 #define VR_CLRBIT(sc, reg, x)                           \
  214         CSR_WRITE_1(sc, reg,                            \
  215                 CSR_READ_1(sc, reg) & ~(x))
  216 
  217 #define VR_SETBIT16(sc, reg, x)                         \
  218         CSR_WRITE_2(sc, reg,                            \
  219                 CSR_READ_2(sc, reg) | (x))
  220 
  221 #define VR_CLRBIT16(sc, reg, x)                         \
  222         CSR_WRITE_2(sc, reg,                            \
  223                 CSR_READ_2(sc, reg) & ~(x))
  224 
  225 #define VR_SETBIT32(sc, reg, x)                         \
  226         CSR_WRITE_4(sc, reg,                            \
  227                 CSR_READ_4(sc, reg) | (x))
  228 
  229 #define VR_CLRBIT32(sc, reg, x)                         \
  230         CSR_WRITE_4(sc, reg,                            \
  231                 CSR_READ_4(sc, reg) & ~(x))
  232 
  233 #define SIO_SET(x)                                      \
  234         CSR_WRITE_1(sc, VR_MIICMD,                      \
  235                 CSR_READ_1(sc, VR_MIICMD) | (x))
  236 
  237 #define SIO_CLR(x)                                      \
  238         CSR_WRITE_1(sc, VR_MIICMD,                      \
  239                 CSR_READ_1(sc, VR_MIICMD) & ~(x))
  240 
  241 #ifdef VR_USESWSHIFT
  242 /*
  243  * Sync the PHYs by setting data bit and strobing the clock 32 times.
  244  */
  245 static void
  246 vr_mii_sync(struct vr_softc *sc)
  247 {
  248         int i;
  249 
  250         SIO_SET(VR_MIICMD_DIR|VR_MIICMD_DATAIN);
  251 
  252         for (i = 0; i < 32; i++) {
  253                 SIO_SET(VR_MIICMD_CLK);
  254                 DELAY(1);
  255                 SIO_CLR(VR_MIICMD_CLK);
  256                 DELAY(1);
  257         }
  258 }
  259 
  260 /*
  261  * Clock a series of bits through the MII.
  262  */
  263 static void
  264 vr_mii_send(struct vr_softc *sc, uint32_t bits, int cnt)
  265 {
  266         int i;
  267 
  268         SIO_CLR(VR_MIICMD_CLK);
  269 
  270         for (i = (0x1 << (cnt - 1)); i; i >>= 1) {
  271                 if (bits & i)
  272                         SIO_SET(VR_MIICMD_DATAIN);
  273                 else
  274                         SIO_CLR(VR_MIICMD_DATAIN);
  275                 DELAY(1);
  276                 SIO_CLR(VR_MIICMD_CLK);
  277                 DELAY(1);
  278                 SIO_SET(VR_MIICMD_CLK);
  279         }
  280 }
  281 #endif
  282 
  283 /*
  284  * Read an PHY register through the MII.
  285  */
  286 static int
  287 vr_mii_readreg(struct vr_softc *sc, struct vr_mii_frame *frame)
  288 #ifdef VR_USESWSHIFT    
  289 {
  290         int i, ack;
  291 
  292         /* Set up frame for RX. */
  293         frame->mii_stdelim = VR_MII_STARTDELIM;
  294         frame->mii_opcode = VR_MII_READOP;
  295         frame->mii_turnaround = 0;
  296         frame->mii_data = 0;
  297         
  298         CSR_WRITE_1(sc, VR_MIICMD, 0);
  299         VR_SETBIT(sc, VR_MIICMD, VR_MIICMD_DIRECTPGM);
  300 
  301         /* Turn on data xmit. */
  302         SIO_SET(VR_MIICMD_DIR);
  303 
  304         vr_mii_sync(sc);
  305 
  306         /* Send command/address info. */
  307         vr_mii_send(sc, frame->mii_stdelim, 2);
  308         vr_mii_send(sc, frame->mii_opcode, 2);
  309         vr_mii_send(sc, frame->mii_phyaddr, 5);
  310         vr_mii_send(sc, frame->mii_regaddr, 5);
  311 
  312         /* Idle bit. */
  313         SIO_CLR((VR_MIICMD_CLK|VR_MIICMD_DATAIN));
  314         DELAY(1);
  315         SIO_SET(VR_MIICMD_CLK);
  316         DELAY(1);
  317 
  318         /* Turn off xmit. */
  319         SIO_CLR(VR_MIICMD_DIR);
  320 
  321         /* Check for ack */
  322         SIO_CLR(VR_MIICMD_CLK);
  323         DELAY(1);
  324         ack = CSR_READ_4(sc, VR_MIICMD) & VR_MIICMD_DATAOUT;
  325         SIO_SET(VR_MIICMD_CLK);
  326         DELAY(1);
  327 
  328         /*
  329          * Now try reading data bits. If the ack failed, we still
  330          * need to clock through 16 cycles to keep the PHY(s) in sync.
  331          */
  332         if (ack) {
  333                 for(i = 0; i < 16; i++) {
  334                         SIO_CLR(VR_MIICMD_CLK);
  335                         DELAY(1);
  336                         SIO_SET(VR_MIICMD_CLK);
  337                         DELAY(1);
  338                 }
  339                 goto fail;
  340         }
  341 
  342         for (i = 0x8000; i; i >>= 1) {
  343                 SIO_CLR(VR_MIICMD_CLK);
  344                 DELAY(1);
  345                 if (!ack) {
  346                         if (CSR_READ_4(sc, VR_MIICMD) & VR_MIICMD_DATAOUT)
  347                                 frame->mii_data |= i;
  348                         DELAY(1);
  349                 }
  350                 SIO_SET(VR_MIICMD_CLK);
  351                 DELAY(1);
  352         }
  353 
  354 fail:
  355         SIO_CLR(VR_MIICMD_CLK);
  356         DELAY(1);
  357         SIO_SET(VR_MIICMD_CLK);
  358         DELAY(1);
  359 
  360         if (ack)
  361                 return(1);
  362         return(0);
  363 }
  364 #else
  365 {
  366         int i;
  367 
  368         /* Set the PHY address. */
  369         CSR_WRITE_1(sc, VR_PHYADDR, (CSR_READ_1(sc, VR_PHYADDR)& 0xe0)|
  370             frame->mii_phyaddr);
  371 
  372         /* Set the register address. */
  373         CSR_WRITE_1(sc, VR_MIIADDR, frame->mii_regaddr);
  374         VR_SETBIT(sc, VR_MIICMD, VR_MIICMD_READ_ENB);
  375         
  376         for (i = 0; i < 10000; i++) {
  377                 if ((CSR_READ_1(sc, VR_MIICMD) & VR_MIICMD_READ_ENB) == 0)
  378                         break;
  379                 DELAY(1);
  380         }
  381         frame->mii_data = CSR_READ_2(sc, VR_MIIDATA);
  382 
  383         return(0);
  384 }
  385 #endif
  386 
  387 
  388 /*
  389  * Write to a PHY register through the MII.
  390  */
  391 static int
  392 vr_mii_writereg(struct vr_softc *sc, struct vr_mii_frame *frame)
  393 #ifdef VR_USESWSHIFT    
  394 {
  395         CSR_WRITE_1(sc, VR_MIICMD, 0);
  396         VR_SETBIT(sc, VR_MIICMD, VR_MIICMD_DIRECTPGM);
  397 
  398         /* Set up frame for TX. */
  399         frame->mii_stdelim = VR_MII_STARTDELIM;
  400         frame->mii_opcode = VR_MII_WRITEOP;
  401         frame->mii_turnaround = VR_MII_TURNAROUND;
  402         
  403         /* Turn on data output. */
  404         SIO_SET(VR_MIICMD_DIR);
  405 
  406         vr_mii_sync(sc);
  407 
  408         vr_mii_send(sc, frame->mii_stdelim, 2);
  409         vr_mii_send(sc, frame->mii_opcode, 2);
  410         vr_mii_send(sc, frame->mii_phyaddr, 5);
  411         vr_mii_send(sc, frame->mii_regaddr, 5);
  412         vr_mii_send(sc, frame->mii_turnaround, 2);
  413         vr_mii_send(sc, frame->mii_data, 16);
  414 
  415         /* Idle bit. */
  416         SIO_SET(VR_MIICMD_CLK);
  417         DELAY(1);
  418         SIO_CLR(VR_MIICMD_CLK);
  419         DELAY(1);
  420 
  421         /* Turn off xmit. */
  422         SIO_CLR(VR_MIICMD_DIR);
  423 
  424         return(0);
  425 }
  426 #else
  427 {
  428         int i;
  429 
  430         /* Set the PHY-adress */
  431         CSR_WRITE_1(sc, VR_PHYADDR, (CSR_READ_1(sc, VR_PHYADDR)& 0xe0)|
  432                     frame->mii_phyaddr);
  433 
  434         /* Set the register address and data to write. */
  435         CSR_WRITE_1(sc, VR_MIIADDR, frame->mii_regaddr);
  436         CSR_WRITE_2(sc, VR_MIIDATA, frame->mii_data);
  437 
  438         VR_SETBIT(sc, VR_MIICMD, VR_MIICMD_WRITE_ENB);
  439 
  440         for (i = 0; i < 10000; i++) {
  441                 if ((CSR_READ_1(sc, VR_MIICMD) & VR_MIICMD_WRITE_ENB) == 0)
  442                         break;
  443                 DELAY(1);
  444         }
  445         return(0);
  446 }
  447 #endif
  448 
  449 static int
  450 vr_miibus_readreg(device_t dev, int phy, int reg)
  451 {
  452         struct vr_mii_frame frame;
  453         struct vr_softc *sc;
  454 
  455         sc = device_get_softc(dev);
  456 
  457         switch (sc->vr_revid) {
  458         case REV_ID_VT6102_APOLLO:
  459                 if (phy != 1)
  460                         return(0);
  461                 break;
  462         default:
  463                 break;
  464         }
  465 
  466         bzero(&frame, sizeof(frame));
  467 
  468         frame.mii_phyaddr = phy;
  469         frame.mii_regaddr = reg;
  470         vr_mii_readreg(sc, &frame);
  471 
  472         return(frame.mii_data);
  473 }
  474 
  475 static int
  476 vr_miibus_writereg(device_t dev, int phy, int reg, int data)
  477 {
  478         struct vr_mii_frame frame;
  479         struct vr_softc *sc;
  480 
  481         sc = device_get_softc(dev);
  482 
  483         switch (sc->vr_revid) {
  484         case REV_ID_VT6102_APOLLO:
  485                 if (phy != 1)
  486                         return 0;
  487                 break;
  488         default:
  489                 break;
  490         }
  491 
  492         bzero(&frame, sizeof(frame));
  493 
  494         frame.mii_phyaddr = phy;
  495         frame.mii_regaddr = reg;
  496         frame.mii_data = data;
  497 
  498         vr_mii_writereg(sc, &frame);
  499 
  500         return(0);
  501 }
  502 
  503 static void
  504 vr_miibus_statchg(device_t dev)
  505 {
  506         struct mii_data *mii;
  507         struct vr_softc *sc;
  508 
  509         sc = device_get_softc(dev);
  510         mii = device_get_softc(sc->vr_miibus);
  511         vr_setcfg(sc, mii->mii_media_active);
  512 }
  513 
  514 /*
  515  * Program the 64-bit multicast hash filter.
  516  */
  517 static void
  518 vr_setmulti(struct vr_softc *sc)
  519 {
  520         struct ifnet *ifp;
  521         uint32_t hashes[2] = { 0, 0 };
  522         struct ifmultiaddr *ifma;
  523         uint8_t rxfilt;
  524         int mcnt = 0;
  525 
  526         ifp = &sc->arpcom.ac_if;
  527 
  528         rxfilt = CSR_READ_1(sc, VR_RXCFG);
  529 
  530         if (ifp->if_flags & IFF_ALLMULTI || ifp->if_flags & IFF_PROMISC) {
  531                 rxfilt |= VR_RXCFG_RX_MULTI;
  532                 CSR_WRITE_1(sc, VR_RXCFG, rxfilt);
  533                 CSR_WRITE_4(sc, VR_MAR0, 0xFFFFFFFF);
  534                 CSR_WRITE_4(sc, VR_MAR1, 0xFFFFFFFF);
  535                 return;
  536         }
  537 
  538         /* First, zero out all the existing hash bits. */
  539         CSR_WRITE_4(sc, VR_MAR0, 0);
  540         CSR_WRITE_4(sc, VR_MAR1, 0);
  541 
  542         /* Now program new ones. */
  543         TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) {
  544                 int h;
  545 
  546                 if (ifma->ifma_addr->sa_family != AF_LINK)
  547                         continue;
  548 
  549                 /* use the lower 6 bits */
  550                 h = (ether_crc32_be(
  551                         LLADDR((struct sockaddr_dl *)ifma->ifma_addr),
  552                         ETHER_ADDR_LEN) >> 26) & 0x0000003F;
  553                 if (h < 32)
  554                         hashes[0] |= (1 << h);
  555                 else
  556                         hashes[1] |= (1 << (h - 32));
  557                 mcnt++;
  558         }
  559 
  560         if (mcnt)
  561                 rxfilt |= VR_RXCFG_RX_MULTI;
  562         else
  563                 rxfilt &= ~VR_RXCFG_RX_MULTI;
  564 
  565         CSR_WRITE_4(sc, VR_MAR0, hashes[0]);
  566         CSR_WRITE_4(sc, VR_MAR1, hashes[1]);
  567         CSR_WRITE_1(sc, VR_RXCFG, rxfilt);
  568 }
  569 
  570 /*
  571  * In order to fiddle with the
  572  * 'full-duplex' and '100Mbps' bits in the netconfig register, we
  573  * first have to put the transmit and/or receive logic in the idle state.
  574  */
  575 static void
  576 vr_setcfg(struct vr_softc *sc, int media)
  577 {
  578         int restart = 0;
  579 
  580         if (CSR_READ_2(sc, VR_COMMAND) & (VR_CMD_TX_ON|VR_CMD_RX_ON)) {
  581                 restart = 1;
  582                 VR_CLRBIT16(sc, VR_COMMAND, (VR_CMD_TX_ON|VR_CMD_RX_ON));
  583         }
  584 
  585         if ((media & IFM_GMASK) == IFM_FDX)
  586                 VR_SETBIT16(sc, VR_COMMAND, VR_CMD_FULLDUPLEX);
  587         else
  588                 VR_CLRBIT16(sc, VR_COMMAND, VR_CMD_FULLDUPLEX);
  589 
  590         if (restart)
  591                 VR_SETBIT16(sc, VR_COMMAND, VR_CMD_TX_ON|VR_CMD_RX_ON);
  592 }
  593 
  594 static void
  595 vr_reset(struct vr_softc *sc)
  596 {
  597         int i;
  598 
  599         VR_SETBIT16(sc, VR_COMMAND, VR_CMD_RESET);
  600 
  601         for (i = 0; i < VR_TIMEOUT; i++) {
  602                 DELAY(10);
  603                 if (!(CSR_READ_2(sc, VR_COMMAND) & VR_CMD_RESET))
  604                         break;
  605         }
  606         if (i == VR_TIMEOUT) {
  607                 struct ifnet *ifp = &sc->arpcom.ac_if;
  608 
  609                 if (sc->vr_revid < REV_ID_VT3065_A) {
  610                         if_printf(ifp, "reset never completed!\n");
  611                 } else {
  612                         /* Use newer force reset command */
  613                         if_printf(ifp, "Using force reset command.\n");
  614                         VR_SETBIT(sc, VR_MISC_CR1, VR_MISCCR1_FORSRST);
  615                 }
  616         }
  617 
  618         /* Wait a little while for the chip to get its brains in order. */
  619         DELAY(1000);
  620 }
  621 
  622 /*
  623  * Probe for a VIA Rhine chip. Check the PCI vendor and device
  624  * IDs against our list and return a device name if we find a match.
  625  */
  626 static int
  627 vr_probe(device_t dev)
  628 {
  629         struct vr_type *t;
  630         uint16_t vid, did;
  631 
  632         vid = pci_get_vendor(dev);
  633         did = pci_get_device(dev);
  634 
  635         for (t = vr_devs; t->vr_name != NULL; ++t) {
  636                 if (vid == t->vr_vid && did == t->vr_did) {
  637                         device_set_desc(dev, t->vr_name);
  638                         return(0);
  639                 }
  640         }
  641 
  642         return(ENXIO);
  643 }
  644 
  645 /*
  646  * Attach the interface. Allocate softc structures, do ifmedia
  647  * setup and ethernet/BPF attach.
  648  */
  649 static int
  650 vr_attach(device_t dev)
  651 {
  652         int i;
  653         uint8_t eaddr[ETHER_ADDR_LEN];
  654         struct vr_softc *sc;
  655         struct ifnet *ifp;
  656         int error = 0, rid;
  657 
  658         sc = device_get_softc(dev);
  659         callout_init(&sc->vr_stat_timer);
  660 
  661         /*
  662          * Handle power management nonsense.
  663          */
  664         if (pci_get_powerstate(dev) != PCI_POWERSTATE_D0) {
  665                 uint32_t iobase, membase, irq;
  666 
  667                 /* Save important PCI config data. */
  668                 iobase = pci_read_config(dev, VR_PCI_LOIO, 4);
  669                 membase = pci_read_config(dev, VR_PCI_LOMEM, 4);
  670                 irq = pci_read_config(dev, VR_PCI_INTLINE, 4);
  671 
  672                 /* Reset the power state. */
  673                 device_printf(dev, "chip is in D%d power mode "
  674                 "-- setting to D0\n", pci_get_powerstate(dev));
  675                 pci_set_powerstate(dev, PCI_POWERSTATE_D0);
  676 
  677                 /* Restore PCI config data. */
  678                 pci_write_config(dev, VR_PCI_LOIO, iobase, 4);
  679                 pci_write_config(dev, VR_PCI_LOMEM, membase, 4);
  680                 pci_write_config(dev, VR_PCI_INTLINE, irq, 4);
  681         }
  682 
  683         pci_enable_busmaster(dev);
  684 
  685         sc->vr_revid = pci_get_revid(dev);
  686 
  687         rid = VR_RID;
  688         sc->vr_res = bus_alloc_resource_any(dev, VR_RES, &rid, RF_ACTIVE);
  689 
  690         if (sc->vr_res == NULL) {
  691                 device_printf(dev, "couldn't map ports/memory\n");
  692                 return ENXIO;
  693         }
  694 
  695         sc->vr_btag = rman_get_bustag(sc->vr_res);
  696         sc->vr_bhandle = rman_get_bushandle(sc->vr_res);
  697 
  698         /* Allocate interrupt */
  699         rid = 0;
  700         sc->vr_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid,
  701                                             RF_SHAREABLE | RF_ACTIVE);
  702 
  703         if (sc->vr_irq == NULL) {
  704                 device_printf(dev, "couldn't map interrupt\n");
  705                 error = ENXIO;
  706                 goto fail;
  707         }
  708 
  709         /*
  710          * Windows may put the chip in suspend mode when it
  711          * shuts down. Be sure to kick it in the head to wake it
  712          * up again.
  713          */
  714         VR_CLRBIT(sc, VR_STICKHW, (VR_STICKHW_DS0|VR_STICKHW_DS1));
  715 
  716         ifp = &sc->arpcom.ac_if;
  717         if_initname(ifp, device_get_name(dev), device_get_unit(dev));
  718 
  719         /* Reset the adapter. */
  720         vr_reset(sc);
  721 
  722         /*
  723          * Turn on bit2 (MIION) in PCI configuration register 0x53 during
  724          * initialization and disable AUTOPOLL.
  725          */
  726         pci_write_config(dev, VR_PCI_MODE,
  727             pci_read_config(dev, VR_PCI_MODE, 4) | (VR_MODE3_MIION << 24), 4);
  728         VR_CLRBIT(sc, VR_MIICMD, VR_MIICMD_AUTOPOLL);
  729 
  730         /*
  731          * Get station address. The way the Rhine chips work,
  732          * you're not allowed to directly access the EEPROM once
  733          * they've been programmed a special way. Consequently,
  734          * we need to read the node address from the PAR0 and PAR1
  735          * registers.
  736          */
  737         VR_SETBIT(sc, VR_EECSR, VR_EECSR_LOAD);
  738         DELAY(200);
  739         for (i = 0; i < ETHER_ADDR_LEN; i++)
  740                 eaddr[i] = CSR_READ_1(sc, VR_PAR0 + i);
  741 
  742         sc->vr_ldata = contigmalloc(sizeof(struct vr_list_data), M_DEVBUF,
  743             M_WAITOK | M_ZERO, 0, 0xffffffff, PAGE_SIZE, 0);
  744 
  745         if (sc->vr_ldata == NULL) {
  746                 device_printf(dev, "no memory for list buffers!\n");
  747                 error = ENXIO;
  748                 goto fail;
  749         }
  750 
  751         /* Initialize TX buffer */
  752         sc->vr_cdata.vr_tx_buf = contigmalloc(VR_TX_BUF_SIZE, M_DEVBUF,
  753             M_WAITOK, 0, 0xffffffff, PAGE_SIZE, 0);
  754         if (sc->vr_cdata.vr_tx_buf == NULL) {
  755                 device_printf(dev, "can't allocate tx buffer!\n");
  756                 error = ENXIO;
  757                 goto fail;
  758         }
  759 
  760         /* Set various TX indexes to invalid value */
  761         sc->vr_cdata.vr_tx_free_idx = -1;
  762         sc->vr_cdata.vr_tx_tail_idx = -1;
  763         sc->vr_cdata.vr_tx_head_idx = -1;
  764 
  765 
  766         ifp->if_softc = sc;
  767         ifp->if_mtu = ETHERMTU;
  768         ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
  769         ifp->if_ioctl = vr_ioctl;
  770         ifp->if_start = vr_start;
  771 #ifdef IFPOLL_ENABLE
  772         ifp->if_npoll = vr_npoll;
  773 #endif
  774         ifp->if_watchdog = vr_watchdog;
  775         ifp->if_init = vr_init;
  776         ifp->if_baudrate = 10000000;
  777         ifq_set_maxlen(&ifp->if_snd, VR_TX_LIST_CNT - 1);
  778         ifq_set_ready(&ifp->if_snd);
  779 
  780         /*
  781          * Do MII setup.
  782          */
  783         if (mii_phy_probe(dev, &sc->vr_miibus,
  784             vr_ifmedia_upd, vr_ifmedia_sts)) {
  785                 if_printf(ifp, "MII without any phy!\n");
  786                 error = ENXIO;
  787                 goto fail;
  788         }
  789 
  790         /* Call MI attach routine. */
  791         ether_ifattach(ifp, eaddr, NULL);
  792 
  793         ifq_set_cpuid(&ifp->if_snd, rman_get_cpuid(sc->vr_irq));
  794 
  795 #ifdef IFPOLL_ENABLE
  796         ifpoll_compat_setup(&sc->vr_npoll, NULL, NULL, device_get_unit(dev),
  797             ifp->if_serializer);
  798 #endif
  799 
  800         error = bus_setup_intr(dev, sc->vr_irq, INTR_MPSAFE,
  801                                vr_intr, sc, &sc->vr_intrhand, 
  802                                ifp->if_serializer);
  803         if (error) {
  804                 device_printf(dev, "couldn't set up irq\n");
  805                 ether_ifdetach(ifp);
  806                 goto fail;
  807         }
  808 
  809         return 0;
  810 
  811 fail:
  812         vr_detach(dev);
  813         return(error);
  814 }
  815 
  816 static int
  817 vr_detach(device_t dev)
  818 {
  819         struct vr_softc *sc = device_get_softc(dev);
  820         struct ifnet *ifp = &sc->arpcom.ac_if;
  821 
  822         if (device_is_attached(dev)) {
  823                 lwkt_serialize_enter(ifp->if_serializer);
  824                 vr_stop(sc);
  825                 bus_teardown_intr(dev, sc->vr_irq, sc->vr_intrhand);
  826                 lwkt_serialize_exit(ifp->if_serializer);
  827 
  828                 ether_ifdetach(ifp);
  829         }
  830         if (sc->vr_miibus != NULL)
  831                 device_delete_child(dev, sc->vr_miibus);
  832         bus_generic_detach(dev);
  833 
  834         if (sc->vr_irq != NULL)
  835                 bus_release_resource(dev, SYS_RES_IRQ, 0, sc->vr_irq);
  836         if (sc->vr_res != NULL)
  837                 bus_release_resource(dev, VR_RES, VR_RID, sc->vr_res);
  838         if (sc->vr_ldata != NULL)
  839                 contigfree(sc->vr_ldata, sizeof(struct vr_list_data), M_DEVBUF);
  840         if (sc->vr_cdata.vr_tx_buf != NULL)
  841                 contigfree(sc->vr_cdata.vr_tx_buf, VR_TX_BUF_SIZE, M_DEVBUF);
  842 
  843         return(0);
  844 }
  845 
  846 /*
  847  * Initialize the transmit descriptors.
  848  */
  849 static int
  850 vr_list_tx_init(struct vr_softc *sc)
  851 {
  852         struct vr_chain_data *cd;
  853         struct vr_list_data *ld;
  854         struct vr_chain *tx_chain;
  855         int i;
  856 
  857         cd = &sc->vr_cdata;
  858         ld = sc->vr_ldata;
  859         tx_chain = cd->vr_tx_chain;
  860 
  861         for (i = 0; i < VR_TX_LIST_CNT; i++) {
  862                 tx_chain[i].vr_ptr = &ld->vr_tx_list[i];
  863                 if (i == (VR_TX_LIST_CNT - 1))
  864                         tx_chain[i].vr_next_idx = 0;
  865                 else
  866                         tx_chain[i].vr_next_idx = i + 1;
  867         }
  868 
  869         for (i = 0; i < VR_TX_LIST_CNT; ++i) {
  870                 void *tx_buf;
  871                 int next_idx;
  872 
  873                 tx_buf = VR_TX_BUF(sc, i);
  874                 next_idx = tx_chain[i].vr_next_idx;
  875 
  876                 tx_chain[i].vr_next_desc_paddr =
  877                         vtophys(tx_chain[next_idx].vr_ptr);
  878                 tx_chain[i].vr_buf_paddr = vtophys(tx_buf);
  879         }
  880 
  881         cd->vr_tx_free_idx = 0;
  882         cd->vr_tx_tail_idx = cd->vr_tx_head_idx = -1;
  883 
  884         return 0;
  885 }
  886 
  887 
  888 /*
  889  * Initialize the RX descriptors and allocate mbufs for them. Note that
  890  * we arrange the descriptors in a closed ring, so that the last descriptor
  891  * points back to the first.
  892  */
  893 static int
  894 vr_list_rx_init(struct vr_softc *sc)
  895 {
  896         struct vr_chain_data *cd;
  897         struct vr_list_data *ld;
  898         int i, nexti;
  899 
  900         cd = &sc->vr_cdata;
  901         ld = sc->vr_ldata;
  902 
  903         for (i = 0; i < VR_RX_LIST_CNT; i++) {
  904                 cd->vr_rx_chain[i].vr_ptr = (struct vr_desc *)&ld->vr_rx_list[i];
  905                 if (vr_newbuf(sc, &cd->vr_rx_chain[i], NULL) == ENOBUFS)
  906                         return(ENOBUFS);
  907                 if (i == (VR_RX_LIST_CNT - 1))
  908                         nexti = 0;
  909                 else
  910                         nexti = i + 1;
  911                 cd->vr_rx_chain[i].vr_nextdesc = &cd->vr_rx_chain[nexti];
  912                 ld->vr_rx_list[i].vr_next = vtophys(&ld->vr_rx_list[nexti]);
  913         }
  914 
  915         cd->vr_rx_head = &cd->vr_rx_chain[0];
  916 
  917         return(0);
  918 }
  919 
  920 /*
  921  * Initialize an RX descriptor and attach an MBUF cluster.
  922  * Note: the length fields are only 11 bits wide, which means the
  923  * largest size we can specify is 2047. This is important because
  924  * MCLBYTES is 2048, so we have to subtract one otherwise we'll
  925  * overflow the field and make a mess.
  926  */
  927 static int
  928 vr_newbuf(struct vr_softc *sc, struct vr_chain_onefrag *c, struct mbuf *m)
  929 {
  930         struct mbuf *m_new = NULL;
  931 
  932         if (m == NULL) {
  933                 m_new = m_getcl(MB_DONTWAIT, MT_DATA, M_PKTHDR);
  934                 if (m_new == NULL)
  935                         return (ENOBUFS);
  936                 m_new->m_len = m_new->m_pkthdr.len = MCLBYTES;
  937         } else {
  938                 m_new = m;
  939                 m_new->m_len = m_new->m_pkthdr.len = MCLBYTES;
  940                 m_new->m_data = m_new->m_ext.ext_buf;
  941         }
  942 
  943         m_adj(m_new, sizeof(uint64_t));
  944 
  945         c->vr_mbuf = m_new;
  946         c->vr_ptr->vr_status = VR_RXSTAT;
  947         c->vr_ptr->vr_data = vtophys(mtod(m_new, caddr_t));
  948         c->vr_ptr->vr_ctl = VR_RXCTL | VR_RXLEN;
  949 
  950         return(0);
  951 }
  952 
  953 /*
  954  * A frame has been uploaded: pass the resulting mbuf chain up to
  955  * the higher level protocols.
  956  */
  957 static void
  958 vr_rxeof(struct vr_softc *sc)
  959 {
  960         struct mbuf *m;
  961         struct ifnet *ifp;
  962         struct vr_chain_onefrag *cur_rx;
  963         int total_len = 0;
  964         uint32_t rxstat;
  965 
  966         ifp = &sc->arpcom.ac_if;
  967 
  968         while(!((rxstat = sc->vr_cdata.vr_rx_head->vr_ptr->vr_status) &
  969                                                         VR_RXSTAT_OWN)) {
  970                 struct mbuf *m0 = NULL;
  971 
  972                 cur_rx = sc->vr_cdata.vr_rx_head;
  973                 sc->vr_cdata.vr_rx_head = cur_rx->vr_nextdesc;
  974                 m = cur_rx->vr_mbuf;
  975 
  976                 /*
  977                  * If an error occurs, update stats, clear the
  978                  * status word and leave the mbuf cluster in place:
  979                  * it should simply get re-used next time this descriptor
  980                  * comes up in the ring.
  981                  */
  982                 if (rxstat & VR_RXSTAT_RXERR) {
  983                         IFNET_STAT_INC(ifp, ierrors, 1);
  984                         if_printf(ifp, "rx error (%02x):", rxstat & 0x000000ff);
  985                         if (rxstat & VR_RXSTAT_CRCERR)
  986                                 kprintf(" crc error");
  987                         if (rxstat & VR_RXSTAT_FRAMEALIGNERR)
  988                                 kprintf(" frame alignment error\n");
  989                         if (rxstat & VR_RXSTAT_FIFOOFLOW)
  990                                 kprintf(" FIFO overflow");
  991                         if (rxstat & VR_RXSTAT_GIANT)
  992                                 kprintf(" received giant packet");
  993                         if (rxstat & VR_RXSTAT_RUNT)
  994                                 kprintf(" received runt packet");
  995                         if (rxstat & VR_RXSTAT_BUSERR)
  996                                 kprintf(" system bus error");
  997                         if (rxstat & VR_RXSTAT_BUFFERR)
  998                                 kprintf("rx buffer error");
  999                         kprintf("\n");
 1000                         vr_newbuf(sc, cur_rx, m);
 1001                         continue;
 1002                 }
 1003 
 1004                 /* No errors; receive the packet. */    
 1005                 total_len = VR_RXBYTES(cur_rx->vr_ptr->vr_status);
 1006 
 1007                 /*
 1008                  * XXX The VIA Rhine chip includes the CRC with every
 1009                  * received frame, and there's no way to turn this
 1010                  * behavior off (at least, I can't find anything in
 1011                  * the manual that explains how to do it) so we have
 1012                  * to trim off the CRC manually.
 1013                  */
 1014                 total_len -= ETHER_CRC_LEN;
 1015 
 1016                 m0 = m_devget(mtod(m, char *) - ETHER_ALIGN,
 1017                     total_len + ETHER_ALIGN, 0, ifp, NULL);
 1018                 vr_newbuf(sc, cur_rx, m);
 1019                 if (m0 == NULL) {
 1020                         IFNET_STAT_INC(ifp, ierrors, 1);
 1021                         continue;
 1022                 }
 1023                 m_adj(m0, ETHER_ALIGN);
 1024                 m = m0;
 1025 
 1026                 IFNET_STAT_INC(ifp, ipackets, 1);
 1027                 ifp->if_input(ifp, m);
 1028         }
 1029 }
 1030 
 1031 static void
 1032 vr_rxeoc(struct vr_softc *sc)
 1033 {
 1034         struct ifnet *ifp;
 1035         int i;
 1036 
 1037         ifp = &sc->arpcom.ac_if;
 1038 
 1039         IFNET_STAT_INC(ifp, ierrors, 1);
 1040 
 1041         VR_CLRBIT16(sc, VR_COMMAND, VR_CMD_RX_ON);      
 1042         DELAY(10000);
 1043 
 1044         /* Wait for receiver to stop */
 1045         for (i = 0x400;
 1046              i && (CSR_READ_2(sc, VR_COMMAND) & VR_CMD_RX_ON);
 1047              i--)
 1048                 ;       /* Wait for receiver to stop */
 1049 
 1050         if (i == 0) {
 1051                 if_printf(ifp, "rx shutdown error!\n");
 1052                 sc->vr_flags |= VR_F_RESTART;
 1053                 return;
 1054         }
 1055 
 1056         vr_rxeof(sc);
 1057 
 1058         CSR_WRITE_4(sc, VR_RXADDR, vtophys(sc->vr_cdata.vr_rx_head->vr_ptr));
 1059         VR_SETBIT16(sc, VR_COMMAND, VR_CMD_RX_ON);
 1060         VR_SETBIT16(sc, VR_COMMAND, VR_CMD_RX_GO);
 1061 }
 1062 
 1063 /*
 1064  * A frame was downloaded to the chip. It's safe for us to clean up
 1065  * the list buffers.
 1066  */
 1067 static void
 1068 vr_txeof(struct vr_softc *sc)
 1069 {
 1070         struct vr_chain_data *cd;
 1071         struct vr_chain *tx_chain;
 1072         struct ifnet *ifp;
 1073 
 1074         ifp = &sc->arpcom.ac_if;
 1075         cd = &sc->vr_cdata;
 1076 
 1077         /* Reset the timeout timer; if_txeoc will clear it. */
 1078         ifp->if_timer = 5;
 1079 
 1080         /* Sanity check. */
 1081         if (cd->vr_tx_head_idx == -1)
 1082                 return;
 1083 
 1084         tx_chain = cd->vr_tx_chain;
 1085 
 1086         /*
 1087          * Go through our tx list and free mbufs for those
 1088          * frames that have been transmitted.
 1089          */
 1090         while(tx_chain[cd->vr_tx_head_idx].vr_buf != NULL) {
 1091                 struct vr_chain *cur_tx;
 1092                 uint32_t txstat;
 1093                 int i;
 1094 
 1095                 cur_tx = &tx_chain[cd->vr_tx_head_idx];
 1096                 txstat = cur_tx->vr_ptr->vr_status;
 1097 
 1098                 if ((txstat & VR_TXSTAT_ABRT) ||
 1099                     (txstat & VR_TXSTAT_UDF)) {
 1100                         for (i = 0x400;
 1101                              i && (CSR_READ_2(sc, VR_COMMAND) & VR_CMD_TX_ON);
 1102                              i--)
 1103                                 ;       /* Wait for chip to shutdown */
 1104                         if (i == 0) {
 1105                                 if_printf(ifp, "tx shutdown timeout\n");
 1106                                 sc->vr_flags |= VR_F_RESTART;
 1107                                 break;
 1108                         }
 1109                         VR_TXOWN(cur_tx) = VR_TXSTAT_OWN;
 1110                         CSR_WRITE_4(sc, VR_TXADDR, vtophys(cur_tx->vr_ptr));
 1111                         break;
 1112                 }
 1113 
 1114                 if (txstat & VR_TXSTAT_OWN)
 1115                         break;
 1116 
 1117                 if (txstat & VR_TXSTAT_ERRSUM) {
 1118                         IFNET_STAT_INC(ifp, oerrors, 1);
 1119                         if (txstat & VR_TXSTAT_DEFER)
 1120                                 IFNET_STAT_INC(ifp, collisions, 1);
 1121                         if (txstat & VR_TXSTAT_LATECOLL)
 1122                                 IFNET_STAT_INC(ifp, collisions, 1);
 1123                 }
 1124 
 1125                 IFNET_STAT_INC(ifp, collisions,
 1126                     (txstat & VR_TXSTAT_COLLCNT) >> 3);
 1127 
 1128                 IFNET_STAT_INC(ifp, opackets, 1);
 1129                 cur_tx->vr_buf = NULL;
 1130 
 1131                 if (cd->vr_tx_head_idx == cd->vr_tx_tail_idx) {
 1132                         cd->vr_tx_head_idx = -1;
 1133                         cd->vr_tx_tail_idx = -1;
 1134                         break;
 1135                 }
 1136 
 1137                 cd->vr_tx_head_idx = cur_tx->vr_next_idx;
 1138         }
 1139 }
 1140 
 1141 /*
 1142  * TX 'end of channel' interrupt handler.
 1143  */
 1144 static void
 1145 vr_txeoc(struct vr_softc *sc)
 1146 {
 1147         struct ifnet *ifp;
 1148 
 1149         ifp = &sc->arpcom.ac_if;
 1150 
 1151         if (sc->vr_cdata.vr_tx_head_idx == -1) {
 1152                 ifq_clr_oactive(&ifp->if_snd);
 1153                 sc->vr_cdata.vr_tx_tail_idx = -1;
 1154                 ifp->if_timer = 0;
 1155         }
 1156 }
 1157 
 1158 static void
 1159 vr_tick(void *xsc)
 1160 {
 1161         struct vr_softc *sc = xsc;
 1162         struct ifnet *ifp = &sc->arpcom.ac_if;
 1163         struct mii_data *mii;
 1164 
 1165         lwkt_serialize_enter(ifp->if_serializer);
 1166 
 1167         if (sc->vr_flags & VR_F_RESTART) {
 1168                 if_printf(&sc->arpcom.ac_if, "restarting\n");
 1169                 vr_stop(sc);
 1170                 vr_reset(sc);
 1171                 vr_init(sc);
 1172                 sc->vr_flags &= ~VR_F_RESTART;
 1173         }
 1174 
 1175         mii = device_get_softc(sc->vr_miibus);
 1176         mii_tick(mii);
 1177 
 1178         callout_reset(&sc->vr_stat_timer, hz, vr_tick, sc);
 1179 
 1180         lwkt_serialize_exit(ifp->if_serializer);
 1181 }
 1182 
 1183 static void
 1184 vr_intr(void *arg)
 1185 {
 1186         struct vr_softc *sc;
 1187         struct ifnet *ifp;
 1188         uint16_t status;
 1189 
 1190         sc = arg;
 1191         ifp = &sc->arpcom.ac_if;
 1192 
 1193         /* Supress unwanted interrupts. */
 1194         if (!(ifp->if_flags & IFF_UP)) {
 1195                 vr_stop(sc);
 1196                 return;
 1197         }
 1198 
 1199         /* Disable interrupts. */
 1200         if ((ifp->if_flags & IFF_NPOLLING) == 0)
 1201                 CSR_WRITE_2(sc, VR_IMR, 0x0000);
 1202 
 1203         for (;;) {
 1204                 status = CSR_READ_2(sc, VR_ISR);
 1205                 if (status)
 1206                         CSR_WRITE_2(sc, VR_ISR, status);
 1207 
 1208                 if ((status & VR_INTRS) == 0)
 1209                         break;
 1210 
 1211                 if (status & VR_ISR_RX_OK)
 1212                         vr_rxeof(sc);
 1213 
 1214                 if (status & VR_ISR_RX_DROPPED) {
 1215                         if_printf(ifp, "rx packet lost\n");
 1216                         IFNET_STAT_INC(ifp, ierrors, 1);
 1217                         }
 1218 
 1219                 if ((status & VR_ISR_RX_ERR) || (status & VR_ISR_RX_NOBUF) ||
 1220                     (status & VR_ISR_RX_OFLOW)) {
 1221                         if_printf(ifp, "receive error (%04x)", status);
 1222                         if (status & VR_ISR_RX_NOBUF)
 1223                                 kprintf(" no buffers");
 1224                         if (status & VR_ISR_RX_OFLOW)
 1225                                 kprintf(" overflow");
 1226                         if (status & VR_ISR_RX_DROPPED)
 1227                                 kprintf(" packet lost");
 1228                         kprintf("\n");
 1229                         vr_rxeoc(sc);
 1230                 }
 1231 
 1232                 if ((status & VR_ISR_BUSERR) || (status & VR_ISR_TX_UNDERRUN)) {
 1233                         vr_reset(sc);
 1234                         vr_init(sc);
 1235                         break;
 1236                 }
 1237 
 1238                 if ((status & VR_ISR_TX_OK) || (status & VR_ISR_TX_ABRT) ||
 1239                     (status & VR_ISR_TX_ABRT2) || (status & VR_ISR_UDFI)) {
 1240                         vr_txeof(sc);
 1241                         if ((status & VR_ISR_UDFI) ||
 1242                             (status & VR_ISR_TX_ABRT2) ||
 1243                             (status & VR_ISR_TX_ABRT)) {
 1244                                 IFNET_STAT_INC(ifp, oerrors, 1);
 1245                                 if (sc->vr_cdata.vr_tx_head_idx != -1) {
 1246                                         VR_SETBIT16(sc, VR_COMMAND,
 1247                                                     VR_CMD_TX_ON);
 1248                                         VR_SETBIT16(sc, VR_COMMAND,
 1249                                                     VR_CMD_TX_GO);
 1250                                 }
 1251                         } else {
 1252                                 vr_txeoc(sc);
 1253                         }
 1254                 }
 1255 
 1256         }
 1257 
 1258         /* Re-enable interrupts. */
 1259         if ((ifp->if_flags & IFF_NPOLLING) == 0)
 1260                 CSR_WRITE_2(sc, VR_IMR, VR_INTRS);
 1261 
 1262         if (!ifq_is_empty(&ifp->if_snd))
 1263                 if_devstart(ifp);
 1264 }
 1265 
 1266 /*
 1267  * Encapsulate an mbuf chain in a descriptor by coupling the mbuf data
 1268  * pointers to the fragment pointers.
 1269  */
 1270 static int
 1271 vr_encap(struct vr_softc *sc, int chain_idx, struct mbuf *m_head)
 1272 {
 1273         struct vr_chain *c;
 1274         struct vr_desc *f;
 1275         caddr_t tx_buf;
 1276         int len;
 1277 
 1278         KASSERT(chain_idx >= 0 && chain_idx < VR_TX_LIST_CNT,
 1279                 ("%s: chain idx(%d) out of range 0-%d",
 1280                  sc->arpcom.ac_if.if_xname, chain_idx, VR_TX_LIST_CNT));
 1281 
 1282         /*
 1283          * The VIA Rhine wants packet buffers to be longword
 1284          * aligned, but very often our mbufs aren't. Rather than
 1285          * waste time trying to decide when to copy and when not
 1286          * to copy, just do it all the time.
 1287          */
 1288         tx_buf = VR_TX_BUF(sc, chain_idx);
 1289         m_copydata(m_head, 0, m_head->m_pkthdr.len, tx_buf);
 1290         len = m_head->m_pkthdr.len;
 1291 
 1292         /*
 1293          * The Rhine chip doesn't auto-pad, so we have to make
 1294          * sure to pad short frames out to the minimum frame length
 1295          * ourselves.
 1296          */
 1297         if (len < VR_MIN_FRAMELEN) {
 1298                 bzero(tx_buf + len, VR_MIN_FRAMELEN - len);
 1299                 len = VR_MIN_FRAMELEN;
 1300         }
 1301 
 1302         c = &sc->vr_cdata.vr_tx_chain[chain_idx];
 1303         c->vr_buf = tx_buf;
 1304 
 1305         f = c->vr_ptr;
 1306         f->vr_data = c->vr_buf_paddr;
 1307         f->vr_ctl = len;
 1308         f->vr_ctl |= (VR_TXCTL_TLINK | VR_TXCTL_FIRSTFRAG);
 1309         f->vr_ctl |= (VR_TXCTL_LASTFRAG | VR_TXCTL_FINT);
 1310         f->vr_status = 0;
 1311         f->vr_next = c->vr_next_desc_paddr;
 1312 
 1313         return(0);
 1314 }
 1315 
 1316 /*
 1317  * Main transmit routine. To avoid having to do mbuf copies, we put pointers
 1318  * to the mbuf data regions directly in the transmit lists. We also save a
 1319  * copy of the pointers since the transmit list fragment pointers are
 1320  * physical addresses.
 1321  */
 1322 static void
 1323 vr_start(struct ifnet *ifp, struct ifaltq_subque *ifsq)
 1324 {
 1325         struct vr_softc *sc;
 1326         struct vr_chain_data *cd;
 1327         struct vr_chain *tx_chain;
 1328         int cur_tx_idx, start_tx_idx, prev_tx_idx;
 1329 
 1330         ASSERT_ALTQ_SQ_DEFAULT(ifp, ifsq);
 1331 
 1332         if ((ifp->if_flags & IFF_RUNNING) == 0 || ifq_is_oactive(&ifp->if_snd))
 1333                 return;
 1334 
 1335         sc = ifp->if_softc;
 1336         cd = &sc->vr_cdata;
 1337         tx_chain = cd->vr_tx_chain;
 1338 
 1339         start_tx_idx = cd->vr_tx_free_idx;
 1340         cur_tx_idx = prev_tx_idx = -1;
 1341 
 1342         /* Check for an available queue slot. If there are none, punt. */
 1343         if (tx_chain[start_tx_idx].vr_buf != NULL) {
 1344                 ifq_set_oactive(&ifp->if_snd);
 1345                 return;
 1346         }
 1347 
 1348         while (tx_chain[cd->vr_tx_free_idx].vr_buf == NULL) {
 1349                 struct mbuf *m_head;
 1350                 struct vr_chain *cur_tx;
 1351 
 1352                 m_head = ifq_dequeue(&ifp->if_snd);
 1353                 if (m_head == NULL)
 1354                         break;
 1355 
 1356                 /* Pick a descriptor off the free list. */
 1357                 cur_tx_idx = cd->vr_tx_free_idx;
 1358                 cur_tx = &tx_chain[cur_tx_idx];
 1359 
 1360                 /* Pack the data into the descriptor. */
 1361                 if (vr_encap(sc, cur_tx_idx, m_head)) {
 1362                         ifq_set_oactive(&ifp->if_snd);
 1363                         cur_tx_idx = prev_tx_idx;
 1364                         break;
 1365                 }
 1366 
 1367                 /* XXX */
 1368                 if (cur_tx_idx != start_tx_idx)
 1369                         VR_TXOWN(cur_tx) = VR_TXSTAT_OWN;
 1370 
 1371                 BPF_MTAP(ifp, m_head);
 1372                 m_freem(m_head);
 1373 
 1374                 VR_TXOWN(cur_tx) = VR_TXSTAT_OWN;
 1375                 VR_SETBIT16(sc, VR_COMMAND, /*VR_CMD_TX_ON|*/VR_CMD_TX_GO);
 1376 
 1377                 /* Iff everything went OK, we bump up free index. */
 1378                 prev_tx_idx = cur_tx_idx;
 1379                 cd->vr_tx_free_idx = cur_tx->vr_next_idx;
 1380         }
 1381 
 1382         /* If there are no frames queued, bail. */
 1383         if (cur_tx_idx == -1)
 1384                 return;
 1385 
 1386         sc->vr_cdata.vr_tx_tail_idx = cur_tx_idx;
 1387 
 1388         if (sc->vr_cdata.vr_tx_head_idx == -1)
 1389                 sc->vr_cdata.vr_tx_head_idx = start_tx_idx;
 1390 
 1391         /*
 1392          * Set a timeout in case the chip goes out to lunch.
 1393          */
 1394         ifp->if_timer = 5;
 1395 }
 1396 
 1397 static void
 1398 vr_init(void *xsc)
 1399 {
 1400         struct vr_softc *sc = xsc;
 1401         struct ifnet *ifp = &sc->arpcom.ac_if;
 1402         struct mii_data *mii;
 1403         int i;
 1404 
 1405         mii = device_get_softc(sc->vr_miibus);
 1406 
 1407         /* Cancel pending I/O and free all RX/TX buffers. */
 1408         vr_stop(sc);
 1409         vr_reset(sc);
 1410 
 1411         /* Set our station address. */
 1412         for (i = 0; i < ETHER_ADDR_LEN; i++)
 1413                 CSR_WRITE_1(sc, VR_PAR0 + i, sc->arpcom.ac_enaddr[i]);
 1414 
 1415         /* Set DMA size. */
 1416         VR_CLRBIT(sc, VR_BCR0, VR_BCR0_DMA_LENGTH);
 1417         VR_SETBIT(sc, VR_BCR0, VR_BCR0_DMA_STORENFWD);
 1418 
 1419         /*
 1420          * BCR0 and BCR1 can override the RXCFG and TXCFG registers,
 1421          * so we must set both.
 1422          */
 1423         VR_CLRBIT(sc, VR_BCR0, VR_BCR0_RX_THRESH);
 1424         VR_SETBIT(sc, VR_BCR0, VR_BCR0_RXTHRESH128BYTES);
 1425 
 1426         VR_CLRBIT(sc, VR_BCR1, VR_BCR1_TX_THRESH);
 1427         VR_SETBIT(sc, VR_BCR1, VR_BCR1_TXTHRESHSTORENFWD);
 1428 
 1429         VR_CLRBIT(sc, VR_RXCFG, VR_RXCFG_RX_THRESH);
 1430         VR_SETBIT(sc, VR_RXCFG, VR_RXTHRESH_128BYTES);
 1431 
 1432         VR_CLRBIT(sc, VR_TXCFG, VR_TXCFG_TX_THRESH);
 1433         VR_SETBIT(sc, VR_TXCFG, VR_TXTHRESH_STORENFWD);
 1434 
 1435         /* Init circular RX list. */
 1436         if (vr_list_rx_init(sc) == ENOBUFS) {
 1437                 vr_stop(sc);
 1438                 if_printf(ifp, "initialization failed: no memory for rx buffers\n");
 1439                 return;
 1440         }
 1441 
 1442         /* Init tx descriptors. */
 1443         vr_list_tx_init(sc);
 1444 
 1445         /* If we want promiscuous mode, set the allframes bit. */
 1446         if (ifp->if_flags & IFF_PROMISC)
 1447                 VR_SETBIT(sc, VR_RXCFG, VR_RXCFG_RX_PROMISC);
 1448         else
 1449                 VR_CLRBIT(sc, VR_RXCFG, VR_RXCFG_RX_PROMISC);
 1450 
 1451         /* Set capture broadcast bit to capture broadcast frames. */
 1452         if (ifp->if_flags & IFF_BROADCAST)
 1453                 VR_SETBIT(sc, VR_RXCFG, VR_RXCFG_RX_BROAD);
 1454         else
 1455                 VR_CLRBIT(sc, VR_RXCFG, VR_RXCFG_RX_BROAD);
 1456 
 1457         /*
 1458          * Program the multicast filter, if necessary.
 1459          */
 1460         vr_setmulti(sc);
 1461 
 1462         /*
 1463          * Load the address of the RX list.
 1464          */
 1465         CSR_WRITE_4(sc, VR_RXADDR, vtophys(sc->vr_cdata.vr_rx_head->vr_ptr));
 1466 
 1467         /* Enable receiver and transmitter. */
 1468         CSR_WRITE_2(sc, VR_COMMAND, VR_CMD_TX_NOPOLL|VR_CMD_START|
 1469                                     VR_CMD_TX_ON|VR_CMD_RX_ON|
 1470                                     VR_CMD_RX_GO);
 1471 
 1472         CSR_WRITE_4(sc, VR_TXADDR, vtophys(&sc->vr_ldata->vr_tx_list[0]));
 1473 
 1474         /*
 1475          * Enable interrupts, unless we are polling.
 1476          */
 1477         CSR_WRITE_2(sc, VR_ISR, 0xFFFF);
 1478 #ifdef IFPOLL_ENABLE
 1479         if ((ifp->if_flags & IFF_NPOLLING) == 0)
 1480 #endif
 1481                 CSR_WRITE_2(sc, VR_IMR, VR_INTRS);
 1482 
 1483         mii_mediachg(mii);
 1484 
 1485         ifp->if_flags |= IFF_RUNNING;
 1486         ifq_clr_oactive(&ifp->if_snd);
 1487 
 1488         callout_reset(&sc->vr_stat_timer, hz, vr_tick, sc);
 1489 }
 1490 
 1491 /*
 1492  * Set media options.
 1493  */
 1494 static int
 1495 vr_ifmedia_upd(struct ifnet *ifp)
 1496 {
 1497         struct vr_softc *sc;
 1498 
 1499         sc = ifp->if_softc;
 1500 
 1501         if (ifp->if_flags & IFF_UP)
 1502                 vr_init(sc);
 1503 
 1504         return(0);
 1505 }
 1506 
 1507 /*
 1508  * Report current media status.
 1509  */
 1510 static void
 1511 vr_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr)
 1512 {
 1513         struct vr_softc *sc;
 1514         struct mii_data *mii;
 1515 
 1516         sc = ifp->if_softc;
 1517         mii = device_get_softc(sc->vr_miibus);
 1518         mii_pollstat(mii);
 1519         ifmr->ifm_active = mii->mii_media_active;
 1520         ifmr->ifm_status = mii->mii_media_status;
 1521 }
 1522 
 1523 static int
 1524 vr_ioctl(struct ifnet *ifp, u_long command, caddr_t data, struct ucred *cr)
 1525 {
 1526         struct vr_softc *sc = ifp->if_softc;
 1527         struct ifreq *ifr = (struct ifreq *) data;
 1528         struct mii_data *mii;
 1529         int error = 0;
 1530 
 1531         switch(command) {
 1532         case SIOCSIFFLAGS:
 1533                 if (ifp->if_flags & IFF_UP) {
 1534                         vr_init(sc);
 1535                 } else {
 1536                         if (ifp->if_flags & IFF_RUNNING)
 1537                                 vr_stop(sc);
 1538                 }
 1539                 error = 0;
 1540                 break;
 1541         case SIOCADDMULTI:
 1542         case SIOCDELMULTI:
 1543                 vr_setmulti(sc);
 1544                 error = 0;
 1545                 break;
 1546         case SIOCGIFMEDIA:
 1547         case SIOCSIFMEDIA:
 1548                 mii = device_get_softc(sc->vr_miibus);
 1549                 error = ifmedia_ioctl(ifp, ifr, &mii->mii_media, command);
 1550                 break;
 1551         default:
 1552                 error = ether_ioctl(ifp, command, data);
 1553                 break;
 1554         }
 1555         return(error);
 1556 }
 1557 
 1558 #ifdef IFPOLL_ENABLE
 1559 
 1560 static void
 1561 vr_npoll_compat(struct ifnet *ifp, void *arg __unused, int count __unused)
 1562 {
 1563         struct vr_softc *sc = ifp->if_softc;
 1564 
 1565         ASSERT_SERIALIZED(ifp->if_serializer);
 1566         vr_intr(sc);
 1567 }
 1568 
 1569 static void
 1570 vr_npoll(struct ifnet *ifp, struct ifpoll_info *info)
 1571 {
 1572         struct vr_softc *sc = ifp->if_softc;
 1573 
 1574         ASSERT_SERIALIZED(ifp->if_serializer);
 1575 
 1576         if (info != NULL) {
 1577                 int cpuid = sc->vr_npoll.ifpc_cpuid;
 1578 
 1579                 info->ifpi_rx[cpuid].poll_func = vr_npoll_compat;
 1580                 info->ifpi_rx[cpuid].arg = NULL;
 1581                 info->ifpi_rx[cpuid].serializer = ifp->if_serializer;
 1582 
 1583                 if (ifp->if_flags & IFF_RUNNING) {
 1584                         /* disable interrupts */
 1585                         CSR_WRITE_2(sc, VR_IMR, 0x0000);
 1586                 }
 1587                 ifq_set_cpuid(&ifp->if_snd, cpuid);
 1588         } else {
 1589                 if (ifp->if_flags & IFF_RUNNING) {
 1590                         /* enable interrupts */
 1591                         CSR_WRITE_2(sc, VR_IMR, VR_INTRS);
 1592                 }
 1593                 ifq_set_cpuid(&ifp->if_snd, rman_get_cpuid(sc->vr_irq));
 1594         }
 1595 }
 1596 
 1597 #endif  /* IFPOLL_ENABLE */
 1598 
 1599 static void
 1600 vr_watchdog(struct ifnet *ifp)
 1601 {
 1602         struct vr_softc *sc;
 1603 
 1604         sc = ifp->if_softc;
 1605 
 1606         IFNET_STAT_INC(ifp, oerrors, 1);
 1607         if_printf(ifp, "watchdog timeout\n");
 1608 
 1609         vr_stop(sc);
 1610         vr_reset(sc);
 1611         vr_init(sc);
 1612 
 1613         if (!ifq_is_empty(&ifp->if_snd))
 1614                 if_devstart(ifp);
 1615 }
 1616 
 1617 /*
 1618  * Stop the adapter and free any mbufs allocated to the
 1619  * RX and TX lists.
 1620  */
 1621 static void
 1622 vr_stop(struct vr_softc *sc)
 1623 {
 1624         int i;
 1625         struct ifnet *ifp;
 1626 
 1627         ifp = &sc->arpcom.ac_if;
 1628         ifp->if_timer = 0;
 1629 
 1630         callout_stop(&sc->vr_stat_timer);
 1631 
 1632         VR_SETBIT16(sc, VR_COMMAND, VR_CMD_STOP);
 1633         VR_CLRBIT16(sc, VR_COMMAND, (VR_CMD_RX_ON|VR_CMD_TX_ON));
 1634         CSR_WRITE_2(sc, VR_IMR, 0x0000);
 1635         CSR_WRITE_4(sc, VR_TXADDR, 0x00000000);
 1636         CSR_WRITE_4(sc, VR_RXADDR, 0x00000000);
 1637 
 1638         /*
 1639          * Free data in the RX lists.
 1640          */
 1641         for (i = 0; i < VR_RX_LIST_CNT; i++) {
 1642                 if (sc->vr_cdata.vr_rx_chain[i].vr_mbuf != NULL) {
 1643                         m_freem(sc->vr_cdata.vr_rx_chain[i].vr_mbuf);
 1644                         sc->vr_cdata.vr_rx_chain[i].vr_mbuf = NULL;
 1645                 }
 1646         }
 1647         bzero(&sc->vr_ldata->vr_rx_list, sizeof(sc->vr_ldata->vr_rx_list));
 1648 
 1649         /*
 1650          * Reset the TX list buffer pointers.
 1651          */
 1652         for (i = 0; i < VR_TX_LIST_CNT; i++)
 1653                 sc->vr_cdata.vr_tx_chain[i].vr_buf = NULL;
 1654 
 1655         bzero(&sc->vr_ldata->vr_tx_list, sizeof(sc->vr_ldata->vr_tx_list));
 1656 
 1657         ifp->if_flags &= ~IFF_RUNNING;
 1658         ifq_clr_oactive(&ifp->if_snd);
 1659 }
 1660 
 1661 /*
 1662  * Stop all chip I/O so that the kernel's probe routines don't
 1663  * get confused by errant DMAs when rebooting.
 1664  */
 1665 static void
 1666 vr_shutdown(device_t dev)
 1667 {
 1668         struct vr_softc *sc;
 1669 
 1670         sc = device_get_softc(dev);
 1671 
 1672         vr_stop(sc);
 1673 }

Cache object: 8eeb3bd1c074b1778686364e9d19581f


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]


This page is part of the FreeBSD/Linux Linux Kernel Cross-Reference, and was automatically generated using a modified version of the LXR engine.