sys/dev/pccard/pccard.c

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