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/pdq/pdq_ifsubr.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 /*      $NetBSD: pdq_ifsubr.c,v 1.38 2001/12/21 23:21:47 matt Exp $     */
    2 
    3 /*-
    4  * Copyright (c) 1995, 1996 Matt Thomas <matt@3am-software.com>
    5  * All rights reserved.
    6  *
    7  * Redistribution and use in source and binary forms, with or without
    8  * modification, are permitted provided that the following conditions
    9  * are met:
   10  * 1. Redistributions of source code must retain the above copyright
   11  *    notice, this list of conditions and the following disclaimer.
   12  * 2. The name of the author may not be used to endorse or promote products
   13  *    derived from this software without specific prior written permission
   14  *
   15  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
   16  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
   17  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
   18  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
   19  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
   20  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
   21  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
   22  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
   23  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
   24  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
   25  *
   26  * $NetBSD: pdq_ifsubr.c,v 1.12 1997/06/05 01:56:35 thomas Exp$
   27  */
   28 
   29 #include <sys/cdefs.h>
   30 __FBSDID("$FreeBSD: releng/5.2/sys/dev/pdq/pdq_ifsubr.c 119418 2003-08-24 17:55:58Z obrien $");
   31 
   32 /*
   33  * DEC PDQ FDDI Controller; code for BSD derived operating systems
   34  *
   35  *      This module provide bus independent BSD specific O/S functions.
   36  *      (ie. it provides an ifnet interface to the rest of the system)
   37  */
   38 
   39 #ifdef __NetBSD__
   40 #include <sys/cdefs.h>
   41 __KERNEL_RCSID(0, "$NetBSD: pdq_ifsubr.c,v 1.38 2001/12/21 23:21:47 matt Exp $");
   42 #endif
   43 
   44 #define PDQ_OSSUPPORT
   45 
   46 #include <sys/param.h>
   47 #include <sys/systm.h>
   48 #include <sys/kernel.h>
   49 #include <sys/lock.h>
   50 #include <sys/mutex.h>
   51 #include <sys/malloc.h>
   52 #include <sys/socket.h>
   53 #include <sys/sockio.h>
   54 
   55 #include <sys/module.h>
   56 #include <sys/bus.h>
   57 
   58 #include <machine/bus_memio.h>
   59 #include <machine/bus_pio.h>
   60 #include <machine/bus.h>
   61 #include <machine/resource.h>
   62 #include <sys/rman.h> 
   63 
   64 #include <net/if.h>
   65 #include <net/if_arp.h>
   66 #include <net/if_dl.h>
   67 #include <net/if_media.h> 
   68 #include <net/fddi.h>
   69 
   70 #include <net/bpf.h>
   71 
   72 #include <dev/pdq/pdq_freebsd.h>
   73 #include <dev/pdq/pdqreg.h>
   74 
   75 devclass_t pdq_devclass;
   76 
   77 static void
   78 pdq_ifinit(
   79     pdq_softc_t *sc)
   80 {
   81     if (sc->sc_if.if_flags & IFF_UP) {
   82         sc->sc_if.if_flags |= IFF_RUNNING;
   83         if (sc->sc_if.if_flags & IFF_PROMISC) {
   84             sc->sc_pdq->pdq_flags |= PDQ_PROMISC;
   85         } else {
   86             sc->sc_pdq->pdq_flags &= ~PDQ_PROMISC;
   87         }
   88         if (sc->sc_if.if_flags & IFF_LINK1) {
   89             sc->sc_pdq->pdq_flags |= PDQ_PASS_SMT;
   90         } else {
   91             sc->sc_pdq->pdq_flags &= ~PDQ_PASS_SMT;
   92         }
   93         sc->sc_pdq->pdq_flags |= PDQ_RUNNING;
   94         pdq_run(sc->sc_pdq);
   95     } else {
   96         sc->sc_if.if_flags &= ~IFF_RUNNING;
   97         sc->sc_pdq->pdq_flags &= ~PDQ_RUNNING;
   98         pdq_stop(sc->sc_pdq);
   99     }
  100 }
  101 
  102 static void
  103 pdq_ifwatchdog(
  104     struct ifnet *ifp)
  105 {
  106     /*
  107      * No progress was made on the transmit queue for PDQ_OS_TX_TRANSMIT
  108      * seconds.  Remove all queued packets.
  109      */
  110 
  111     ifp->if_flags &= ~IFF_OACTIVE;
  112     ifp->if_timer = 0;
  113     for (;;) {
  114         struct mbuf *m;
  115         IFQ_DEQUEUE(&ifp->if_snd, m);
  116         if (m == NULL)
  117             return;
  118         PDQ_OS_DATABUF_FREE(PDQ_OS_IFP_TO_SOFTC(ifp)->sc_pdq, m);
  119     }
  120 }
  121 
  122 static void
  123 pdq_ifstart(
  124     struct ifnet *ifp)
  125 {
  126     pdq_softc_t * const sc = PDQ_OS_IFP_TO_SOFTC(ifp);
  127     struct mbuf *m;
  128     int tx = 0;
  129 
  130     if ((ifp->if_flags & IFF_RUNNING) == 0)
  131         return;
  132 
  133     if (sc->sc_if.if_timer == 0)
  134         sc->sc_if.if_timer = PDQ_OS_TX_TIMEOUT;
  135 
  136     if ((sc->sc_pdq->pdq_flags & PDQ_TXOK) == 0) {
  137         sc->sc_if.if_flags |= IFF_OACTIVE;
  138         return;
  139     }
  140     sc->sc_flags |= PDQIF_DOWNCALL;
  141     for (;; tx = 1) {
  142         IF_DEQUEUE(&ifp->if_snd, m);
  143         if (m == NULL)
  144             break;
  145 #if defined(PDQ_BUS_DMA) && !defined(PDQ_BUS_DMA_NOTX)
  146         if ((m->m_flags & M_HASTXDMAMAP) == 0) {
  147             bus_dmamap_t map;
  148             if (PDQ_OS_HDR_OFFSET != PDQ_RX_FC_OFFSET) {
  149                 m->m_data[0] = PDQ_FDDI_PH0;
  150                 m->m_data[1] = PDQ_FDDI_PH1;
  151                 m->m_data[2] = PDQ_FDDI_PH2;
  152             }
  153             if (!bus_dmamap_create(sc->sc_dmatag, m->m_pkthdr.len, 255,
  154                                    m->m_pkthdr.len, 0, BUS_DMA_NOWAIT, &map)) {
  155                 if (!bus_dmamap_load_mbuf(sc->sc_dmatag, map, m,
  156                                           BUS_DMA_WRITE|BUS_DMA_NOWAIT)) {
  157                     bus_dmamap_sync(sc->sc_dmatag, map, 0, m->m_pkthdr.len,
  158                                     BUS_DMASYNC_PREWRITE);
  159                     M_SETCTX(m, map);
  160                     m->m_flags |= M_HASTXDMAMAP;
  161                 }
  162             }
  163             if ((m->m_flags & M_HASTXDMAMAP) == 0)
  164                 break;
  165         }
  166 #else
  167         if (PDQ_OS_HDR_OFFSET != PDQ_RX_FC_OFFSET) {
  168             m->m_data[0] = PDQ_FDDI_PH0;
  169             m->m_data[1] = PDQ_FDDI_PH1;
  170             m->m_data[2] = PDQ_FDDI_PH2;
  171         }
  172 #endif
  173 
  174         if (pdq_queue_transmit_data(sc->sc_pdq, m) == PDQ_FALSE)
  175             break;
  176     }
  177     if (m != NULL) {
  178         ifp->if_flags |= IFF_OACTIVE;
  179         IF_PREPEND(&ifp->if_snd, m);
  180     }
  181     if (tx)
  182         PDQ_DO_TYPE2_PRODUCER(sc->sc_pdq);
  183     sc->sc_flags &= ~PDQIF_DOWNCALL;
  184 }
  185 
  186 void
  187 pdq_os_receive_pdu(
  188     pdq_t *pdq,
  189     struct mbuf *m,
  190     size_t pktlen,
  191     int drop)
  192 {
  193     pdq_softc_t *sc = pdq->pdq_os_ctx;
  194     struct ifnet *ifp = &sc->sc_if;
  195     struct fddi_header *fh;
  196 
  197     ifp->if_ipackets++;
  198 #if defined(PDQ_BUS_DMA)
  199     {
  200         /*
  201          * Even though the first mbuf start at the first fddi header octet,
  202          * the dmamap starts PDQ_OS_HDR_OFFSET octets earlier.  Any additional
  203          * mbufs will start normally.
  204          */
  205         int offset = PDQ_OS_HDR_OFFSET;
  206         struct mbuf *m0;
  207         for (m0 = m; m0 != NULL; m0 = m0->m_next, offset = 0) {
  208             pdq_os_databuf_sync(sc, m0, offset, m0->m_len, BUS_DMASYNC_POSTREAD);
  209             bus_dmamap_unload(sc->sc_dmatag, M_GETCTX(m0, bus_dmamap_t));
  210             bus_dmamap_destroy(sc->sc_dmatag, M_GETCTX(m0, bus_dmamap_t));
  211             m0->m_flags &= ~M_HASRXDMAMAP;
  212             M_SETCTX(m0, NULL);
  213         }
  214     }
  215 #endif
  216     m->m_pkthdr.len = pktlen;
  217 #if NBPFILTER > 0 && defined(__NetBSD__)
  218     if (sc->sc_bpf != NULL)
  219         PDQ_BPF_MTAP(sc, m);
  220 #endif
  221     fh = mtod(m, struct fddi_header *);
  222     if (drop || (fh->fddi_fc & (FDDIFC_L|FDDIFC_F)) != FDDIFC_LLC_ASYNC) {
  223         ifp->if_iqdrops++;
  224         ifp->if_ierrors++;
  225         PDQ_OS_DATABUF_FREE(pdq, m);
  226         return;
  227     }
  228 
  229     m->m_pkthdr.rcvif = ifp;
  230     (*ifp->if_input)(ifp, m);
  231 }
  232 
  233 void
  234 pdq_os_restart_transmitter(
  235     pdq_t *pdq)
  236 {
  237     pdq_softc_t *sc = pdq->pdq_os_ctx;
  238     sc->sc_if.if_flags &= ~IFF_OACTIVE;
  239     if (IFQ_IS_EMPTY(&sc->sc_if.if_snd) == 0) {
  240         sc->sc_if.if_timer = PDQ_OS_TX_TIMEOUT;
  241         if ((sc->sc_flags & PDQIF_DOWNCALL) == 0)
  242             pdq_ifstart(&sc->sc_if);
  243     } else {
  244         sc->sc_if.if_timer = 0;
  245     }
  246 }
  247 
  248 void
  249 pdq_os_transmit_done(
  250     pdq_t *pdq,
  251     struct mbuf *m)
  252 {
  253     pdq_softc_t *sc = pdq->pdq_os_ctx;
  254 #if NBPFILTER > 0
  255     if (sc->sc_bpf != NULL)
  256         PDQ_BPF_MTAP(sc, m);
  257 #endif
  258     PDQ_OS_DATABUF_FREE(pdq, m);
  259     sc->sc_if.if_opackets++;
  260 }
  261 
  262 void
  263 pdq_os_addr_fill(
  264     pdq_t *pdq,
  265     pdq_lanaddr_t *addr,
  266     size_t num_addrs)
  267 {
  268     pdq_softc_t *sc = pdq->pdq_os_ctx;
  269     struct ifnet *ifp;
  270     struct ifmultiaddr *ifma;
  271 
  272     ifp = &sc->arpcom.ac_if;
  273 
  274     /*
  275      * ADDR_FILTER_SET is always issued before FILTER_SET so
  276      * we can play with PDQ_ALLMULTI and not worry about 
  277      * queueing a FILTER_SET ourselves.
  278      */
  279 
  280     pdq->pdq_flags &= ~PDQ_ALLMULTI;
  281 #if defined(IFF_ALLMULTI)
  282     sc->sc_if.if_flags &= ~IFF_ALLMULTI;
  283 #endif
  284 
  285     for (ifma = TAILQ_FIRST(&sc->sc_if.if_multiaddrs); ifma && num_addrs > 0;
  286          ifma = TAILQ_NEXT(ifma, ifma_link)) {
  287             char *mcaddr;
  288             if (ifma->ifma_addr->sa_family != AF_LINK)
  289                     continue;
  290             mcaddr = LLADDR((struct sockaddr_dl *)ifma->ifma_addr);
  291             ((u_short *) addr->lanaddr_bytes)[0] = ((u_short *) mcaddr)[0];
  292             ((u_short *) addr->lanaddr_bytes)[1] = ((u_short *) mcaddr)[1];
  293             ((u_short *) addr->lanaddr_bytes)[2] = ((u_short *) mcaddr)[2];
  294             addr++;
  295             num_addrs--;
  296     }
  297     /*
  298      * If not all the address fit into the CAM, turn on all-multicast mode.
  299      */
  300     if (ifma != NULL) {
  301         pdq->pdq_flags |= PDQ_ALLMULTI;
  302 #if defined(IFF_ALLMULTI)
  303         sc->sc_if.if_flags |= IFF_ALLMULTI;
  304 #endif
  305     }
  306 }
  307 
  308 #if defined(IFM_FDDI)
  309 static int
  310 pdq_ifmedia_change(
  311     struct ifnet *ifp)
  312 {
  313     pdq_softc_t * const sc = PDQ_OS_IFP_TO_SOFTC(ifp);
  314 
  315     if (sc->sc_ifmedia.ifm_media & IFM_FDX) {
  316         if ((sc->sc_pdq->pdq_flags & PDQ_WANT_FDX) == 0) {
  317             sc->sc_pdq->pdq_flags |= PDQ_WANT_FDX;
  318             if (sc->sc_pdq->pdq_flags & PDQ_RUNNING)
  319                 pdq_run(sc->sc_pdq);
  320         }
  321     } else if (sc->sc_pdq->pdq_flags & PDQ_WANT_FDX) {
  322         sc->sc_pdq->pdq_flags &= ~PDQ_WANT_FDX;
  323         if (sc->sc_pdq->pdq_flags & PDQ_RUNNING)
  324             pdq_run(sc->sc_pdq);
  325     }
  326 
  327     return 0;
  328 }
  329 
  330 static void
  331 pdq_ifmedia_status(
  332     struct ifnet *ifp,
  333     struct ifmediareq *ifmr)
  334 {
  335     pdq_softc_t * const sc = PDQ_OS_IFP_TO_SOFTC(ifp);
  336 
  337     ifmr->ifm_status = IFM_AVALID;
  338     if (sc->sc_pdq->pdq_flags & PDQ_IS_ONRING)
  339         ifmr->ifm_status |= IFM_ACTIVE;
  340 
  341     ifmr->ifm_active = (ifmr->ifm_current & ~IFM_FDX);
  342     if (sc->sc_pdq->pdq_flags & PDQ_IS_FDX)
  343         ifmr->ifm_active |= IFM_FDX;
  344 }
  345 
  346 void
  347 pdq_os_update_status(
  348     pdq_t *pdq,
  349     const void *arg)
  350 {
  351     pdq_softc_t * const sc = pdq->pdq_os_ctx;
  352     const pdq_response_status_chars_get_t *rsp = arg;
  353     int media = 0;
  354 
  355     switch (rsp->status_chars_get.pmd_type[0]) {
  356         case PDQ_PMD_TYPE_ANSI_MUTLI_MODE:         media = IFM_FDDI_MMF; break;
  357         case PDQ_PMD_TYPE_ANSI_SINGLE_MODE_TYPE_1: media = IFM_FDDI_SMF; break;
  358         case PDQ_PMD_TYPE_ANSI_SIGNLE_MODE_TYPE_2: media = IFM_FDDI_SMF; break;
  359         case PDQ_PMD_TYPE_UNSHIELDED_TWISTED_PAIR: media = IFM_FDDI_UTP; break;
  360         default: media |= IFM_MANUAL;
  361     }
  362 
  363     if (rsp->status_chars_get.station_type == PDQ_STATION_TYPE_DAS)
  364         media |= IFM_FDDI_DA;
  365 
  366     sc->sc_ifmedia.ifm_media = media | IFM_FDDI;
  367 }
  368 #endif /* defined(IFM_FDDI) */
  369 
  370 static int
  371 pdq_ifioctl(
  372     struct ifnet *ifp,
  373     u_long cmd,
  374     caddr_t data)
  375 {
  376     pdq_softc_t *sc = PDQ_OS_IFP_TO_SOFTC(ifp);
  377     int error = 0;
  378 
  379     PDQ_LOCK(sc);
  380 
  381     switch (cmd) {
  382         case SIOCSIFMTU:
  383         case SIOCGIFADDR:
  384         case SIOCSIFADDR: {
  385             error = fddi_ioctl(ifp, cmd, data);
  386             break;
  387         }
  388 
  389         case SIOCSIFFLAGS: {
  390             pdq_ifinit(sc);
  391             break;
  392         }
  393 
  394         case SIOCADDMULTI:
  395         case SIOCDELMULTI: {
  396             if (sc->sc_if.if_flags & IFF_RUNNING) {
  397                     pdq_run(sc->sc_pdq);
  398                 error = 0;
  399             }
  400             break;
  401         }
  402 
  403 #if defined(IFM_FDDI) && defined(SIOCSIFMEDIA)
  404         case SIOCSIFMEDIA:
  405         case SIOCGIFMEDIA: {
  406             struct ifreq *ifr = (struct ifreq *)data;
  407             error = ifmedia_ioctl(ifp, ifr, &sc->sc_ifmedia, cmd);
  408             break;
  409         }
  410 #endif
  411 
  412         default: {
  413             error = EINVAL;
  414             break;
  415         }
  416     }
  417 
  418     PDQ_UNLOCK(sc);
  419     return error;
  420 }
  421 
  422 #ifndef IFF_NOTRAILERS
  423 #define IFF_NOTRAILERS  0
  424 #endif
  425 
  426 void
  427 pdq_ifattach(pdq_softc_t *sc)
  428 {
  429     struct ifnet *ifp = &sc->sc_if;
  430 
  431     mtx_init(&sc->mtx, device_get_nameunit(sc->dev), MTX_NETWORK_LOCK,
  432         MTX_DEF | MTX_RECURSE);
  433 
  434     ifp->if_softc = sc;
  435     ifp->if_init = (if_init_f_t *)pdq_ifinit;
  436     ifp->if_snd.ifq_maxlen = IFQ_MAXLEN;
  437     ifp->if_flags = IFF_BROADCAST|IFF_SIMPLEX|IFF_NOTRAILERS|IFF_MULTICAST;
  438 
  439 #if (defined(__FreeBSD__) && BSD >= 199506) || defined(__NetBSD__)
  440     ifp->if_watchdog = pdq_ifwatchdog;
  441 #else
  442     ifp->if_watchdog = ifwatchdog;
  443 #endif
  444 
  445     ifp->if_ioctl = pdq_ifioctl;
  446 #if !defined(__NetBSD__) && !defined(__FreeBSD__)
  447     ifp->if_output = fddi_output;
  448 #endif
  449     ifp->if_start = pdq_ifstart;
  450 
  451 #if defined(IFM_FDDI)
  452     {
  453         const int media = sc->sc_ifmedia.ifm_media;
  454         ifmedia_init(&sc->sc_ifmedia, IFM_FDX,
  455                      pdq_ifmedia_change, pdq_ifmedia_status);
  456         ifmedia_add(&sc->sc_ifmedia, media, 0, 0);
  457         ifmedia_set(&sc->sc_ifmedia, media);
  458     }
  459 #endif
  460   
  461 #if defined(__NetBSD__)
  462     if_attach(ifp);
  463     fddi_ifattach(ifp, (caddr_t)&sc->sc_pdq->pdq_hwaddr);
  464 #else
  465     fddi_ifattach(ifp, FDDI_BPF_SUPPORTED);
  466 #endif
  467 }
  468 
  469 void
  470 pdq_ifdetach (pdq_softc_t *sc)
  471 {
  472     struct ifnet *ifp;
  473 
  474     ifp = &sc->arpcom.ac_if;
  475 
  476     fddi_ifdetach(ifp, FDDI_BPF_SUPPORTED);
  477     pdq_stop(sc->sc_pdq);
  478     pdq_free(sc->dev);
  479 
  480     return;
  481 }
  482 
  483 void
  484 pdq_free (device_t dev)
  485 {
  486         pdq_softc_t *sc;
  487 
  488         sc = device_get_softc(dev);
  489 
  490         if (sc->io)
  491                 bus_release_resource(dev, sc->io_type, sc->io_rid, sc->io);
  492         if (sc->mem)
  493                 bus_release_resource(dev, sc->mem_type, sc->mem_rid, sc->mem);
  494         if (sc->irq_ih)
  495                 bus_teardown_intr(dev, sc->irq, sc->irq_ih);
  496         if (sc->irq)
  497                 bus_release_resource(dev, SYS_RES_IRQ, sc->irq_rid, sc->irq);
  498 
  499         /*
  500          * Destroy the mutex.
  501          */
  502         if (mtx_initialized(&sc->mtx) != 0) {
  503                 mtx_destroy(&sc->mtx);
  504         }
  505 
  506         return;
  507 }
  508 
  509 #if defined(PDQ_BUS_DMA) 
  510 int
  511 pdq_os_memalloc_contig(
  512     pdq_t *pdq)
  513 {
  514     pdq_softc_t * const sc = pdq->pdq_os_ctx;
  515     bus_dma_segment_t db_segs[1], ui_segs[1], cb_segs[1];
  516     int db_nsegs = 0, ui_nsegs = 0;
  517     int steps = 0;
  518     int not_ok;
  519 
  520     not_ok = bus_dmamem_alloc(sc->sc_dmatag,
  521                          sizeof(*pdq->pdq_dbp), sizeof(*pdq->pdq_dbp),
  522                          sizeof(*pdq->pdq_dbp), db_segs, 1, &db_nsegs,
  523                          BUS_DMA_NOWAIT);
  524     if (!not_ok) {
  525         steps = 1;
  526         not_ok = bus_dmamem_map(sc->sc_dmatag, db_segs, db_nsegs,
  527                                 sizeof(*pdq->pdq_dbp), (caddr_t *) &pdq->pdq_dbp,
  528                                 BUS_DMA_NOWAIT);
  529     }
  530     if (!not_ok) {
  531         steps = 2;
  532         not_ok = bus_dmamap_create(sc->sc_dmatag, db_segs[0].ds_len, 1,
  533                                    0x2000, 0, BUS_DMA_NOWAIT, &sc->sc_dbmap);
  534     }
  535     if (!not_ok) {
  536         steps = 3;
  537         not_ok = bus_dmamap_load(sc->sc_dmatag, sc->sc_dbmap,
  538                                  pdq->pdq_dbp, sizeof(*pdq->pdq_dbp),
  539                                  NULL, BUS_DMA_NOWAIT);
  540     }
  541     if (!not_ok) {
  542         steps = 4;
  543         pdq->pdq_pa_descriptor_block = sc->sc_dbmap->dm_segs[0].ds_addr;
  544         not_ok = bus_dmamem_alloc(sc->sc_dmatag,
  545                          PDQ_OS_PAGESIZE, PDQ_OS_PAGESIZE, PDQ_OS_PAGESIZE,
  546                          ui_segs, 1, &ui_nsegs, BUS_DMA_NOWAIT);
  547     }
  548     if (!not_ok) {
  549         steps = 5;
  550         not_ok = bus_dmamem_map(sc->sc_dmatag, ui_segs, ui_nsegs,
  551                             PDQ_OS_PAGESIZE,
  552                             (caddr_t *) &pdq->pdq_unsolicited_info.ui_events,
  553                             BUS_DMA_NOWAIT);
  554     }
  555     if (!not_ok) {
  556         steps = 6;
  557         not_ok = bus_dmamap_create(sc->sc_dmatag, ui_segs[0].ds_len, 1,
  558                                    PDQ_OS_PAGESIZE, 0, BUS_DMA_NOWAIT,
  559                                    &sc->sc_uimap);
  560     }
  561     if (!not_ok) {
  562         steps = 7;
  563         not_ok = bus_dmamap_load(sc->sc_dmatag, sc->sc_uimap,
  564                                  pdq->pdq_unsolicited_info.ui_events,
  565                                  PDQ_OS_PAGESIZE, NULL, BUS_DMA_NOWAIT);
  566     }
  567     if (!not_ok) {
  568         steps = 8;
  569         pdq->pdq_unsolicited_info.ui_pa_bufstart = sc->sc_uimap->dm_segs[0].ds_addr;
  570         cb_segs[0] = db_segs[0];
  571         cb_segs[0].ds_addr += offsetof(pdq_descriptor_block_t, pdqdb_consumer);
  572         cb_segs[0].ds_len = sizeof(pdq_consumer_block_t);
  573         not_ok = bus_dmamem_map(sc->sc_dmatag, cb_segs, 1,
  574                                 sizeof(*pdq->pdq_cbp), (caddr_t *) &pdq->pdq_cbp,
  575                                 BUS_DMA_NOWAIT|BUS_DMA_COHERENT);
  576     }
  577     if (!not_ok) {
  578         steps = 9;
  579         not_ok = bus_dmamap_create(sc->sc_dmatag, cb_segs[0].ds_len, 1,
  580                                    0x2000, 0, BUS_DMA_NOWAIT, &sc->sc_cbmap);
  581     }
  582     if (!not_ok) {
  583         steps = 10;
  584         not_ok = bus_dmamap_load(sc->sc_dmatag, sc->sc_cbmap,
  585                                  (caddr_t) pdq->pdq_cbp, sizeof(*pdq->pdq_cbp),
  586                                  NULL, BUS_DMA_NOWAIT);
  587     }
  588     if (!not_ok) {
  589         pdq->pdq_pa_consumer_block = sc->sc_cbmap->dm_segs[0].ds_addr;
  590         return not_ok;
  591     }
  592 
  593     switch (steps) {
  594         case 11: {
  595             bus_dmamap_unload(sc->sc_dmatag, sc->sc_cbmap);
  596             /* FALL THROUGH */
  597         }
  598         case 10: {
  599             bus_dmamap_destroy(sc->sc_dmatag, sc->sc_cbmap);
  600             /* FALL THROUGH */
  601         }
  602         case 9: {
  603             bus_dmamem_unmap(sc->sc_dmatag,
  604                              (caddr_t) pdq->pdq_cbp, sizeof(*pdq->pdq_cbp));
  605             /* FALL THROUGH */
  606         }
  607         case 8: {
  608             bus_dmamap_unload(sc->sc_dmatag, sc->sc_uimap);
  609             /* FALL THROUGH */
  610         }
  611         case 7: {
  612             bus_dmamap_destroy(sc->sc_dmatag, sc->sc_uimap);
  613             /* FALL THROUGH */
  614         }
  615         case 6: {
  616             bus_dmamem_unmap(sc->sc_dmatag,
  617                              (caddr_t) pdq->pdq_unsolicited_info.ui_events,
  618                              PDQ_OS_PAGESIZE);
  619             /* FALL THROUGH */
  620         }
  621         case 5: {
  622             bus_dmamem_free(sc->sc_dmatag, ui_segs, ui_nsegs);
  623             /* FALL THROUGH */
  624         }
  625         case 4: {
  626             bus_dmamap_unload(sc->sc_dmatag, sc->sc_dbmap);
  627             /* FALL THROUGH */
  628         }
  629         case 3: {
  630             bus_dmamap_destroy(sc->sc_dmatag, sc->sc_dbmap);
  631             /* FALL THROUGH */
  632         }
  633         case 2: {
  634             bus_dmamem_unmap(sc->sc_dmatag,
  635                              (caddr_t) pdq->pdq_dbp,
  636                              sizeof(*pdq->pdq_dbp));
  637             /* FALL THROUGH */
  638         }
  639         case 1: {
  640             bus_dmamem_free(sc->sc_dmatag, db_segs, db_nsegs);
  641             /* FALL THROUGH */
  642         }
  643     }
  644 
  645     return not_ok;
  646 }
  647 
  648 extern void
  649 pdq_os_descriptor_block_sync(
  650     pdq_os_ctx_t *sc,
  651     size_t offset,
  652     size_t length,
  653     int ops)
  654 {
  655     bus_dmamap_sync(sc->sc_dmatag, sc->sc_dbmap, offset, length, ops);
  656 }
  657 
  658 extern void
  659 pdq_os_consumer_block_sync(
  660     pdq_os_ctx_t *sc,
  661     int ops)
  662 {
  663     bus_dmamap_sync(sc->sc_dmatag, sc->sc_cbmap, 0, sizeof(pdq_consumer_block_t), ops);
  664 }
  665 
  666 extern void
  667 pdq_os_unsolicited_event_sync(
  668     pdq_os_ctx_t *sc,
  669     size_t offset,
  670     size_t length,
  671     int ops)
  672 {
  673     bus_dmamap_sync(sc->sc_dmatag, sc->sc_uimap, offset, length, ops);
  674 }
  675 
  676 extern void
  677 pdq_os_databuf_sync(
  678     pdq_os_ctx_t *sc,
  679     struct mbuf *m,
  680     size_t offset,
  681     size_t length,
  682     int ops)
  683 {
  684     bus_dmamap_sync(sc->sc_dmatag, M_GETCTX(m, bus_dmamap_t), offset, length, ops);
  685 }
  686 
  687 extern void
  688 pdq_os_databuf_free(
  689     pdq_os_ctx_t *sc,
  690     struct mbuf *m)
  691 {
  692     if (m->m_flags & (M_HASRXDMAMAP|M_HASTXDMAMAP)) {
  693         bus_dmamap_t map = M_GETCTX(m, bus_dmamap_t);
  694         bus_dmamap_unload(sc->sc_dmatag, map);
  695         bus_dmamap_destroy(sc->sc_dmatag, map);
  696         m->m_flags &= ~(M_HASRXDMAMAP|M_HASTXDMAMAP);
  697     }
  698     m_freem(m);
  699 }
  700 
  701 extern struct mbuf *
  702 pdq_os_databuf_alloc(
  703     pdq_os_ctx_t *sc)
  704 {
  705     struct mbuf *m;
  706     bus_dmamap_t map;
  707 
  708     MGETHDR(m, M_DONTWAIT, MT_DATA);
  709     if (m == NULL) {
  710         printf("%s: can't alloc small buf\n", sc->sc_dev.dv_xname);
  711         return NULL;
  712     }
  713     MCLGET(m, M_DONTWAIT);
  714     if ((m->m_flags & M_EXT) == 0) {
  715         printf("%s: can't alloc cluster\n", sc->sc_dev.dv_xname);
  716         m_free(m);
  717         return NULL;
  718     }
  719     m->m_pkthdr.len = m->m_len = PDQ_OS_DATABUF_SIZE;
  720 
  721     if (bus_dmamap_create(sc->sc_dmatag, PDQ_OS_DATABUF_SIZE,
  722                            1, PDQ_OS_DATABUF_SIZE, 0, BUS_DMA_NOWAIT, &map)) {
  723         printf("%s: can't create dmamap\n", sc->sc_dev.dv_xname);
  724         m_free(m);
  725         return NULL;
  726     }
  727     if (bus_dmamap_load_mbuf(sc->sc_dmatag, map, m,
  728                              BUS_DMA_READ|BUS_DMA_NOWAIT)) {
  729         printf("%s: can't load dmamap\n", sc->sc_dev.dv_xname);
  730         bus_dmamap_destroy(sc->sc_dmatag, map);
  731         m_free(m);
  732         return NULL;
  733     }
  734     m->m_flags |= M_HASRXDMAMAP;
  735     M_SETCTX(m, map);
  736     return m;
  737 }
  738 #endif

Cache object: fe818624e94b91b93a6510498afd1514


[ 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.