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