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/pccard/pccard.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: pcmcia.c,v 1.23 2000/07/28 19:17:02 drochner Exp $     */
    2 
    3 /*-
    4  * Copyright (c) 1997 Marc Horowitz.  All rights reserved.
    5  *
    6  * Redistribution and use in source and binary forms, with or without
    7  * modification, are permitted provided that the following conditions
    8  * are met:
    9  * 1. Redistributions of source code must retain the above copyright
   10  *    notice, this list of conditions and the following disclaimer.
   11  * 2. Redistributions in binary form must reproduce the above copyright
   12  *    notice, this list of conditions and the following disclaimer in the
   13  *    documentation and/or other materials provided with the distribution.
   14  * 3. All advertising materials mentioning features or use of this software
   15  *    must display the following acknowledgement:
   16  *      This product includes software developed by Marc Horowitz.
   17  * 4. The name of the author may not be used to endorse or promote products
   18  *    derived from this software without specific prior written permission.
   19  *
   20  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
   21  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
   22  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
   23  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
   24  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
   25  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
   26  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
   27  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
   28  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
   29  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
   30  */
   31 
   32 #include <sys/cdefs.h>
   33 __FBSDID("$FreeBSD: releng/6.1/sys/dev/pccard/pccard.c 155116 2006-01-31 17:10:02Z imp $");
   34 
   35 #include <sys/param.h>
   36 #include <sys/systm.h>
   37 #include <sys/malloc.h>
   38 #include <sys/module.h>
   39 #include <sys/kernel.h>
   40 #include <sys/queue.h>
   41 #include <sys/sysctl.h>
   42 #include <sys/types.h>
   43 
   44 #include <sys/bus.h>
   45 #include <machine/bus.h>
   46 #include <sys/rman.h>
   47 #include <machine/resource.h>
   48 
   49 #include <net/ethernet.h>
   50 
   51 #include <dev/pccard/pccardreg.h>
   52 #include <dev/pccard/pccardvar.h>
   53 #include <dev/pccard/pccardvarp.h>
   54 #include <dev/pccard/pccard_cis.h>
   55 
   56 #include "power_if.h"
   57 #include "card_if.h"
   58 
   59 #define PCCARDDEBUG
   60 
   61 /* sysctl vars */
   62 SYSCTL_NODE(_hw, OID_AUTO, pccard, CTLFLAG_RD, 0, "PCCARD parameters");
   63 
   64 int     pccard_debug = 0;
   65 TUNABLE_INT("hw.pccard.debug", &pccard_debug);
   66 SYSCTL_INT(_hw_pccard, OID_AUTO, debug, CTLFLAG_RW,
   67     &pccard_debug, 0,
   68   "pccard debug");
   69 
   70 int     pccard_cis_debug = 0;
   71 TUNABLE_INT("hw.pccard.cis_debug", &pccard_cis_debug);
   72 SYSCTL_INT(_hw_pccard, OID_AUTO, cis_debug, CTLFLAG_RW,
   73     &pccard_cis_debug, 0, "pccard CIS debug");
   74 
   75 #ifdef PCCARDDEBUG
   76 #define DPRINTF(arg) if (pccard_debug) printf arg
   77 #define DEVPRINTF(arg) if (pccard_debug) device_printf arg
   78 #define PRVERBOSE(arg) printf arg
   79 #define DEVPRVERBOSE(arg) device_printf arg
   80 #else
   81 #define DPRINTF(arg)
   82 #define DEVPRINTF(arg)
   83 #define PRVERBOSE(arg) if (bootverbose) printf arg
   84 #define DEVPRVERBOSE(arg) if (bootverbose) device_printf arg
   85 #endif
   86 
   87 static int      pccard_ccr_read(struct pccard_function *pf, int ccr);
   88 static void     pccard_ccr_write(struct pccard_function *pf, int ccr, int val);
   89 static int      pccard_attach_card(device_t dev);
   90 static int      pccard_detach_card(device_t dev);
   91 static void     pccard_function_init(struct pccard_function *pf);
   92 static void     pccard_function_free(struct pccard_function *pf);
   93 static int      pccard_function_enable(struct pccard_function *pf);
   94 static void     pccard_function_disable(struct pccard_function *pf);
   95 static int      pccard_compat_do_probe(device_t bus, device_t dev);
   96 static int      pccard_compat_do_attach(device_t bus, device_t dev);
   97 static int      pccard_probe(device_t dev);
   98 static int      pccard_attach(device_t dev);
   99 static int      pccard_detach(device_t dev);
  100 static void     pccard_print_resources(struct resource_list *rl,
  101                     const char *name, int type, int count, const char *format);
  102 static int      pccard_print_child(device_t dev, device_t child);
  103 static int      pccard_set_resource(device_t dev, device_t child, int type,
  104                     int rid, u_long start, u_long count);
  105 static int      pccard_get_resource(device_t dev, device_t child, int type,
  106                     int rid, u_long *startp, u_long *countp);
  107 static void     pccard_delete_resource(device_t dev, device_t child, int type,
  108                     int rid);
  109 static int      pccard_set_res_flags(device_t dev, device_t child, int type,
  110                     int rid, uint32_t flags);
  111 static int      pccard_set_memory_offset(device_t dev, device_t child, int rid,
  112                     uint32_t offset, uint32_t *deltap);
  113 static void     pccard_probe_nomatch(device_t cbdev, device_t child);
  114 static int      pccard_read_ivar(device_t bus, device_t child, int which,
  115                     u_char *result);
  116 static void     pccard_driver_added(device_t dev, driver_t *driver);
  117 static struct resource *pccard_alloc_resource(device_t dev,
  118                     device_t child, int type, int *rid, u_long start,
  119                     u_long end, u_long count, u_int flags);
  120 static int      pccard_release_resource(device_t dev, device_t child, int type,
  121                     int rid, struct resource *r);
  122 static void     pccard_child_detached(device_t parent, device_t dev);
  123 static void     pccard_intr(void *arg);
  124 static int      pccard_setup_intr(device_t dev, device_t child,
  125                     struct resource *irq, int flags, driver_intr_t *intr,
  126                     void *arg, void **cookiep);
  127 static int      pccard_teardown_intr(device_t dev, device_t child,
  128                     struct resource *r, void *cookie);
  129 
  130 static const struct pccard_product *
  131 pccard_do_product_lookup(device_t bus, device_t dev,
  132                          const struct pccard_product *tab, size_t ent_size,
  133                          pccard_product_match_fn matchfn);
  134 
  135 
  136 static int
  137 pccard_ccr_read(struct pccard_function *pf, int ccr)
  138 {
  139         return (bus_space_read_1(pf->pf_ccrt, pf->pf_ccrh,
  140             pf->pf_ccr_offset + ccr));
  141 }
  142 
  143 static void
  144 pccard_ccr_write(struct pccard_function *pf, int ccr, int val)
  145 {
  146         if ((pf->ccr_mask) & (1 << (ccr / 2))) {
  147                 bus_space_write_1(pf->pf_ccrt, pf->pf_ccrh,
  148                     pf->pf_ccr_offset + ccr, val);
  149         }
  150 }
  151 
  152 static int
  153 pccard_set_default_descr(device_t dev)
  154 {
  155         const char *vendorstr, *prodstr;
  156         uint32_t vendor, prod;
  157         char *str;
  158 
  159         if (pccard_get_vendor_str(dev, &vendorstr))
  160                 return (0);
  161         if (pccard_get_product_str(dev, &prodstr))
  162                 return (0);
  163         if (vendorstr != NULL && prodstr != NULL) {
  164                 str = malloc(strlen(vendorstr) + strlen(prodstr) + 2, M_DEVBUF,
  165                     M_WAITOK);
  166                 sprintf(str, "%s %s", vendorstr, prodstr);
  167                 device_set_desc_copy(dev, str);
  168                 free(str, M_DEVBUF);
  169         } else {
  170                 if (pccard_get_vendor(dev, &vendor))
  171                         return (0);
  172                 if (pccard_get_product(dev, &prod))
  173                         return (0);
  174                 str = malloc(100, M_DEVBUF, M_WAITOK);
  175                 snprintf(str, 100, "vendor=0x%x product=0x%x", vendor, prod);
  176                 device_set_desc_copy(dev, str);
  177                 free(str, M_DEVBUF);
  178         }
  179         return (0);
  180 }
  181 
  182 static int
  183 pccard_attach_card(device_t dev)
  184 {
  185         struct pccard_softc *sc = PCCARD_SOFTC(dev);
  186         struct pccard_function *pf;
  187         struct pccard_ivar *ivar;
  188         device_t child;
  189         int i;
  190 
  191         if (!STAILQ_EMPTY(&sc->card.pf_head)) {
  192                 if (bootverbose || pccard_debug)
  193                         device_printf(dev, "Card already inserted.\n");
  194         }
  195 
  196         DEVPRINTF((dev, "chip_socket_enable\n"));
  197         POWER_ENABLE_SOCKET(device_get_parent(dev), dev);
  198 
  199         DEVPRINTF((dev, "read_cis\n"));
  200         pccard_read_cis(sc);
  201 
  202         DEVPRINTF((dev, "check_cis_quirks\n"));
  203         pccard_check_cis_quirks(dev);
  204 
  205         /*
  206          * bail now if the card has no functions, or if there was an error in
  207          * the cis.
  208          */
  209 
  210         if (sc->card.error) {
  211                 device_printf(dev, "CARD ERROR!\n");
  212                 return (1);
  213         }
  214         if (STAILQ_EMPTY(&sc->card.pf_head)) {
  215                 device_printf(dev, "Card has no functions!\n");
  216                 return (1);
  217         }
  218 
  219         if (bootverbose || pccard_debug)
  220                 pccard_print_cis(dev);
  221 
  222         DEVPRINTF((dev, "functions scanning\n"));
  223         i = -1;
  224         STAILQ_FOREACH(pf, &sc->card.pf_head, pf_list) {
  225                 i++;
  226                 if (STAILQ_EMPTY(&pf->cfe_head)) {
  227                         device_printf(dev,
  228                             "Function %d has no config entries.!\n", i);
  229                         continue;
  230                 }
  231                 pf->sc = sc;
  232                 pf->cfe = NULL;
  233                 pf->dev = NULL;
  234         }
  235         DEVPRINTF((dev, "Card has %d functions. pccard_mfc is %d\n", i + 1,
  236             pccard_mfc(sc)));
  237 
  238         STAILQ_FOREACH(pf, &sc->card.pf_head, pf_list) {
  239                 if (STAILQ_EMPTY(&pf->cfe_head))
  240                         continue;
  241                 /*
  242                  * In NetBSD, the drivers are responsible for activating
  243                  * each function of a card.  I think that in FreeBSD we
  244                  * want to activate them enough for the usual bus_*_resource
  245                  * routines will do the right thing.  This many mean a
  246                  * departure from the current NetBSD model.
  247                  *
  248                  * This seems to work well in practice for most cards.
  249                  * However, there are two cases that are problematic.
  250                  * If a driver wishes to pick and chose which config
  251                  * entry to use, then this method falls down.  These
  252                  * are usually older cards.  In addition, there are
  253                  * some cards that have multiple hardware units on the
  254                  * cards, but presents only one CIS chain.  These cards
  255                  * are combination cards, but only one of these units
  256                  * can be on at a time.
  257                  */
  258                 ivar = malloc(sizeof(struct pccard_ivar), M_DEVBUF,
  259                     M_WAITOK | M_ZERO);
  260                 resource_list_init(&ivar->resources);
  261                 child = device_add_child(dev, NULL, -1);
  262                 device_set_ivars(child, ivar);
  263                 ivar->pf = pf;
  264                 pf->dev = child;
  265                 /*
  266                  * XXX We might want to move the next three lines into
  267                  * XXX the pccard interface layer.  For the moment, this
  268                  * XXX is OK, but some drivers want to pick the config
  269                  * XXX entry to use as well as some address tweaks (mostly
  270                  * XXX due to bugs in decode logic that makes some
  271                  * XXX addresses illegal or broken).
  272                  */
  273                 pccard_function_init(pf);
  274                 if (sc->sc_enabled_count == 0)
  275                         POWER_ENABLE_SOCKET(device_get_parent(dev), dev);
  276                 if (pccard_function_enable(pf) == 0 &&
  277                     pccard_set_default_descr(child) == 0 &&
  278                     device_probe_and_attach(child) == 0) {
  279                         DEVPRINTF((sc->dev, "function %d CCR at %d "
  280                             "offset %x mask %x: "
  281                             "%x %x %x %x, %x %x %x %x, %x\n",
  282                             pf->number, pf->pf_ccr_window, pf->pf_ccr_offset,
  283                             pf->ccr_mask, pccard_ccr_read(pf, 0x00),
  284                         pccard_ccr_read(pf, 0x02), pccard_ccr_read(pf, 0x04),
  285                         pccard_ccr_read(pf, 0x06), pccard_ccr_read(pf, 0x0A),
  286                         pccard_ccr_read(pf, 0x0C), pccard_ccr_read(pf, 0x0E),
  287                         pccard_ccr_read(pf, 0x10), pccard_ccr_read(pf, 0x12)));
  288                 } else {
  289                         if (pf->cfe != NULL)
  290                                 pccard_function_disable(pf);
  291                 }
  292         }
  293         return (0);
  294 }
  295 
  296 static int
  297 pccard_detach_card(device_t dev)
  298 {
  299         struct pccard_softc *sc = PCCARD_SOFTC(dev);
  300         struct pccard_function *pf;
  301         struct pccard_config_entry *cfe;
  302         int state;
  303 
  304         /*
  305          * We are running on either the PCCARD socket's event thread
  306          * or in user context detaching a device by user request.
  307          */
  308         STAILQ_FOREACH(pf, &sc->card.pf_head, pf_list) {
  309                 if (pf->dev == NULL)
  310                         continue;
  311                 state = device_get_state(pf->dev);
  312                 if (state == DS_ATTACHED || state == DS_BUSY)
  313                         device_detach(pf->dev);
  314                 if (pf->cfe != NULL)
  315                         pccard_function_disable(pf);
  316                 pccard_function_free(pf);
  317                 device_delete_child(dev, pf->dev);
  318         }
  319         if (sc->sc_enabled_count == 0)
  320                 POWER_DISABLE_SOCKET(device_get_parent(dev), dev);
  321 
  322         while (NULL != (pf = STAILQ_FIRST(&sc->card.pf_head))) {
  323                 while (NULL != (cfe = STAILQ_FIRST(&pf->cfe_head))) {
  324                         STAILQ_REMOVE_HEAD(&pf->cfe_head, cfe_list);
  325                         free(cfe, M_DEVBUF);
  326                 }
  327                 STAILQ_REMOVE_HEAD(&sc->card.pf_head, pf_list);
  328                 free(pf, M_DEVBUF);
  329         }
  330         STAILQ_INIT(&sc->card.pf_head);
  331         return (0);
  332 }
  333 
  334 static const struct pccard_product *
  335 pccard_do_product_lookup(device_t bus, device_t dev,
  336     const struct pccard_product *tab, size_t ent_size,
  337     pccard_product_match_fn matchfn)
  338 {
  339         const struct pccard_product *ent;
  340         int matches;
  341         uint32_t vendor;
  342         uint32_t prod;
  343         const char *vendorstr;
  344         const char *prodstr;
  345         const char *cis3str;
  346         const char *cis4str;
  347 
  348 #ifdef DIAGNOSTIC
  349         if (sizeof *ent > ent_size)
  350                 panic("pccard_product_lookup: bogus ent_size %jd",
  351                     (intmax_t) ent_size);
  352 #endif
  353         if (pccard_get_vendor(dev, &vendor))
  354                 return (NULL);
  355         if (pccard_get_product(dev, &prod))
  356                 return (NULL);
  357         if (pccard_get_vendor_str(dev, &vendorstr))
  358                 return (NULL);
  359         if (pccard_get_product_str(dev, &prodstr))
  360                 return (NULL);
  361         if (pccard_get_cis3_str(dev, &cis3str))
  362                 return (NULL);
  363         if (pccard_get_cis4_str(dev, &cis4str))
  364                 return (NULL);
  365         for (ent = tab; ent->pp_vendor != 0; ent =
  366             (const struct pccard_product *) ((const char *) ent + ent_size)) {
  367                 matches = 1;
  368                 if (ent->pp_vendor == PCCARD_VENDOR_ANY &&
  369                     ent->pp_product == PCCARD_PRODUCT_ANY &&
  370                     ent->pp_cis[0] == NULL &&
  371                     ent->pp_cis[1] == NULL) {
  372                         if (ent->pp_name)
  373                                 device_printf(dev,
  374                                     "Total wildcard entry ignored for %s\n",
  375                                     ent->pp_name);
  376                         continue;
  377                 }
  378                 if (matches && ent->pp_vendor != PCCARD_VENDOR_ANY &&
  379                     vendor != ent->pp_vendor)
  380                         matches = 0;
  381                 if (matches && ent->pp_product != PCCARD_PRODUCT_ANY &&
  382                     prod != ent->pp_product)
  383                         matches = 0;
  384                 if (matches && ent->pp_cis[0] &&
  385                     (vendorstr == NULL ||
  386                     strcmp(ent->pp_cis[0], vendorstr) != 0))
  387                         matches = 0;
  388                 if (matches && ent->pp_cis[1] &&
  389                     (prodstr == NULL ||
  390                     strcmp(ent->pp_cis[1], prodstr) != 0))
  391                         matches = 0;
  392                 if (matches && ent->pp_cis[2] &&
  393                     (cis3str == NULL ||
  394                     strcmp(ent->pp_cis[2], cis3str) != 0))
  395                         matches = 0;
  396                 if (matches && ent->pp_cis[3] &&
  397                     (cis4str == NULL ||
  398                     strcmp(ent->pp_cis[3], cis4str) != 0))
  399                         matches = 0;
  400                 if (matchfn != NULL)
  401                         matches = (*matchfn)(dev, ent, matches);
  402                 if (matches)
  403                         return (ent);
  404         }
  405         return (NULL);
  406 }
  407 
  408 /*
  409  * Initialize a PCCARD function.  May be called as long as the function is
  410  * disabled.
  411  *
  412  * Note: pccard_function_init should not keep resources allocated.  It should
  413  * only set them up ala isa pnp, set the values in the rl lists, and return.
  414  * Any resource held after pccard_function_init is called is a bug.  However,
  415  * the bus routines to get the resources also assume that pccard_function_init
  416  * does this, so they need to be fixed too.
  417  */
  418 static void
  419 pccard_function_init(struct pccard_function *pf)
  420 {
  421         struct pccard_config_entry *cfe;
  422         struct pccard_ivar *devi = PCCARD_IVAR(pf->dev);
  423         struct resource_list *rl = &devi->resources;
  424         struct resource_list_entry *rle;
  425         struct resource *r = 0;
  426         device_t bus;
  427         u_long start, end, len;
  428         int i, rid, spaces;
  429 
  430         if (pf->pf_flags & PFF_ENABLED) {
  431                 printf("pccard_function_init: function is enabled");
  432                 return;
  433         }
  434         bus = device_get_parent(pf->dev);
  435         /* Remember which configuration entry we are using. */
  436         STAILQ_FOREACH(cfe, &pf->cfe_head, cfe_list) {
  437                 if (cfe->iftype != PCCARD_IFTYPE_IO)
  438                         continue;
  439                 spaces = 0;
  440                 for (i = 0; i < cfe->num_iospace; i++) {
  441                         start = cfe->iospace[i].start;
  442                         if (start)
  443                                 end = start + cfe->iospace[i].length - 1;
  444                         else
  445                                 end = ~0UL;
  446                         DEVPRINTF((bus, "I/O rid %d start %lx end %lx\n",
  447                             i, start, end));
  448                         rid = i;
  449                         len = cfe->iospace[i].length;
  450                         r = bus_alloc_resource(bus, SYS_RES_IOPORT, &rid,
  451                             start, end, len, rman_make_alignment_flags(len));
  452                         if (r == NULL)
  453                                 goto not_this_one;
  454                         rle = resource_list_add(rl, SYS_RES_IOPORT,
  455                             rid, rman_get_start(r), rman_get_end(r),
  456                             cfe->iospace[i].length);
  457                         if (rle == NULL)
  458                                 panic("Cannot add resource rid %d IOPORT", rid);
  459                         rle->res = r;
  460                         spaces++;
  461                 }
  462                 for (i = 0; i < cfe->num_memspace; i++) {
  463                         start = cfe->memspace[i].hostaddr;
  464                         if (start)
  465                                 end = start + cfe->memspace[i].length - 1;
  466                         else
  467                                 end = ~0UL;
  468                         DEVPRINTF((bus, "Memory rid %d start %lx end %lx\n",
  469                             i, start, end));
  470                         rid = i;
  471                         len = cfe->memspace[i].length;
  472                         r = bus_alloc_resource(bus, SYS_RES_MEMORY, &rid,
  473                             start, end, len, rman_make_alignment_flags(len));
  474                         if (r == NULL)
  475                                 goto not_this_one;
  476                         rle = resource_list_add(rl, SYS_RES_MEMORY,
  477                             rid, rman_get_start(r), rman_get_end(r),
  478                             cfe->memspace[i].length);
  479                         if (rle == NULL)
  480                                 panic("Cannot add resource rid %d MEM", rid);
  481                         rle->res = r;
  482                         spaces++;
  483                 }
  484                 if (spaces == 0) {
  485                         DEVPRINTF((bus, "Neither memory nor I/O mapped\n"));
  486                         goto not_this_one;
  487                 }
  488                 if (cfe->irqmask) {
  489                         rid = 0;
  490                         r = bus_alloc_resource_any(bus, SYS_RES_IRQ, &rid,
  491                             RF_SHAREABLE);
  492                         if (r == NULL)
  493                                 goto not_this_one;
  494                         rle = resource_list_add(rl, SYS_RES_IRQ, rid,
  495                             rman_get_start(r), rman_get_end(r), 1);
  496                         if (rle == NULL)
  497                                 panic("Cannot add resource rid %d IRQ", rid);
  498                         rle->res = r;
  499                 }
  500                 /* If we get to here, we've allocated all we need */
  501                 pf->cfe = cfe;
  502                 break;
  503             not_this_one:;
  504                 DEVPRVERBOSE((bus, "Allocation failed for cfe %d\n",
  505                     cfe->number));
  506                 resource_list_purge(rl);
  507         }
  508 }
  509 
  510 /*
  511  * Free resources allocated by pccard_function_init(), May be called as long
  512  * as the function is disabled.
  513  *
  514  * NOTE: This function should be unnecessary.  pccard_function_init should
  515  * never keep resources initialized.
  516  */
  517 static void
  518 pccard_function_free(struct pccard_function *pf)
  519 {
  520         struct pccard_ivar *devi = PCCARD_IVAR(pf->dev);
  521         struct resource_list_entry *rle;
  522 
  523         if (pf->pf_flags & PFF_ENABLED) {
  524                 printf("pccard_function_init: function is enabled");
  525                 return;
  526         }
  527 
  528         STAILQ_FOREACH(rle, &devi->resources, link) {
  529                 if (rle->res) {
  530                         if (rman_get_device(rle->res) != pf->sc->dev)
  531                                 device_printf(pf->sc->dev,
  532                                     "function_free: Resource still owned by "
  533                                     "child, oops. "
  534                                     "(type=%d, rid=%d, addr=%lx)\n",
  535                                     rle->type, rle->rid,
  536                                     rman_get_start(rle->res));
  537                         BUS_RELEASE_RESOURCE(device_get_parent(pf->sc->dev),
  538                             pf->sc->dev, rle->type, rle->rid, rle->res);
  539                         rle->res = NULL;
  540                 }
  541         }
  542         resource_list_free(&devi->resources);
  543 }
  544 
  545 static void
  546 pccard_mfc_adjust_iobase(struct pccard_function *pf, bus_addr_t addr,
  547     bus_addr_t offset, bus_size_t size)
  548 {
  549         bus_size_t iosize, tmp;
  550 
  551         if (addr != 0) {
  552                 if (pf->pf_mfc_iomax == 0) {
  553                         pf->pf_mfc_iobase = addr + offset;
  554                         pf->pf_mfc_iomax = pf->pf_mfc_iobase + size;
  555                 } else {
  556                         /* this makes the assumption that nothing overlaps */
  557                         if (pf->pf_mfc_iobase > addr + offset)
  558                                 pf->pf_mfc_iobase = addr + offset;
  559                         if (pf->pf_mfc_iomax < addr + offset + size)
  560                                 pf->pf_mfc_iomax = addr + offset + size;
  561                 }
  562         }
  563 
  564         tmp = pf->pf_mfc_iomax - pf->pf_mfc_iobase;
  565         /* round up to nearest (2^n)-1 */
  566         for (iosize = 1; iosize < tmp; iosize <<= 1)
  567                 ;
  568         iosize--;
  569 
  570         DEVPRINTF((pf->dev, "MFC: I/O base %#jx IOSIZE %#jx\n",
  571             (uintmax_t)pf->pf_mfc_iobase, (uintmax_t)(iosize + 1)));
  572         pccard_ccr_write(pf, PCCARD_CCR_IOBASE0,
  573             pf->pf_mfc_iobase & 0xff);
  574         pccard_ccr_write(pf, PCCARD_CCR_IOBASE1,
  575             (pf->pf_mfc_iobase >> 8) & 0xff);
  576         pccard_ccr_write(pf, PCCARD_CCR_IOBASE2, 0);
  577         pccard_ccr_write(pf, PCCARD_CCR_IOBASE3, 0);
  578         pccard_ccr_write(pf, PCCARD_CCR_IOSIZE, iosize);
  579 }
  580 
  581 /* Enable a PCCARD function */
  582 static int
  583 pccard_function_enable(struct pccard_function *pf)
  584 {
  585         struct pccard_function *tmp;
  586         int reg;
  587         device_t dev = pf->sc->dev;
  588 
  589         if (pf->cfe == NULL) {
  590                 DEVPRVERBOSE((dev, "No config entry could be allocated.\n"));
  591                 return (ENOMEM);
  592         }
  593 
  594         /*
  595          * Increase the reference count on the socket, enabling power, if
  596          * necessary.
  597          */
  598         pf->sc->sc_enabled_count++;
  599 
  600         if (pf->pf_flags & PFF_ENABLED) {
  601                 /*
  602                  * Don't do anything if we're already enabled.
  603                  */
  604                 return (0);
  605         }
  606 
  607         /*
  608          * it's possible for different functions' CCRs to be in the same
  609          * underlying page.  Check for that.
  610          */
  611         STAILQ_FOREACH(tmp, &pf->sc->card.pf_head, pf_list) {
  612                 if ((tmp->pf_flags & PFF_ENABLED) &&
  613                     (pf->ccr_base >= (tmp->ccr_base - tmp->pf_ccr_offset)) &&
  614                     ((pf->ccr_base + PCCARD_CCR_SIZE) <=
  615                     (tmp->ccr_base - tmp->pf_ccr_offset +
  616                     tmp->pf_ccr_realsize))) {
  617                         pf->pf_ccrt = tmp->pf_ccrt;
  618                         pf->pf_ccrh = tmp->pf_ccrh;
  619                         pf->pf_ccr_realsize = tmp->pf_ccr_realsize;
  620 
  621                         /*
  622                          * pf->pf_ccr_offset = (tmp->pf_ccr_offset -
  623                          * tmp->ccr_base) + pf->ccr_base;
  624                          */
  625                         /* pf->pf_ccr_offset =
  626                             (tmp->pf_ccr_offset + pf->ccr_base) -
  627                             tmp->ccr_base; */
  628                         pf->pf_ccr_window = tmp->pf_ccr_window;
  629                         break;
  630                 }
  631         }
  632         if (tmp == NULL) {
  633                 pf->ccr_rid = 0;
  634                 pf->ccr_res = bus_alloc_resource(dev, SYS_RES_MEMORY,
  635                     &pf->ccr_rid, 0, ~0, PCCARD_MEM_PAGE_SIZE, RF_ACTIVE);
  636                 if (!pf->ccr_res)
  637                         goto bad;
  638                 DEVPRINTF((dev, "ccr_res == %lx-%lx, base=%x\n",
  639                     rman_get_start(pf->ccr_res), rman_get_end(pf->ccr_res),
  640                     pf->ccr_base));
  641                 CARD_SET_RES_FLAGS(device_get_parent(dev), dev, SYS_RES_MEMORY,
  642                     pf->ccr_rid, PCCARD_A_MEM_ATTR);
  643                 CARD_SET_MEMORY_OFFSET(device_get_parent(dev), dev,
  644                     pf->ccr_rid, pf->ccr_base, &pf->pf_ccr_offset);
  645                 pf->pf_ccrt = rman_get_bustag(pf->ccr_res);
  646                 pf->pf_ccrh = rman_get_bushandle(pf->ccr_res);
  647                 pf->pf_ccr_realsize = 1;
  648         }
  649 
  650         reg = (pf->cfe->number & PCCARD_CCR_OPTION_CFINDEX);
  651         reg |= PCCARD_CCR_OPTION_LEVIREQ;
  652         if (pccard_mfc(pf->sc)) {
  653                 reg |= (PCCARD_CCR_OPTION_FUNC_ENABLE |
  654                         PCCARD_CCR_OPTION_ADDR_DECODE);
  655                 /* PCCARD_CCR_OPTION_IRQ_ENABLE set elsewhere as needed */
  656         }
  657         pccard_ccr_write(pf, PCCARD_CCR_OPTION, reg);
  658 
  659         reg = 0;
  660         if ((pf->cfe->flags & PCCARD_CFE_IO16) == 0)
  661                 reg |= PCCARD_CCR_STATUS_IOIS8;
  662         if (pf->cfe->flags & PCCARD_CFE_AUDIO)
  663                 reg |= PCCARD_CCR_STATUS_AUDIO;
  664         pccard_ccr_write(pf, PCCARD_CCR_STATUS, reg);
  665 
  666         pccard_ccr_write(pf, PCCARD_CCR_SOCKETCOPY, 0);
  667 
  668         if (pccard_mfc(pf->sc))
  669                 pccard_mfc_adjust_iobase(pf, 0, 0, 0);
  670 
  671 #ifdef PCCARDDEBUG
  672         if (pccard_debug) {
  673                 STAILQ_FOREACH(tmp, &pf->sc->card.pf_head, pf_list) {
  674                         device_printf(tmp->sc->dev,
  675                             "function %d CCR at %d offset %x: "
  676                             "%x %x %x %x, %x %x %x %x, %x\n",
  677                             tmp->number, tmp->pf_ccr_window,
  678                             tmp->pf_ccr_offset,
  679                             pccard_ccr_read(tmp, 0x00),
  680                             pccard_ccr_read(tmp, 0x02),
  681                             pccard_ccr_read(tmp, 0x04),
  682                             pccard_ccr_read(tmp, 0x06),
  683                             pccard_ccr_read(tmp, 0x0A),
  684                             pccard_ccr_read(tmp, 0x0C),
  685                             pccard_ccr_read(tmp, 0x0E),
  686                             pccard_ccr_read(tmp, 0x10),
  687                             pccard_ccr_read(tmp, 0x12));
  688                 }
  689         }
  690 #endif
  691         pf->pf_flags |= PFF_ENABLED;
  692         return (0);
  693 
  694  bad:
  695         /*
  696          * Decrement the reference count, and power down the socket, if
  697          * necessary.
  698          */
  699         pf->sc->sc_enabled_count--;
  700         DEVPRINTF((dev, "bad --enabled_count = %d\n", pf->sc->sc_enabled_count));
  701 
  702         return (1);
  703 }
  704 
  705 /* Disable PCCARD function. */
  706 static void
  707 pccard_function_disable(struct pccard_function *pf)
  708 {
  709         struct pccard_function *tmp;
  710         device_t dev = pf->sc->dev;
  711 
  712         if (pf->cfe == NULL)
  713                 panic("pccard_function_disable: function not initialized");
  714 
  715         if ((pf->pf_flags & PFF_ENABLED) == 0) {
  716                 /*
  717                  * Don't do anything if we're already disabled.
  718                  */
  719                 return;
  720         }
  721 
  722         if (pf->intr_handler != NULL) {
  723                 struct pccard_ivar *devi = PCCARD_IVAR(pf->dev);
  724                 struct resource_list_entry *rle =
  725                     resource_list_find(&devi->resources, SYS_RES_IRQ, 0);
  726                 if (rle == NULL)
  727                         panic("Can't disable an interrupt with no IRQ res\n");
  728                 BUS_TEARDOWN_INTR(dev, pf->dev, rle->res,
  729                     pf->intr_handler_cookie);
  730         }
  731 
  732         /*
  733          * it's possible for different functions' CCRs to be in the same
  734          * underlying page.  Check for that.  Note we mark us as disabled
  735          * first to avoid matching ourself.
  736          */
  737 
  738         pf->pf_flags &= ~PFF_ENABLED;
  739         STAILQ_FOREACH(tmp, &pf->sc->card.pf_head, pf_list) {
  740                 if ((tmp->pf_flags & PFF_ENABLED) &&
  741                     (pf->ccr_base >= (tmp->ccr_base - tmp->pf_ccr_offset)) &&
  742                     ((pf->ccr_base + PCCARD_CCR_SIZE) <=
  743                     (tmp->ccr_base - tmp->pf_ccr_offset +
  744                     tmp->pf_ccr_realsize)))
  745                         break;
  746         }
  747 
  748         /* Not used by anyone else; unmap the CCR. */
  749         if (tmp == NULL) {
  750                 bus_release_resource(dev, SYS_RES_MEMORY, pf->ccr_rid,
  751                     pf->ccr_res);
  752                 pf->ccr_res = NULL;
  753         }
  754 
  755         /*
  756          * Decrement the reference count, and power down the socket, if
  757          * necessary.
  758          */
  759         pf->sc->sc_enabled_count--;
  760 }
  761 
  762 /*
  763  * simulate the old "probe" routine.  In the new world order, the driver
  764  * needs to grab devices while in the old they were assigned to the device by
  765  * the pccardd process.  These symbols are exported to the upper layers.
  766  */
  767 static int
  768 pccard_compat_do_probe(device_t bus, device_t dev)
  769 {
  770         return (CARD_COMPAT_MATCH(dev));
  771 }
  772 
  773 static int
  774 pccard_compat_do_attach(device_t bus, device_t dev)
  775 {
  776         int err;
  777 
  778         err = CARD_COMPAT_PROBE(dev);
  779         if (err <= 0)
  780                 err = CARD_COMPAT_ATTACH(dev);
  781         return (err);
  782 }
  783 
  784 #define PCCARD_NPORT    2
  785 #define PCCARD_NMEM     5
  786 #define PCCARD_NIRQ     1
  787 #define PCCARD_NDRQ     0
  788 
  789 static int
  790 pccard_probe(device_t dev)
  791 {
  792         device_set_desc(dev, "16-bit PCCard bus");
  793         return (0);
  794 }
  795 
  796 static int
  797 pccard_attach(device_t dev)
  798 {
  799         struct pccard_softc *sc = PCCARD_SOFTC(dev);
  800         int err;
  801 
  802         sc->dev = dev;
  803         sc->sc_enabled_count = 0;
  804         if ((err = pccard_device_create(sc)) != 0)
  805                 return  (err);
  806         STAILQ_INIT(&sc->card.pf_head);
  807         return (bus_generic_attach(dev));
  808 }
  809 
  810 static int
  811 pccard_detach(device_t dev)
  812 {
  813         pccard_detach_card(dev);
  814         pccard_device_destroy(device_get_softc(dev));
  815         return (0);
  816 }
  817 
  818 static int
  819 pccard_suspend(device_t self)
  820 {
  821         pccard_detach_card(self);
  822         return (0);
  823 }
  824 
  825 static
  826 int
  827 pccard_resume(device_t self)
  828 {
  829         return (0);
  830 }
  831 
  832 static void
  833 pccard_print_resources(struct resource_list *rl, const char *name, int type,
  834     int count, const char *format)
  835 {
  836         struct resource_list_entry *rle;
  837         int printed;
  838         int i;
  839 
  840         printed = 0;
  841         for (i = 0; i < count; i++) {
  842                 rle = resource_list_find(rl, type, i);
  843                 if (rle != NULL) {
  844                         if (printed == 0)
  845                                 printf(" %s ", name);
  846                         else if (printed > 0)
  847                                 printf(",");
  848                         printed++;
  849                         printf(format, rle->start);
  850                         if (rle->count > 1) {
  851                                 printf("-");
  852                                 printf(format, rle->start + rle->count - 1);
  853                         }
  854                 } else if (i > 3) {
  855                         /* check the first few regardless */
  856                         break;
  857                 }
  858         }
  859 }
  860 
  861 static int
  862 pccard_print_child(device_t dev, device_t child)
  863 {
  864         struct pccard_ivar *devi = PCCARD_IVAR(child);
  865         struct resource_list *rl = &devi->resources;
  866         int retval = 0;
  867 
  868         retval += bus_print_child_header(dev, child);
  869         retval += printf(" at");
  870 
  871         if (devi != NULL) {
  872                 pccard_print_resources(rl, "port", SYS_RES_IOPORT,
  873                     PCCARD_NPORT, "%#lx");
  874                 pccard_print_resources(rl, "iomem", SYS_RES_MEMORY,
  875                     PCCARD_NMEM, "%#lx");
  876                 pccard_print_resources(rl, "irq", SYS_RES_IRQ, PCCARD_NIRQ,
  877                     "%ld");
  878                 pccard_print_resources(rl, "drq", SYS_RES_DRQ, PCCARD_NDRQ,
  879                     "%ld");
  880                 retval += printf(" function %d config %d", devi->pf->number,
  881                     devi->pf->cfe->number);
  882         }
  883 
  884         retval += bus_print_child_footer(dev, child);
  885 
  886         return (retval);
  887 }
  888 
  889 static int
  890 pccard_set_resource(device_t dev, device_t child, int type, int rid,
  891     u_long start, u_long count)
  892 {
  893         struct pccard_ivar *devi = PCCARD_IVAR(child);
  894         struct resource_list *rl = &devi->resources;
  895 
  896         if (type != SYS_RES_IOPORT && type != SYS_RES_MEMORY
  897             && type != SYS_RES_IRQ && type != SYS_RES_DRQ)
  898                 return (EINVAL);
  899         if (rid < 0)
  900                 return (EINVAL);
  901         if (type == SYS_RES_IOPORT && rid >= PCCARD_NPORT)
  902                 return (EINVAL);
  903         if (type == SYS_RES_MEMORY && rid >= PCCARD_NMEM)
  904                 return (EINVAL);
  905         if (type == SYS_RES_IRQ && rid >= PCCARD_NIRQ)
  906                 return (EINVAL);
  907         if (type == SYS_RES_DRQ && rid >= PCCARD_NDRQ)
  908                 return (EINVAL);
  909 
  910         resource_list_add(rl, type, rid, start, start + count - 1, count);
  911         if (NULL != resource_list_alloc(rl, device_get_parent(dev), dev,
  912             type, &rid, start, start + count - 1, count, 0))
  913                 return 0;
  914         else
  915                 return ENOMEM;
  916 }
  917 
  918 static int
  919 pccard_get_resource(device_t dev, device_t child, int type, int rid,
  920     u_long *startp, u_long *countp)
  921 {
  922         struct pccard_ivar *devi = PCCARD_IVAR(child);
  923         struct resource_list *rl = &devi->resources;
  924         struct resource_list_entry *rle;
  925 
  926         rle = resource_list_find(rl, type, rid);
  927         if (rle == NULL)
  928                 return (ENOENT);
  929 
  930         if (startp != NULL)
  931                 *startp = rle->start;
  932         if (countp != NULL)
  933                 *countp = rle->count;
  934 
  935         return (0);
  936 }
  937 
  938 static void
  939 pccard_delete_resource(device_t dev, device_t child, int type, int rid)
  940 {
  941         struct pccard_ivar *devi = PCCARD_IVAR(child);
  942         struct resource_list *rl = &devi->resources;
  943         resource_list_delete(rl, type, rid);
  944 }
  945 
  946 static int
  947 pccard_set_res_flags(device_t dev, device_t child, int type, int rid,
  948     uint32_t flags)
  949 {
  950         return (CARD_SET_RES_FLAGS(device_get_parent(dev), child, type,
  951             rid, flags));
  952 }
  953 
  954 static int
  955 pccard_set_memory_offset(device_t dev, device_t child, int rid,
  956     uint32_t offset, uint32_t *deltap)
  957 
  958 {
  959         return (CARD_SET_MEMORY_OFFSET(device_get_parent(dev), child, rid,
  960             offset, deltap));
  961 }
  962 
  963 static void
  964 pccard_probe_nomatch(device_t bus, device_t child)
  965 {
  966         struct pccard_ivar *devi = PCCARD_IVAR(child);
  967         struct pccard_function *pf = devi->pf;
  968         struct pccard_softc *sc = PCCARD_SOFTC(bus);
  969         int i;
  970 
  971         device_printf(bus, "<unknown card>");
  972         printf(" (manufacturer=0x%04x, product=0x%04x, function_type=%d) "
  973             "at function %d\n", sc->card.manufacturer, sc->card.product,
  974             pf->function, pf->number);
  975         device_printf(bus, "   CIS info: ");
  976         for (i = 0; sc->card.cis1_info[i] != NULL && i < 4; i++)
  977                 printf("%s%s", i > 0 ? ", " : "", sc->card.cis1_info[i]);
  978         printf("\n");
  979         return;
  980 }
  981 
  982 static int
  983 pccard_child_location_str(device_t bus, device_t child, char *buf,
  984     size_t buflen)
  985 {
  986         struct pccard_ivar *devi = PCCARD_IVAR(child);
  987         struct pccard_function *pf = devi->pf;
  988 
  989         snprintf(buf, buflen, "function=%d", pf->number);
  990         return (0);
  991 }
  992 
  993 /* XXX Maybe this should be in subr_bus? */
  994 static void
  995 pccard_safe_quote(char *dst, const char *src, size_t len)
  996 {
  997         char *walker = dst, *ep = dst + len - 1;
  998 
  999         if (len == 0)
 1000                 return;
 1001         while (walker < ep)
 1002         {
 1003                 if (*src == '"') {
 1004                         if (ep - walker < 2)
 1005                                 break;
 1006                         *walker++ = '\\';
 1007                 }
 1008                 *walker++ = *src++;
 1009         }
 1010         *walker = '\0';
 1011 }
 1012 
 1013 static int
 1014 pccard_child_pnpinfo_str(device_t bus, device_t child, char *buf,
 1015     size_t buflen)
 1016 {
 1017         struct pccard_ivar *devi = PCCARD_IVAR(child);
 1018         struct pccard_function *pf = devi->pf;
 1019         struct pccard_softc *sc = PCCARD_SOFTC(bus);
 1020         char cis0[128], cis1[128];
 1021 
 1022         pccard_safe_quote(cis0, sc->card.cis1_info[0], sizeof(cis0));
 1023         pccard_safe_quote(cis1, sc->card.cis1_info[1], sizeof(cis1));
 1024         snprintf(buf, buflen, "manufacturer=0x%04x product=0x%04x "
 1025             "cisvendor=\"%s\" cisproduct=\"%s\" function_type=%d",
 1026             sc->card.manufacturer, sc->card.product, cis0, cis1, pf->function);
 1027         return (0);
 1028 }
 1029 
 1030 static int
 1031 pccard_read_ivar(device_t bus, device_t child, int which, u_char *result)
 1032 {
 1033         struct pccard_ivar *devi = PCCARD_IVAR(child);
 1034         struct pccard_function *pf = devi->pf;
 1035         struct pccard_softc *sc = PCCARD_SOFTC(bus);
 1036 
 1037         if (!pf)
 1038                 panic("No pccard function pointer");
 1039         switch (which) {
 1040         default:
 1041                 return (EINVAL);
 1042         case PCCARD_IVAR_ETHADDR:
 1043                 bcopy(pf->pf_funce_lan_nid, result, ETHER_ADDR_LEN);
 1044                 break;
 1045         case PCCARD_IVAR_VENDOR:
 1046                 *(uint32_t *)result = sc->card.manufacturer;
 1047                 break;
 1048         case PCCARD_IVAR_PRODUCT:
 1049                 *(uint32_t *)result = sc->card.product;
 1050                 break;
 1051         case PCCARD_IVAR_PRODEXT:
 1052                 *(uint16_t *)result = sc->card.prodext;
 1053                 break;
 1054         case PCCARD_IVAR_FUNCTION:
 1055                 *(uint32_t *)result = pf->function;
 1056                 break;
 1057         case PCCARD_IVAR_FUNCTION_NUMBER:
 1058                 *(uint32_t *)result = pf->number;
 1059                 break;
 1060         case PCCARD_IVAR_VENDOR_STR:
 1061                 *(const char **)result = sc->card.cis1_info[0];
 1062                 break;
 1063         case PCCARD_IVAR_PRODUCT_STR:
 1064                 *(const char **)result = sc->card.cis1_info[1];
 1065                 break;
 1066         case PCCARD_IVAR_CIS3_STR:
 1067                 *(const char **)result = sc->card.cis1_info[2];
 1068                 break;
 1069         case PCCARD_IVAR_CIS4_STR:
 1070                 *(const char **)result = sc->card.cis1_info[3];
 1071                 break;
 1072         }
 1073         return (0);
 1074 }
 1075 
 1076 static void
 1077 pccard_driver_added(device_t dev, driver_t *driver)
 1078 {
 1079         struct pccard_softc *sc = PCCARD_SOFTC(dev);
 1080         struct pccard_function *pf;
 1081         device_t child;
 1082 
 1083         STAILQ_FOREACH(pf, &sc->card.pf_head, pf_list) {
 1084                 if (STAILQ_EMPTY(&pf->cfe_head))
 1085                         continue;
 1086                 child = pf->dev;
 1087                 if (device_get_state(child) != DS_NOTPRESENT)
 1088                         continue;
 1089                 if (pccard_function_enable(pf) == 0 &&
 1090                     device_probe_and_attach(child) == 0) {
 1091                         DEVPRINTF((sc->dev, "function %d CCR at %d "
 1092                             "offset %x: %x %x %x %x, %x %x %x %x, %x\n",
 1093                             pf->number, pf->pf_ccr_window, pf->pf_ccr_offset,
 1094                             pccard_ccr_read(pf, 0x00),
 1095                         pccard_ccr_read(pf, 0x02), pccard_ccr_read(pf, 0x04),
 1096                         pccard_ccr_read(pf, 0x06), pccard_ccr_read(pf, 0x0A),
 1097                         pccard_ccr_read(pf, 0x0C), pccard_ccr_read(pf, 0x0E),
 1098                         pccard_ccr_read(pf, 0x10), pccard_ccr_read(pf, 0x12)));
 1099                 } else {
 1100                         if (pf->cfe != NULL)
 1101                                 pccard_function_disable(pf);
 1102                 }
 1103         }
 1104         return;
 1105 }
 1106 
 1107 static struct resource *
 1108 pccard_alloc_resource(device_t dev, device_t child, int type, int *rid,
 1109     u_long start, u_long end, u_long count, u_int flags)
 1110 {
 1111         struct pccard_ivar *dinfo;
 1112         struct resource_list_entry *rle = 0;
 1113         int passthrough = (device_get_parent(child) != dev);
 1114         int isdefault = (start == 0 && end == ~0UL && count == 1);
 1115         struct resource *r = NULL;
 1116 
 1117         /* XXX I'm no longer sure this is right */
 1118         if (passthrough) {
 1119                 return (BUS_ALLOC_RESOURCE(device_get_parent(dev), child,
 1120                     type, rid, start, end, count, flags));
 1121         }
 1122 
 1123         dinfo = device_get_ivars(child);
 1124         rle = resource_list_find(&dinfo->resources, type, *rid);
 1125 
 1126         if (rle == NULL && isdefault)
 1127                 return (NULL);  /* no resource of that type/rid */
 1128         if (rle == NULL || rle->res == NULL) {
 1129                 /* XXX Need to adjust flags */
 1130                 r = bus_alloc_resource(dev, type, rid, start, end,
 1131                   count, flags);
 1132                 if (r == NULL)
 1133                     goto bad;
 1134                 resource_list_add(&dinfo->resources, type, *rid,
 1135                   rman_get_start(r), rman_get_end(r), count);
 1136                 rle = resource_list_find(&dinfo->resources, type, *rid);
 1137                 if (!rle)
 1138                     goto bad;
 1139                 rle->res = r;
 1140         }
 1141         /*
 1142          * If dev doesn't own the device, then we can't give this device
 1143          * out.
 1144          */
 1145         if (rman_get_device(rle->res) != dev)
 1146                 return (NULL);
 1147         rman_set_device(rle->res, child);
 1148         if (flags & RF_ACTIVE)
 1149                 BUS_ACTIVATE_RESOURCE(dev, child, type, *rid, rle->res);
 1150         return (rle->res);
 1151 bad:;
 1152         device_printf(dev, "WARNING: Resource not reserved by pccard\n");
 1153         return (NULL);
 1154 }
 1155 
 1156 static int
 1157 pccard_release_resource(device_t dev, device_t child, int type, int rid,
 1158     struct resource *r)
 1159 {
 1160         struct pccard_ivar *dinfo;
 1161         int passthrough = (device_get_parent(child) != dev);
 1162         struct resource_list_entry *rle = 0;
 1163 
 1164         if (passthrough)
 1165                 return BUS_RELEASE_RESOURCE(device_get_parent(dev), child,
 1166                     type, rid, r);
 1167 
 1168         dinfo = device_get_ivars(child);
 1169 
 1170         rle = resource_list_find(&dinfo->resources, type, rid);
 1171 
 1172         if (!rle) {
 1173                 device_printf(dev, "Allocated resource not found, "
 1174                     "%d %x %lx %lx\n",
 1175                     type, rid, rman_get_start(r), rman_get_size(r));
 1176                 return ENOENT;
 1177         }
 1178         if (!rle->res) {
 1179                 device_printf(dev, "Allocated resource not recorded\n");
 1180                 return ENOENT;
 1181         }
 1182         /*
 1183          * Deactivate the resource (since it is being released), and
 1184          * assign it to the bus.
 1185          */
 1186         BUS_DEACTIVATE_RESOURCE(dev, child, type, rid, rle->res);
 1187         rman_set_device(rle->res, dev);
 1188         return (0);
 1189 }
 1190 
 1191 static void
 1192 pccard_child_detached(device_t parent, device_t dev)
 1193 {
 1194         struct pccard_ivar *ivar = PCCARD_IVAR(dev);
 1195         struct pccard_function *pf = ivar->pf;
 1196 
 1197         pccard_function_disable(pf);
 1198 }
 1199 
 1200 static void
 1201 pccard_intr(void *arg)
 1202 {
 1203         struct pccard_function *pf = (struct pccard_function*) arg;
 1204         int reg;
 1205         int doisr = 1;
 1206 
 1207         /*
 1208          * MFC cards know if they interrupted, so we have to ack the
 1209          * interrupt and call the ISR.  Non-MFC cards don't have these
 1210          * bits, so they always get called.  Many non-MFC cards have
 1211          * this bit set always upon read, but some do not.
 1212          *
 1213          * We always ack the interrupt, even if there's no ISR
 1214          * for the card.  This is done on the theory that acking
 1215          * the interrupt will pacify the card enough to keep an
 1216          * interrupt storm from happening.  Of course this won't
 1217          * help in the non-MFC case.
 1218          *
 1219          * This has no impact for MPSAFEness of the client drivers.
 1220          * We register this with whatever flags the intr_handler
 1221          * was registered with.  All these functions are MPSAFE.
 1222          */
 1223         if (pccard_mfc(pf->sc)) {
 1224                 reg = pccard_ccr_read(pf, PCCARD_CCR_STATUS);
 1225                 if (reg & PCCARD_CCR_STATUS_INTR)
 1226                         pccard_ccr_write(pf, PCCARD_CCR_STATUS,
 1227                             reg & ~PCCARD_CCR_STATUS_INTR);
 1228                 else
 1229                         doisr = 0;
 1230         }
 1231         if (pf->intr_handler != NULL && doisr)
 1232                 pf->intr_handler(pf->intr_handler_arg);
 1233 }
 1234 
 1235 static int
 1236 pccard_setup_intr(device_t dev, device_t child, struct resource *irq,
 1237     int flags, driver_intr_t *intr, void *arg, void **cookiep)
 1238 {
 1239         struct pccard_softc *sc = PCCARD_SOFTC(dev);
 1240         struct pccard_ivar *ivar = PCCARD_IVAR(child);
 1241         struct pccard_function *pf = ivar->pf;
 1242         int err;
 1243 
 1244         if (pf->intr_handler != NULL)
 1245                 panic("Only one interrupt handler per function allowed");
 1246         err = bus_generic_setup_intr(dev, child, irq, flags, pccard_intr,
 1247             pf, cookiep);
 1248         if (err != 0)
 1249                 return (err);
 1250         pf->intr_handler = intr;
 1251         pf->intr_handler_arg = arg;
 1252         pf->intr_handler_cookie = *cookiep;
 1253         if (pccard_mfc(sc)) {
 1254                 pccard_ccr_write(pf, PCCARD_CCR_OPTION,
 1255                     pccard_ccr_read(pf, PCCARD_CCR_OPTION) |
 1256                     PCCARD_CCR_OPTION_IREQ_ENABLE);
 1257         }
 1258         return (0);
 1259 }
 1260 
 1261 static int
 1262 pccard_teardown_intr(device_t dev, device_t child, struct resource *r,
 1263     void *cookie)
 1264 {
 1265         struct pccard_softc *sc = PCCARD_SOFTC(dev);
 1266         struct pccard_ivar *ivar = PCCARD_IVAR(child);
 1267         struct pccard_function *pf = ivar->pf;
 1268         int ret;
 1269 
 1270         if (pccard_mfc(sc)) {
 1271                 pccard_ccr_write(pf, PCCARD_CCR_OPTION,
 1272                     pccard_ccr_read(pf, PCCARD_CCR_OPTION) &
 1273                     ~PCCARD_CCR_OPTION_IREQ_ENABLE);
 1274         }
 1275         ret = bus_generic_teardown_intr(dev, child, r, cookie);
 1276         if (ret == 0) {
 1277                 pf->intr_handler = NULL;
 1278                 pf->intr_handler_arg = NULL;
 1279                 pf->intr_handler_cookie = NULL;
 1280         }
 1281 
 1282         return (ret);
 1283 }
 1284 
 1285 static int
 1286 pccard_activate_resource(device_t brdev, device_t child, int type, int rid,
 1287     struct resource *r)
 1288 {
 1289         struct pccard_ivar *ivar = PCCARD_IVAR(child);
 1290         struct pccard_function *pf = ivar->pf;
 1291 
 1292         switch(type) {
 1293         case SYS_RES_IOPORT:
 1294                 /*
 1295                  * We need to adjust IOBASE[01] and IOSIZE if we're an MFC
 1296                  * card.
 1297                  */
 1298                 if (pccard_mfc(pf->sc))
 1299                         pccard_mfc_adjust_iobase(pf, rman_get_start(r), 0,
 1300                             rman_get_size(r));
 1301                 break;
 1302         default:
 1303                 break;
 1304         }
 1305         return (bus_generic_activate_resource(brdev, child, type, rid, r));
 1306 }
 1307 
 1308 static int
 1309 pccard_deactivate_resource(device_t brdev, device_t child, int type,
 1310     int rid, struct resource *r)
 1311 {
 1312         /* XXX undo pccard_activate_resource? XXX */
 1313         return (bus_generic_deactivate_resource(brdev, child, type, rid, r));
 1314 }
 1315 
 1316 static int
 1317 pccard_attr_read_impl(device_t brdev, device_t child, uint32_t offset,
 1318     uint8_t *val)
 1319 {
 1320         struct pccard_ivar *devi = PCCARD_IVAR(child);
 1321         struct pccard_function *pf = devi->pf;
 1322 
 1323         /*
 1324          * Optimization.  Most of the time, devices want to access
 1325          * the same page of the attribute memory that the CCR is in.
 1326          * We take advantage of this fact here.
 1327          */
 1328         if (offset / PCCARD_MEM_PAGE_SIZE ==
 1329             pf->ccr_base / PCCARD_MEM_PAGE_SIZE)
 1330                 *val = bus_space_read_1(pf->pf_ccrt, pf->pf_ccrh,
 1331                     offset % PCCARD_MEM_PAGE_SIZE);
 1332         else {
 1333                 CARD_SET_MEMORY_OFFSET(brdev, child, pf->ccr_rid, offset,
 1334                     &offset);
 1335                 *val = bus_space_read_1(pf->pf_ccrt, pf->pf_ccrh, offset);
 1336                 CARD_SET_MEMORY_OFFSET(brdev, child, pf->ccr_rid, pf->ccr_base,
 1337                     &offset);
 1338         }
 1339         return 0;
 1340 }
 1341 
 1342 static int
 1343 pccard_attr_write_impl(device_t brdev, device_t child, uint32_t offset,
 1344     uint8_t val)
 1345 {
 1346         struct pccard_ivar *devi = PCCARD_IVAR(child);
 1347         struct pccard_function *pf = devi->pf;
 1348 
 1349         /*
 1350          * Optimization.  Most of the time, devices want to access
 1351          * the same page of the attribute memory that the CCR is in.
 1352          * We take advantage of this fact here.
 1353          */
 1354         if (offset / PCCARD_MEM_PAGE_SIZE ==
 1355             pf->ccr_base / PCCARD_MEM_PAGE_SIZE)
 1356                 bus_space_write_1(pf->pf_ccrt, pf->pf_ccrh,
 1357                     offset % PCCARD_MEM_PAGE_SIZE, val);
 1358         else {
 1359                 CARD_SET_MEMORY_OFFSET(brdev, child, pf->ccr_rid, offset,
 1360                     &offset);
 1361                 bus_space_write_1(pf->pf_ccrt, pf->pf_ccrh, offset, val);
 1362                 CARD_SET_MEMORY_OFFSET(brdev, child, pf->ccr_rid, pf->ccr_base,
 1363                     &offset);
 1364         }
 1365 
 1366         return 0;
 1367 }
 1368 
 1369 static int
 1370 pccard_ccr_read_impl(device_t brdev, device_t child, uint32_t offset,
 1371     uint8_t *val)
 1372 {
 1373         struct pccard_ivar *devi = PCCARD_IVAR(child);
 1374 
 1375         *val = pccard_ccr_read(devi->pf, offset);
 1376         device_printf(child, "ccr_read of %#x (%#x) is %#x\n", offset,
 1377           devi->pf->pf_ccr_offset, *val);
 1378         return 0;
 1379 }
 1380 
 1381 static int
 1382 pccard_ccr_write_impl(device_t brdev, device_t child, uint32_t offset,
 1383     uint8_t val)
 1384 {
 1385         struct pccard_ivar *devi = PCCARD_IVAR(child);
 1386         struct pccard_function *pf = devi->pf;
 1387 
 1388         /*
 1389          * Can't use pccard_ccr_write since client drivers may access
 1390          * registers not contained in the 'mask' if they are non-standard.
 1391          */
 1392         device_printf(child, "ccr_write of %#x to %#x (%#x)\n", val, offset,
 1393           devi->pf->pf_ccr_offset);
 1394         bus_space_write_1(pf->pf_ccrt, pf->pf_ccrh, pf->pf_ccr_offset + offset,
 1395             val);
 1396         return 0;
 1397 }
 1398 
 1399 
 1400 static device_method_t pccard_methods[] = {
 1401         /* Device interface */
 1402         DEVMETHOD(device_probe,         pccard_probe),
 1403         DEVMETHOD(device_attach,        pccard_attach),
 1404         DEVMETHOD(device_detach,        pccard_detach),
 1405         DEVMETHOD(device_shutdown,      bus_generic_shutdown),
 1406         DEVMETHOD(device_suspend,       pccard_suspend),
 1407         DEVMETHOD(device_resume,        pccard_resume),
 1408 
 1409         /* Bus interface */
 1410         DEVMETHOD(bus_print_child,      pccard_print_child),
 1411         DEVMETHOD(bus_driver_added,     pccard_driver_added),
 1412         DEVMETHOD(bus_child_detached,   pccard_child_detached),
 1413         DEVMETHOD(bus_alloc_resource,   pccard_alloc_resource),
 1414         DEVMETHOD(bus_release_resource, pccard_release_resource),
 1415         DEVMETHOD(bus_activate_resource, pccard_activate_resource),
 1416         DEVMETHOD(bus_deactivate_resource, pccard_deactivate_resource),
 1417         DEVMETHOD(bus_setup_intr,       pccard_setup_intr),
 1418         DEVMETHOD(bus_teardown_intr,    pccard_teardown_intr),
 1419         DEVMETHOD(bus_set_resource,     pccard_set_resource),
 1420         DEVMETHOD(bus_get_resource,     pccard_get_resource),
 1421         DEVMETHOD(bus_delete_resource,  pccard_delete_resource),
 1422         DEVMETHOD(bus_probe_nomatch,    pccard_probe_nomatch),
 1423         DEVMETHOD(bus_read_ivar,        pccard_read_ivar),
 1424         DEVMETHOD(bus_child_pnpinfo_str, pccard_child_pnpinfo_str),
 1425         DEVMETHOD(bus_child_location_str, pccard_child_location_str),
 1426 
 1427         /* Card Interface */
 1428         DEVMETHOD(card_set_res_flags,   pccard_set_res_flags),
 1429         DEVMETHOD(card_set_memory_offset, pccard_set_memory_offset),
 1430         DEVMETHOD(card_attach_card,     pccard_attach_card),
 1431         DEVMETHOD(card_detach_card,     pccard_detach_card),
 1432         DEVMETHOD(card_do_product_lookup, pccard_do_product_lookup),
 1433         DEVMETHOD(card_compat_do_probe, pccard_compat_do_probe),
 1434         DEVMETHOD(card_compat_do_attach, pccard_compat_do_attach),
 1435         DEVMETHOD(card_cis_scan,        pccard_scan_cis),
 1436         DEVMETHOD(card_attr_read,       pccard_attr_read_impl),
 1437         DEVMETHOD(card_attr_write,      pccard_attr_write_impl),
 1438         DEVMETHOD(card_ccr_read,        pccard_ccr_read_impl),
 1439         DEVMETHOD(card_ccr_write,       pccard_ccr_write_impl),
 1440 
 1441         { 0, 0 }
 1442 };
 1443 
 1444 static driver_t pccard_driver = {
 1445         "pccard",
 1446         pccard_methods,
 1447         sizeof(struct pccard_softc)
 1448 };
 1449 
 1450 devclass_t      pccard_devclass;
 1451 
 1452 /* Maybe we need to have a slot device? */
 1453 DRIVER_MODULE(pccard, pcic, pccard_driver, pccard_devclass, 0, 0);
 1454 DRIVER_MODULE(pccard, cbb, pccard_driver, pccard_devclass, 0, 0);
 1455 MODULE_VERSION(pccard, 1);

Cache object: 186eb781131925b0637561d7c66147b4


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