/* $NetBSD: pcmcia.c,v 1.23 2000/07/28 19:17:02 drochner Exp $ */ /* $FreeBSD$ */ /* * Copyright (c) 1997 Marc Horowitz. All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * 3. All advertising materials mentioning features or use of this software * must display the following acknowledgement: * This product includes software developed by Marc Horowitz. * 4. The name of the author may not be used to endorse or promote products * derived from this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include "power_if.h" #include "card_if.h" #define PCCARDDEBUG #ifdef PCCARDDEBUG int pccard_debug = 1; #define DPRINTF(arg) if (pccard_debug) printf arg #define DEVPRINTF(arg) if (pccard_debug) device_printf arg #define PRVERBOSE(arg) printf arg #define DEVPRVERBOSE(arg) device_printf arg #else #define DPRINTF(arg) #define DEVPRINTF(arg) #define PRVERBOSE(arg) if (bootverbose) printf arg #define DEVPRVERBOSE(arg) if (bootverbose) device_printf arg #endif #ifdef PCCARDVERBOSE int pccard_verbose = 1; #else int pccard_verbose = 0; #endif int pccard_print(void *, const char *); int pccard_ccr_read(struct pccard_function *pf, int ccr) { return (bus_space_read_1(pf->pf_ccrt, pf->pf_ccrh, pf->pf_ccr_offset + ccr)); } void pccard_ccr_write(struct pccard_function *pf, int ccr, int val) { if ((pf->ccr_mask) & (1 << (ccr / 2))) { bus_space_write_1(pf->pf_ccrt, pf->pf_ccrh, pf->pf_ccr_offset + ccr, val); } } static int pccard_attach_card(device_t dev) { struct pccard_softc *sc = PCCARD_SOFTC(dev); struct pccard_function *pf; struct pccard_ivar *ivar; device_t child; int attached; sc->intr_handler_count = 0; /* * this is here so that when socket_enable calls gettype, trt happens */ STAILQ_INIT(&sc->card.pf_head); DEVPRINTF((dev, "chip_socket_enable\n")); POWER_ENABLE_SOCKET(device_get_parent(dev), dev); DEVPRINTF((dev, "read_cis\n")); pccard_read_cis(sc); DEVPRINTF((dev, "check_cis_quirks\n")); pccard_check_cis_quirks(dev); /* * bail now if the card has no functions, or if there was an error in * the cis. */ if (sc->card.error) { device_printf (dev, "CARD ERROR!\n"); return (1); } if (STAILQ_EMPTY(&sc->card.pf_head)) { device_printf (dev, "Card has no functions!\n"); return (1); } if (1) pccard_print_cis(dev); attached = 0; DEVPRINTF((dev, "functions scanning\n")); STAILQ_FOREACH(pf, &sc->card.pf_head, pf_list) { if (STAILQ_EMPTY(&pf->cfe_head)) continue; pf->sc = sc; pf->cfe = NULL; pf->dev = NULL; } #if 0 DEVPRINTF((dev, "chip_socket_disable\n")); POWER_DISABLE_SOCKET(device_get_parent(dev), dev); #endif STAILQ_FOREACH(pf, &sc->card.pf_head, pf_list) { if (STAILQ_EMPTY(&pf->cfe_head)) continue; /* * In NetBSD, the drivers are responsible for activating * each function of a card. I think that in FreeBSD we * want to activate them enough for the usual bus_*_resource * routines will do the right thing. This many mean a * departure from the current NetBSD model. * * This could get really ugly for multifunction cards. But * it might also just fall out of the FreeBSD resource model. * */ ivar = malloc(sizeof(struct pccard_ivar), M_DEVBUF, M_WAITOK | M_ZERO); child = device_add_child(dev, NULL, -1); device_set_ivars(child, ivar); ivar->fcn = pf; pf->dev = child; /* * XXX We might want to move the next two lines into * XXX the pccard interface layer. For the moment, this * XXX is OK, but some drivers want to pick the config * XXX entry to use as well as some address tweaks (mostly * XXX due to bugs in decode logic that makes some * XXX addresses illegal or broken). */ pccard_function_init(pf); if (pccard_function_enable(pf) == 0 && device_probe_and_attach(child) == 0) { attached++; DEVPRINTF((sc->dev, "function %d CCR at %d " "offset %x: %x %x %x %x, %x %x %x %x, %x\n", pf->number, pf->pf_ccr_window, pf->pf_ccr_offset, pccard_ccr_read(pf, 0x00), pccard_ccr_read(pf, 0x02), pccard_ccr_read(pf, 0x04), pccard_ccr_read(pf, 0x06), pccard_ccr_read(pf, 0x0A), pccard_ccr_read(pf, 0x0C), pccard_ccr_read(pf, 0x0E), pccard_ccr_read(pf, 0x10), pccard_ccr_read(pf, 0x12))); } else { device_delete_child(dev, child); } } return (0); } static int pccard_detach_card(device_t dev, int flags) { struct pccard_softc *sc = PCCARD_SOFTC(dev); struct pccard_function *pf; /* * We are running on either the PCCARD socket's event thread * or in user context detaching a device by user request. */ STAILQ_FOREACH(pf, &sc->card.pf_head, pf_list) { if (STAILQ_FIRST(&pf->cfe_head) == NULL) continue; pccard_function_disable(pf); /* * XXX must also actually delete resources created by * pccard_function_init() */ if (pf->dev) device_delete_child(dev, pf->dev); } return (0); } const struct pccard_product * pccard_product_lookup(device_t dev, const struct pccard_product *tab, size_t ent_size, pccard_product_match_fn matchfn) { const struct pccard_product *ent; int matches; u_int32_t fcn; u_int32_t vendor; u_int32_t prod; char *vendorstr; char *prodstr; #ifdef DIAGNOSTIC if (sizeof *ent > ent_size) panic("pccard_product_lookup: bogus ent_size %ld", (long) ent_size); #endif if (pccard_get_vendor(dev, &vendor)) return (NULL); if (pccard_get_product(dev, &prod)) return (NULL); if (pccard_get_function_number(dev, &fcn)) return (NULL); if (pccard_get_vendor_str(dev, &vendorstr)) return (NULL); if (pccard_get_product_str(dev, &prodstr)) return (NULL); for (ent = tab; ent->pp_name != NULL; ent = (const struct pccard_product *) ((const char *) ent + ent_size)) { matches = 1; if (matches && ent->pp_vendor != PCCARD_VENDOR_ANY && vendor != ent->pp_vendor) matches = 0; if (matches && ent->pp_product != PCCARD_PRODUCT_ANY && prod != ent->pp_product) matches = 0; if (matches && fcn != ent->pp_expfunc) matches = 0; if (matches && ent->pp_cis[0] && strcmp(ent->pp_cis[0], vendorstr) != 0) matches = 0; if (matches && ent->pp_cis[1] && strcmp(ent->pp_cis[1], prodstr) != 0) matches = 0; /* XXX need to match cis[2] and cis[3] also XXX */ if (matchfn != NULL) matches = (*matchfn)(dev, ent, matches); if (matches) return (ent); } return (NULL); } static int pccard_card_gettype(device_t dev, int *type) { struct pccard_softc *sc = PCCARD_SOFTC(dev); struct pccard_function *pf; /* * set the iftype to memory if this card has no functions (not yet * probed), or only one function, and that is not initialized yet or * that is memory. */ pf = STAILQ_FIRST(&sc->card.pf_head); if (pf == NULL || (STAILQ_NEXT(pf, pf_list) == NULL && (pf->cfe == NULL || pf->cfe->iftype == PCCARD_IFTYPE_MEMORY))) *type = PCCARD_IFTYPE_MEMORY; else *type = PCCARD_IFTYPE_IO; return (0); } /* * Initialize a PCCARD function. May be called as long as the function is * disabled. */ void pccard_function_init(struct pccard_function *pf) { struct pccard_config_entry *cfe; int i; struct pccard_ivar *devi = PCCARD_IVAR(pf->dev); struct resource_list *rl = &devi->resources; struct resource_list_entry *rle; struct resource *r = 0; device_t bus; int start; int end; if (pf->pf_flags & PFF_ENABLED) { printf("pccard_function_init: function is enabled"); return; } bus = device_get_parent(pf->dev); /* Remember which configuration entry we are using. */ STAILQ_FOREACH(cfe, &pf->cfe_head, cfe_list) { for (i = 0; i < cfe->num_iospace; i++) cfe->iores[i] = NULL; cfe->irqres = NULL; for (i = 0; i < cfe->num_iospace; i++) { start = cfe->iospace[i].start; if (start) end = start + cfe->iospace[i].length - 1; else end = ~0; cfe->iorid[i] = i; r = cfe->iores[i] = bus_alloc_resource(bus, SYS_RES_IOPORT, &cfe->iorid[i], start, end, cfe->iospace[i].length, rman_make_alignment_flags(cfe->iospace[i].length)); if (cfe->iores[i] == 0) goto not_this_one; resource_list_add(rl, SYS_RES_IOPORT, cfe->iorid[i], rman_get_start(r), rman_get_end(r), cfe->iospace[i].length); { rle = resource_list_find(rl, SYS_RES_IOPORT, cfe->iorid[i]); rle->res = r; } } if (cfe->num_memspace > 0) { goto not_this_one; } if (cfe->irqmask) { cfe->irqrid = 0; r = cfe->irqres = bus_alloc_resource(bus, SYS_RES_IRQ, &cfe->irqrid, 0, ~0, 1, 0); if (cfe->irqres == 0) goto not_this_one; resource_list_add(rl, SYS_RES_IRQ, cfe->irqrid, rman_get_start(r), rman_get_end(r), 1); { rle = resource_list_find(rl, SYS_RES_IRQ, cfe->irqrid); rle->res = r; } } /* XXX Don't know how to deal with maxtwins */ /* If we get to here, we've allocated all we need */ pf->cfe = cfe; break; not_this_one:; DEVPRVERBOSE((bus, "Allocation failed for cfe %d\n", cfe->number)); /* * Release resources that we partially allocated * from this config entry. */ for (i = 0; i < cfe->num_iospace; i++) { if (cfe->iores[i]) { resource_list_delete(rl, SYS_RES_IOPORT, i); bus_release_resource(bus, SYS_RES_IOPORT, cfe->iorid[i], cfe->iores[i]); } cfe->iores[i] = NULL; } if (cfe->irqmask && cfe->irqres) { resource_list_delete(rl, SYS_RES_IRQ, cfe->irqrid); bus_release_resource(bus, SYS_RES_IRQ, cfe->irqrid, cfe->irqres); cfe->irqres = NULL; } } } /* Enable a PCCARD function */ int pccard_function_enable(struct pccard_function *pf) { struct pccard_function *tmp; int reg; device_t dev = pf->sc->dev; if (pf->cfe == NULL) { DEVPRVERBOSE((dev, "No config entry could be allocated.\n")); return (ENOMEM); } /* * Increase the reference count on the socket, enabling power, if * necessary. */ if (pf->sc->sc_enabled_count++ == 0) POWER_ENABLE_SOCKET(device_get_parent(dev), dev); DEVPRINTF((dev, "++enabled_count = %d\n", pf->sc->sc_enabled_count)); if (pf->pf_flags & PFF_ENABLED) { /* * Don't do anything if we're already enabled. */ return (0); } /* * it's possible for different functions' CCRs to be in the same * underlying page. Check for that. */ STAILQ_FOREACH(tmp, &pf->sc->card.pf_head, pf_list) { if ((tmp->pf_flags & PFF_ENABLED) && (pf->ccr_base >= (tmp->ccr_base - tmp->pf_ccr_offset)) && ((pf->ccr_base + PCCARD_CCR_SIZE) <= (tmp->ccr_base - tmp->pf_ccr_offset + tmp->pf_ccr_realsize))) { pf->pf_ccrt = tmp->pf_ccrt; pf->pf_ccrh = tmp->pf_ccrh; pf->pf_ccr_realsize = tmp->pf_ccr_realsize; /* * pf->pf_ccr_offset = (tmp->pf_ccr_offset - * tmp->ccr_base) + pf->ccr_base; */ /* pf->pf_ccr_offset = (tmp->pf_ccr_offset + pf->ccr_base) - tmp->ccr_base; */ pf->pf_ccr_window = tmp->pf_ccr_window; break; } } if (tmp == NULL) { pf->ccr_rid = 0; pf->ccr_res = bus_alloc_resource(dev, SYS_RES_MEMORY, &pf->ccr_rid, 0, ~0, 1 << 10, RF_ACTIVE); if (!pf->ccr_res) goto bad; DEVPRINTF((dev, "ccr_res == %lx-%lx, base=%lx\n", rman_get_start(pf->ccr_res), rman_get_end(pf->ccr_res), pf->ccr_base)); CARD_SET_RES_FLAGS(device_get_parent(dev), dev, SYS_RES_MEMORY, pf->ccr_rid, PCCARD_A_MEM_ATTR); CARD_SET_MEMORY_OFFSET(device_get_parent(dev), dev, pf->ccr_rid, pf->ccr_base, &pf->pf_ccr_offset); pf->pf_ccrt = rman_get_bustag(pf->ccr_res); pf->pf_ccrh = rman_get_bushandle(pf->ccr_res); pf->pf_ccr_realsize = 1; } reg = (pf->cfe->number & PCCARD_CCR_OPTION_CFINDEX); reg |= PCCARD_CCR_OPTION_LEVIREQ; if (pccard_mfc(pf->sc)) { reg |= (PCCARD_CCR_OPTION_FUNC_ENABLE | PCCARD_CCR_OPTION_ADDR_DECODE); /* * XXX Need to enable PCCARD_CCR_OPTION_IRQ_ENABLE if * XXX we have an interrupt handler, but we don't know that * XXX at this point. */ /* reg |= PCCARD_CCR_OPTION_IREQ_ENABLE;*/ } pccard_ccr_write(pf, PCCARD_CCR_OPTION, reg); reg = 0; if ((pf->cfe->flags & PCCARD_CFE_IO16) == 0) reg |= PCCARD_CCR_STATUS_IOIS8; if (pf->cfe->flags & PCCARD_CFE_AUDIO) reg |= PCCARD_CCR_STATUS_AUDIO; pccard_ccr_write(pf, PCCARD_CCR_STATUS, reg); pccard_ccr_write(pf, PCCARD_CCR_SOCKETCOPY, 0); if (pccard_mfc(pf->sc)) { long tmp, iosize; tmp = pf->pf_mfc_iomax - pf->pf_mfc_iobase; /* round up to nearest (2^n)-1 */ for (iosize = 1; iosize < tmp; iosize <<= 1) ; iosize--; pccard_ccr_write(pf, PCCARD_CCR_IOBASE0, pf->pf_mfc_iobase & 0xff); pccard_ccr_write(pf, PCCARD_CCR_IOBASE1, (pf->pf_mfc_iobase >> 8) & 0xff); pccard_ccr_write(pf, PCCARD_CCR_IOBASE2, 0); pccard_ccr_write(pf, PCCARD_CCR_IOBASE3, 0); pccard_ccr_write(pf, PCCARD_CCR_IOSIZE, iosize); } #ifdef PCCARDDEBUG if (pccard_debug) { STAILQ_FOREACH(tmp, &pf->sc->card.pf_head, pf_list) { device_printf(tmp->sc->dev, "function %d CCR at %d offset %x: " "%x %x %x %x, %x %x %x %x, %x\n", tmp->number, tmp->pf_ccr_window, tmp->pf_ccr_offset, pccard_ccr_read(tmp, 0x00), pccard_ccr_read(tmp, 0x02), pccard_ccr_read(tmp, 0x04), pccard_ccr_read(tmp, 0x06), pccard_ccr_read(tmp, 0x0A), pccard_ccr_read(tmp, 0x0C), pccard_ccr_read(tmp, 0x0E), pccard_ccr_read(tmp, 0x10), pccard_ccr_read(tmp, 0x12)); } } #endif pf->pf_flags |= PFF_ENABLED; return (0); bad: /* * Decrement the reference count, and power down the socket, if * necessary. */ if (--pf->sc->sc_enabled_count == 0) POWER_DISABLE_SOCKET(device_get_parent(dev), dev); DEVPRINTF((dev, "bad --enabled_count = %d\n", pf->sc->sc_enabled_count)); return (1); } /* Disable PCCARD function. */ void pccard_function_disable(struct pccard_function *pf) { struct pccard_function *tmp; device_t dev = pf->sc->dev; if (pf->cfe == NULL) panic("pccard_function_disable: function not initialized"); if ((pf->pf_flags & PFF_ENABLED) == 0) { /* * Don't do anything if we're already disabled. */ return; } if (pf->intr_handler != NULL) { pf->intr_handler = NULL; pf->intr_handler_arg = NULL; pf->intr_handler_cookie = NULL; pccard_ccr_write(pf, PCCARD_CCR_OPTION, pccard_ccr_read(pf, PCCARD_CCR_OPTION) & ~PCCARD_CCR_OPTION_IREQ_ENABLE); if (pf->sc->intr_handler_count == 1) { struct pccard_ivar *ivar = PCCARD_IVAR(pf->dev); struct resource_list_entry *rle = NULL; pf->sc->intr_handler_count--; rle = resource_list_find(&ivar->resources, SYS_RES_IRQ, 0); if (rle == NULL) panic("No IRQ for pccard?"); bus_teardown_intr(dev, rle->res, &pf->sc->intr_handler_count); } } /* * it's possible for different functions' CCRs to be in the same * underlying page. Check for that. Note we mark us as disabled * first to avoid matching ourself. */ pf->pf_flags &= ~PFF_ENABLED; STAILQ_FOREACH(tmp, &pf->sc->card.pf_head, pf_list) { if ((tmp->pf_flags & PFF_ENABLED) && (pf->ccr_base >= (tmp->ccr_base - tmp->pf_ccr_offset)) && ((pf->ccr_base + PCCARD_CCR_SIZE) <= (tmp->ccr_base - tmp->pf_ccr_offset + tmp->pf_ccr_realsize))) break; } /* Not used by anyone else; unmap the CCR. */ if (tmp == NULL) { bus_release_resource(dev, SYS_RES_MEMORY, pf->ccr_rid, pf->ccr_res); pf->ccr_res = NULL; } /* * Decrement the reference count, and power down the socket, if * necessary. */ if (--pf->sc->sc_enabled_count == 0) POWER_DISABLE_SOCKET(device_get_parent(dev), dev); DEVPRINTF((dev, "--enabled_count = %d\n", pf->sc->sc_enabled_count)); } #if 0 /* XXX These functions are needed, but not like this XXX */ int pccard_io_map(struct pccard_function *pf, int width, bus_addr_t offset, bus_size_t size, struct pccard_io_handle *pcihp, int *windowp) { int reg; if (pccard_chip_io_map(pf->sc->pct, pf->sc->pch, width, offset, size, pcihp, windowp)) return (1); /* * XXX in the multifunction multi-iospace-per-function case, this * needs to cooperate with io_alloc to make sure that the spaces * don't overlap, and that the ccr's are set correctly */ if (pccard_mfc(pf->sc)) { long tmp, iosize; if (pf->pf_mfc_iomax == 0) { pf->pf_mfc_iobase = pcihp->addr + offset; pf->pf_mfc_iomax = pf->pf_mfc_iobase + size; } else { /* this makes the assumption that nothing overlaps */ if (pf->pf_mfc_iobase > pcihp->addr + offset) pf->pf_mfc_iobase = pcihp->addr + offset; if (pf->pf_mfc_iomax < pcihp->addr + offset + size) pf->pf_mfc_iomax = pcihp->addr + offset + size; } tmp = pf->pf_mfc_iomax - pf->pf_mfc_iobase; /* round up to nearest (2^n)-1 */ for (iosize = 1; iosize >= tmp; iosize <<= 1) ; iosize--; pccard_ccr_write(pf, PCCARD_CCR_IOBASE0, pf->pf_mfc_iobase & 0xff); pccard_ccr_write(pf, PCCARD_CCR_IOBASE1, (pf->pf_mfc_iobase >> 8) & 0xff); pccard_ccr_write(pf, PCCARD_CCR_IOBASE2, 0); pccard_ccr_write(pf, PCCARD_CCR_IOBASE3, 0); pccard_ccr_write(pf, PCCARD_CCR_IOSIZE, iosize); reg = pccard_ccr_read(pf, PCCARD_CCR_OPTION); reg |= PCCARD_CCR_OPTION_ADDR_DECODE; pccard_ccr_write(pf, PCCARD_CCR_OPTION, reg); } return (0); } void pccard_io_unmap(struct pccard_function *pf, int window) { pccard_chip_io_unmap(pf->sc->pct, pf->sc->pch, window); /* XXX Anything for multi-function cards? */ } #endif /* * simulate the old "probe" routine. In the new world order, the driver * needs to grab devices while in the old they were assigned to the device by * the pccardd process. These symbols are exported to the upper layers. */ static int pccard_compat_do_probe(device_t bus, device_t dev) { return (CARD_COMPAT_MATCH(dev)); } static int pccard_compat_do_attach(device_t bus, device_t dev) { int err; err = CARD_COMPAT_PROBE(dev); if (err == 0) err = CARD_COMPAT_ATTACH(dev); return (err); } #define PCCARD_NPORT 2 #define PCCARD_NMEM 5 #define PCCARD_NIRQ 1 #define PCCARD_NDRQ 0 static int pccard_add_children(device_t dev, int busno) { /* Call parent to scan for any current children */ return (0); } static int pccard_probe(device_t dev) { device_set_desc(dev, "16-bit PCCard bus"); return (pccard_add_children(dev, device_get_unit(dev))); } static int pccard_attach(device_t dev) { struct pccard_softc *sc = PCCARD_SOFTC(dev); sc->dev = dev; sc->sc_enabled_count = 0; return (bus_generic_attach(dev)); } static void pccard_print_resources(struct resource_list *rl, const char *name, int type, int count, const char *format) { struct resource_list_entry *rle; int printed; int i; printed = 0; for (i = 0; i < count; i++) { rle = resource_list_find(rl, type, i); if (rle) { if (printed == 0) printf(" %s ", name); else if (printed > 0) printf(","); printed++; printf(format, rle->start); if (rle->count > 1) { printf("-"); printf(format, rle->start + rle->count - 1); } } else if (i > 3) { /* check the first few regardless */ break; } } } static int pccard_print_child(device_t dev, device_t child) { struct pccard_ivar *devi = PCCARD_IVAR(child); struct resource_list *rl = &devi->resources; int retval = 0; retval += bus_print_child_header(dev, child); retval += printf(" at"); if (devi) { pccard_print_resources(rl, "port", SYS_RES_IOPORT, PCCARD_NPORT, "%#lx"); pccard_print_resources(rl, "iomem", SYS_RES_MEMORY, PCCARD_NMEM, "%#lx"); pccard_print_resources(rl, "irq", SYS_RES_IRQ, PCCARD_NIRQ, "%ld"); pccard_print_resources(rl, "drq", SYS_RES_DRQ, PCCARD_NDRQ, "%ld"); retval += printf(" function %d config %d", devi->fcn->number, devi->fcn->cfe->number); } retval += bus_print_child_footer(dev, child); return (retval); } static int pccard_set_resource(device_t dev, device_t child, int type, int rid, u_long start, u_long count) { struct pccard_ivar *devi = PCCARD_IVAR(child); struct resource_list *rl = &devi->resources; if (type != SYS_RES_IOPORT && type != SYS_RES_MEMORY && type != SYS_RES_IRQ && type != SYS_RES_DRQ) return (EINVAL); if (rid < 0) return (EINVAL); if (type == SYS_RES_IOPORT && rid >= PCCARD_NPORT) return (EINVAL); if (type == SYS_RES_MEMORY && rid >= PCCARD_NMEM) return (EINVAL); if (type == SYS_RES_IRQ && rid >= PCCARD_NIRQ) return (EINVAL); if (type == SYS_RES_DRQ && rid >= PCCARD_NDRQ) return (EINVAL); resource_list_add(rl, type, rid, start, start + count - 1, count); return (0); } static int pccard_get_resource(device_t dev, device_t child, int type, int rid, u_long *startp, u_long *countp) { struct pccard_ivar *devi = PCCARD_IVAR(child); struct resource_list *rl = &devi->resources; struct resource_list_entry *rle; rle = resource_list_find(rl, type, rid); if (!rle) return (ENOENT); if (startp) *startp = rle->start; if (countp) *countp = rle->count; return (0); } static void pccard_delete_resource(device_t dev, device_t child, int type, int rid) { struct pccard_ivar *devi = PCCARD_IVAR(child); struct resource_list *rl = &devi->resources; resource_list_delete(rl, type, rid); } static int pccard_set_res_flags(device_t dev, device_t child, int type, int rid, u_int32_t flags) { return (CARD_SET_RES_FLAGS(device_get_parent(dev), child, type, rid, flags)); } static int pccard_set_memory_offset(device_t dev, device_t child, int rid, u_int32_t offset, u_int32_t *deltap) { return (CARD_SET_MEMORY_OFFSET(device_get_parent(dev), child, rid, offset, deltap)); } static int pccard_read_ivar(device_t bus, device_t child, int which, u_char *result) { struct pccard_ivar *devi = PCCARD_IVAR(child); struct pccard_function *func = devi->fcn; struct pccard_softc *sc = PCCARD_SOFTC(bus); /* PCCARD_IVAR_ETHADDR unhandled from oldcard */ switch (which) { default: case PCCARD_IVAR_ETHADDR: return (ENOENT); break; case PCCARD_IVAR_VENDOR: *(u_int32_t *) result = sc->card.manufacturer; break; case PCCARD_IVAR_PRODUCT: *(u_int32_t *) result = sc->card.product; break; case PCCARD_IVAR_FUNCTION: *(u_int32_t *) result = func->function; break; case PCCARD_IVAR_FUNCTION_NUMBER: if (!func) { device_printf(bus, "No function number, bug!\n"); return (ENOENT); } *(u_int32_t *) result = func->number; break; case PCCARD_IVAR_VENDOR_STR: *(char **) result = sc->card.cis1_info[0]; break; case PCCARD_IVAR_PRODUCT_STR: *(char **) result = sc->card.cis1_info[1]; break; case PCCARD_IVAR_CIS3_STR: *(char **) result = sc->card.cis1_info[2]; break; case PCCARD_IVAR_CIS4_STR: *(char **) result = sc->card.cis1_info[2]; break; } return (0); } static void pccard_driver_added(device_t dev, driver_t *driver) { /* * XXX eventually we need to attach stuff when we know we * XXX have kids. For now we do nothing because we normally * XXX add children ourselves. We don't want to necessarily * XXX force a reprobe. */ } static struct resource * pccard_alloc_resource(device_t dev, device_t child, int type, int *rid, u_long start, u_long end, u_long count, u_int flags) { struct resource_list_entry *rle = NULL; /* XXX: This is an ugly way to fudge the resources. */ if (device_get_parent(child) == dev) { struct pccard_ivar *devi = PCCARD_IVAR(child); struct resource_list *rl = &devi->resources; rle = resource_list_find(rl, type, *rid); } if (rle != NULL) { if (flags & RF_ACTIVE) bus_activate_resource(dev, type, rle->rid, rle->res); return (rle->res); } return (bus_generic_alloc_resource(dev, child, type, rid, start, end, count, flags)); } static int pccard_release_resource(device_t dev, device_t child, int type, int rid, struct resource *r) { struct resource_list_entry *rle = NULL; if (device_get_parent(child) == dev) { struct pccard_ivar *devi = PCCARD_IVAR(child); struct resource_list *rl = &devi->resources; rle = resource_list_find(rl, type, rid); } if (rle != NULL) { return (bus_deactivate_resource(dev, type, rle->rid, rle->res)); } return (bus_generic_release_resource(dev, child, type, rid, r)); } static int pccard_activate_resource(device_t dev, device_t child, int type, int rid, struct resource *r) { /* XXX need to write to the COR to activate this for mf cards */ struct resource_list_entry *rle = NULL; if (device_get_parent(child) == dev) { struct pccard_ivar *devi = PCCARD_IVAR(child); struct resource_list *rl = &devi->resources; rle = resource_list_find(rl, type, rid); } if (rle != NULL) { return (bus_activate_resource(dev, type, rle->rid, rle->res)); } return (bus_generic_activate_resource(dev, child, type, rid, r)); } static int pccard_deactivate_resource(device_t dev, device_t child, int type, int rid, struct resource *r) { /* XXX need to write to the COR to deactivate this for mf cards */ struct resource_list_entry *rle = NULL; if (device_get_parent(child) == dev) { struct pccard_ivar *devi = PCCARD_IVAR(child); struct resource_list *rl = &devi->resources; rle = resource_list_find(rl, type, rid); } if (rle != NULL) { return (bus_deactivate_resource(dev, type, rle->rid, rle->res)); } return (bus_generic_deactivate_resource(dev, child, type, rid, r)); } static void pccard_child_detached(device_t parent, device_t dev) { struct pccard_ivar *ivar = PCCARD_IVAR(dev); if (parent == device_get_parent(dev)) free(ivar, M_DEVBUF); } static void pccard_intr(void *arg) { struct pccard_softc *sc = (struct pccard_softc *) arg; struct pccard_function *pf; STAILQ_FOREACH(pf, &sc->card.pf_head, pf_list) { if (pf->intr_handler != NULL) { int reg = pccard_ccr_read(pf, PCCARD_CCR_STATUS); if (reg & PCCARD_CCR_STATUS_INTR) { pccard_ccr_write(pf, PCCARD_CCR_STATUS, reg & ~PCCARD_CCR_STATUS_INTR); pf->intr_handler(pf->intr_handler_arg); } } } } static int pccard_setup_intr(device_t dev, device_t child, struct resource *irq, int flags, driver_intr_t *intr, void *arg, void **cookiep) { struct pccard_ivar *ivar = PCCARD_IVAR(child); struct pccard_function *func = ivar->fcn; struct resource_list_entry *rle = NULL; struct pccard_softc *sc = device_get_softc(dev); if (func->intr_handler != NULL) panic("Only one interrupt handler per function allowed\n"); rle = resource_list_find(&ivar->resources, SYS_RES_IRQ, 0); if (rle == NULL || rle->res != irq) panic("irq in setup_intr does not match allocated irq\n"); func->intr_handler = intr; func->intr_handler_arg = arg; func->intr_handler_cookie = *cookiep = func; pccard_ccr_write(func, PCCARD_CCR_OPTION, pccard_ccr_read(func, PCCARD_CCR_OPTION) | PCCARD_CCR_OPTION_IREQ_ENABLE); if (sc->intr_handler_count++ == 0) { rle = resource_list_find(&ivar->resources, SYS_RES_IRQ, 0); if (rle == NULL) panic("No IRQ for pccard?"); bus_setup_intr(dev, rle->res, INTR_TYPE_TTY/* | INTR_FAST*/, pccard_intr, sc, (void*)&sc->intr_handler_count); } return (0); } static int pccard_teardown_intr(device_t dev, device_t child, struct resource *r, void *cookie) { struct pccard_ivar *ivar = PCCARD_IVAR(child); struct pccard_function *func = ivar->fcn; struct pccard_softc *sc = device_get_softc(dev); if (func->intr_handler_cookie != cookie) panic("pccard teardown of unknown interrupt handler\n"); func->intr_handler = NULL; func->intr_handler_arg = NULL; func->intr_handler_cookie = NULL; pccard_ccr_write(func, PCCARD_CCR_OPTION, pccard_ccr_read(func, PCCARD_CCR_OPTION) & ~PCCARD_CCR_OPTION_IREQ_ENABLE); if (--sc->intr_handler_count == 0) { struct resource_list_entry *rle = NULL; rle = resource_list_find(&ivar->resources, SYS_RES_IRQ, 0); if (rle == NULL) panic("No IRQ for pccard?"); bus_teardown_intr(dev, rle->res, &sc->intr_handler_count); } return (0); } static device_method_t pccard_methods[] = { /* Device interface */ DEVMETHOD(device_probe, pccard_probe), DEVMETHOD(device_attach, pccard_attach), DEVMETHOD(device_detach, bus_generic_detach), DEVMETHOD(device_shutdown, bus_generic_shutdown), DEVMETHOD(device_suspend, bus_generic_suspend), DEVMETHOD(device_resume, bus_generic_resume), /* Bus interface */ DEVMETHOD(bus_print_child, pccard_print_child), DEVMETHOD(bus_driver_added, pccard_driver_added), DEVMETHOD(bus_child_detached, pccard_child_detached), DEVMETHOD(bus_alloc_resource, pccard_alloc_resource), DEVMETHOD(bus_release_resource, pccard_release_resource), DEVMETHOD(bus_activate_resource, pccard_activate_resource), DEVMETHOD(bus_deactivate_resource, pccard_deactivate_resource), DEVMETHOD(bus_setup_intr, pccard_setup_intr), DEVMETHOD(bus_teardown_intr, pccard_teardown_intr), DEVMETHOD(bus_set_resource, pccard_set_resource), DEVMETHOD(bus_get_resource, pccard_get_resource), DEVMETHOD(bus_delete_resource, pccard_delete_resource), DEVMETHOD(bus_read_ivar, pccard_read_ivar), /* Card Interface */ DEVMETHOD(card_set_res_flags, pccard_set_res_flags), DEVMETHOD(card_set_memory_offset, pccard_set_memory_offset), DEVMETHOD(card_get_type, pccard_card_gettype), DEVMETHOD(card_attach_card, pccard_attach_card), DEVMETHOD(card_detach_card, pccard_detach_card), DEVMETHOD(card_compat_do_probe, pccard_compat_do_probe), DEVMETHOD(card_compat_do_attach, pccard_compat_do_attach), { 0, 0 } }; static driver_t pccard_driver = { "pccard", pccard_methods, sizeof(struct pccard_softc) }; devclass_t pccard_devclass; DRIVER_MODULE(pccard, pcic, pccard_driver, pccard_devclass, 0, 0); DRIVER_MODULE(pccard, pc98pcic, pccard_driver, pccard_devclass, 0, 0); DRIVER_MODULE(pccard, pccbb, pccard_driver, pccard_devclass, 0, 0); DRIVER_MODULE(pccard, tcic, pccard_driver, pccard_devclass, 0, 0); MODULE_VERSION(pccard, 1); /*MODULE_DEPEND(pccard, pcic, 1, 1, 1);*/