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