Home | History | Annotate | Line # | Download | only in pcmcia
pcmcia.c revision 1.82.22.4
      1  1.82.22.4  jmcneill /*	$NetBSD: pcmcia.c,v 1.82.22.4 2007/12/08 16:21:34 jmcneill Exp $	*/
      2       1.42   mycroft 
      3       1.42   mycroft /*
      4       1.42   mycroft  * Copyright (c) 2004 Charles M. Hannum.  All rights reserved.
      5       1.42   mycroft  *
      6       1.42   mycroft  * Redistribution and use in source and binary forms, with or without
      7       1.42   mycroft  * modification, are permitted provided that the following conditions
      8       1.42   mycroft  * are met:
      9       1.42   mycroft  * 1. Redistributions of source code must retain the above copyright
     10       1.42   mycroft  *    notice, this list of conditions and the following disclaimer.
     11       1.42   mycroft  * 2. Redistributions in binary form must reproduce the above copyright
     12       1.42   mycroft  *    notice, this list of conditions and the following disclaimer in the
     13       1.42   mycroft  *    documentation and/or other materials provided with the distribution.
     14       1.42   mycroft  * 3. All advertising materials mentioning features or use of this software
     15       1.42   mycroft  *    must display the following acknowledgement:
     16       1.42   mycroft  *      This product includes software developed by Charles M. Hannum.
     17       1.42   mycroft  * 4. The name of the author may not be used to endorse or promote products
     18       1.42   mycroft  *    derived from this software without specific prior written permission.
     19       1.42   mycroft  */
     20        1.2   thorpej 
     21        1.2   thorpej /*
     22        1.2   thorpej  * Copyright (c) 1997 Marc Horowitz.  All rights reserved.
     23        1.2   thorpej  *
     24        1.2   thorpej  * Redistribution and use in source and binary forms, with or without
     25        1.2   thorpej  * modification, are permitted provided that the following conditions
     26        1.2   thorpej  * are met:
     27        1.2   thorpej  * 1. Redistributions of source code must retain the above copyright
     28        1.2   thorpej  *    notice, this list of conditions and the following disclaimer.
     29        1.2   thorpej  * 2. Redistributions in binary form must reproduce the above copyright
     30        1.2   thorpej  *    notice, this list of conditions and the following disclaimer in the
     31        1.2   thorpej  *    documentation and/or other materials provided with the distribution.
     32        1.2   thorpej  * 3. All advertising materials mentioning features or use of this software
     33        1.2   thorpej  *    must display the following acknowledgement:
     34        1.2   thorpej  *	This product includes software developed by Marc Horowitz.
     35        1.2   thorpej  * 4. The name of the author may not be used to endorse or promote products
     36        1.2   thorpej  *    derived from this software without specific prior written permission.
     37        1.2   thorpej  *
     38        1.2   thorpej  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     39        1.2   thorpej  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     40        1.2   thorpej  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     41        1.2   thorpej  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     42        1.2   thorpej  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     43        1.2   thorpej  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     44        1.2   thorpej  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     45        1.2   thorpej  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     46        1.2   thorpej  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     47        1.2   thorpej  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     48        1.2   thorpej  */
     49       1.26     lukem 
     50       1.26     lukem #include <sys/cdefs.h>
     51  1.82.22.4  jmcneill __KERNEL_RCSID(0, "$NetBSD: pcmcia.c,v 1.82.22.4 2007/12/08 16:21:34 jmcneill Exp $");
     52        1.2   thorpej 
     53        1.2   thorpej #include "opt_pcmciaverbose.h"
     54        1.2   thorpej 
     55        1.2   thorpej #include <sys/param.h>
     56        1.2   thorpej #include <sys/systm.h>
     57        1.2   thorpej #include <sys/device.h>
     58        1.2   thorpej 
     59  1.82.22.1     joerg #include <net/if.h>
     60  1.82.22.1     joerg 
     61        1.2   thorpej #include <dev/pcmcia/pcmciareg.h>
     62        1.2   thorpej #include <dev/pcmcia/pcmciachip.h>
     63        1.2   thorpej #include <dev/pcmcia/pcmciavar.h>
     64       1.21       uch #ifdef IT8368E_LEGACY_MODE /* XXX -uch */
     65       1.21       uch #include <arch/hpcmips/dev/it8368var.h>
     66       1.21       uch #endif
     67        1.2   thorpej 
     68        1.3     enami #include "locators.h"
     69        1.3     enami 
     70        1.2   thorpej #ifdef PCMCIADEBUG
     71        1.2   thorpej int	pcmcia_debug = 0;
     72        1.2   thorpej #define	DPRINTF(arg) if (pcmcia_debug) printf arg
     73        1.2   thorpej #else
     74        1.2   thorpej #define	DPRINTF(arg)
     75        1.2   thorpej #endif
     76        1.2   thorpej 
     77        1.2   thorpej #ifdef PCMCIAVERBOSE
     78        1.2   thorpej int	pcmcia_verbose = 1;
     79        1.2   thorpej #else
     80        1.2   thorpej int	pcmcia_verbose = 0;
     81        1.2   thorpej #endif
     82        1.2   thorpej 
     83       1.72     perry int	pcmcia_match(struct device *, struct cfdata *, void *);
     84       1.72     perry void	pcmcia_attach(struct device *, struct device *, void *);
     85       1.71  drochner int	pcmcia_rescan(struct device *, const char *, const int *);
     86       1.71  drochner void	pcmcia_childdetached(struct device *, struct device *);
     87       1.72     perry int	pcmcia_print(void *, const char *);
     88        1.2   thorpej 
     89       1.71  drochner CFATTACH_DECL2(pcmcia, sizeof(struct pcmcia_softc),
     90       1.71  drochner     pcmcia_match, pcmcia_attach, NULL, NULL,
     91       1.71  drochner     pcmcia_rescan, pcmcia_childdetached);
     92        1.2   thorpej 
     93        1.2   thorpej int
     94        1.2   thorpej pcmcia_ccr_read(pf, ccr)
     95        1.2   thorpej 	struct pcmcia_function *pf;
     96        1.2   thorpej 	int ccr;
     97        1.2   thorpej {
     98        1.2   thorpej 
     99        1.2   thorpej 	return (bus_space_read_1(pf->pf_ccrt, pf->pf_ccrh,
    100       1.43   mycroft 	    pf->pf_ccr_offset + ccr * 2));
    101        1.2   thorpej }
    102        1.2   thorpej 
    103        1.2   thorpej void
    104        1.2   thorpej pcmcia_ccr_write(pf, ccr, val)
    105        1.2   thorpej 	struct pcmcia_function *pf;
    106        1.2   thorpej 	int ccr;
    107        1.2   thorpej 	int val;
    108        1.2   thorpej {
    109        1.2   thorpej 
    110       1.43   mycroft 	if (pf->ccr_mask & (1 << ccr)) {
    111        1.2   thorpej 		bus_space_write_1(pf->pf_ccrt, pf->pf_ccrh,
    112       1.43   mycroft 		    pf->pf_ccr_offset + ccr * 2, val);
    113        1.2   thorpej 	}
    114        1.2   thorpej }
    115        1.2   thorpej 
    116        1.2   thorpej int
    117       1.82  christos pcmcia_match(struct device *parent, struct cfdata *match, void *aux)
    118        1.2   thorpej {
    119       1.14      haya 	struct pcmciabus_attach_args *paa = aux;
    120       1.14      haya 
    121       1.30   thorpej 	if (strcmp(paa->paa_busname, match->cf_name)) {
    122       1.14      haya 	    return 0;
    123       1.14      haya 	}
    124        1.2   thorpej 	/* if the autoconfiguration got this far, there's a socket here */
    125        1.2   thorpej 	return (1);
    126        1.2   thorpej }
    127        1.2   thorpej 
    128        1.2   thorpej void
    129       1.82  christos pcmcia_attach(struct device *parent, struct device *self, void *aux)
    130        1.2   thorpej {
    131        1.2   thorpej 	struct pcmciabus_attach_args *paa = aux;
    132        1.2   thorpej 	struct pcmcia_softc *sc = (struct pcmcia_softc *) self;
    133        1.2   thorpej 
    134  1.82.22.3  jmcneill 	aprint_naive("\n");
    135  1.82.22.3  jmcneill 	aprint_normal("\n");
    136        1.2   thorpej 
    137        1.2   thorpej 	sc->pct = paa->pct;
    138        1.2   thorpej 	sc->pch = paa->pch;
    139        1.2   thorpej 	sc->iobase = paa->iobase;
    140        1.2   thorpej 	sc->iosize = paa->iosize;
    141        1.2   thorpej 
    142        1.2   thorpej 	sc->ih = NULL;
    143  1.82.22.2     joerg 
    144  1.82.22.4  jmcneill 	if (!pmf_device_register(self, NULL, NULL))
    145  1.82.22.2     joerg 		aprint_error_dev(self, "couldn't establish power handler\n");
    146        1.2   thorpej }
    147        1.2   thorpej 
    148        1.2   thorpej int
    149        1.2   thorpej pcmcia_card_attach(dev)
    150        1.2   thorpej 	struct device *dev;
    151        1.2   thorpej {
    152        1.2   thorpej 	struct pcmcia_softc *sc = (struct pcmcia_softc *) dev;
    153        1.2   thorpej 	struct pcmcia_function *pf;
    154       1.71  drochner 	int error;
    155       1.77  drochner 	static const int wildcard[PCMCIACF_NLOCS] = {
    156       1.81  drochner 		PCMCIACF_FUNCTION_DEFAULT
    157       1.71  drochner 	};
    158        1.2   thorpej 
    159        1.2   thorpej 	/*
    160        1.2   thorpej 	 * this is here so that when socket_enable calls gettype, trt happens
    161        1.2   thorpej 	 */
    162       1.29     lukem 	SIMPLEQ_FIRST(&sc->card.pf_head) = NULL;
    163        1.2   thorpej 
    164       1.59   mycroft 	pcmcia_socket_enable(dev);
    165        1.2   thorpej 
    166        1.2   thorpej 	pcmcia_read_cis(sc);
    167       1.59   mycroft 	pcmcia_check_cis_quirks(sc);
    168        1.2   thorpej 
    169       1.71  drochner #if 1 /* XXX remove this, done below ??? */
    170        1.2   thorpej 	/*
    171        1.2   thorpej 	 * bail now if the card has no functions, or if there was an error in
    172        1.2   thorpej 	 * the cis.
    173        1.2   thorpej 	 */
    174       1.64   mycroft 	if (sc->card.error ||
    175       1.64   mycroft 	    SIMPLEQ_EMPTY(&sc->card.pf_head)) {
    176       1.64   mycroft 		printf("%s: card appears to have bogus CIS\n",
    177       1.64   mycroft 		    sc->dev.dv_xname);
    178       1.71  drochner 		error = EIO;
    179       1.59   mycroft 		goto done;
    180       1.64   mycroft 	}
    181       1.71  drochner #endif
    182        1.2   thorpej 
    183        1.2   thorpej 	if (pcmcia_verbose)
    184        1.2   thorpej 		pcmcia_print_cis(sc);
    185        1.2   thorpej 
    186       1.29     lukem 	SIMPLEQ_FOREACH(pf, &sc->card.pf_head, pf_list) {
    187       1.29     lukem 		if (SIMPLEQ_EMPTY(&pf->cfe_head))
    188        1.2   thorpej 			continue;
    189        1.2   thorpej 
    190       1.11   thorpej #ifdef DIAGNOSTIC
    191       1.11   thorpej 		if (pf->child != NULL) {
    192       1.11   thorpej 			printf("%s: %s still attached to function %d!\n",
    193       1.11   thorpej 			    sc->dev.dv_xname, pf->child->dv_xname,
    194       1.11   thorpej 			    pf->number);
    195       1.11   thorpej 			panic("pcmcia_card_attach");
    196       1.11   thorpej 		}
    197       1.11   thorpej #endif
    198        1.2   thorpej 		pf->sc = sc;
    199       1.11   thorpej 		pf->child = NULL;
    200        1.2   thorpej 		pf->cfe = NULL;
    201       1.52   mycroft 		pf->pf_ih = NULL;
    202        1.2   thorpej 	}
    203        1.2   thorpej 
    204       1.71  drochner 	error = pcmcia_rescan(dev, "pcmcia", wildcard);
    205       1.71  drochner done:
    206       1.71  drochner 	pcmcia_socket_disable(dev);
    207       1.71  drochner 	return (error);
    208       1.71  drochner }
    209       1.71  drochner 
    210       1.71  drochner int
    211       1.82  christos pcmcia_rescan(struct device *self, const char *ifattr,
    212       1.80  christos     const int *locators)
    213       1.71  drochner {
    214       1.71  drochner 	struct pcmcia_softc *sc = (struct pcmcia_softc *)self;
    215       1.71  drochner 	struct pcmcia_function *pf;
    216       1.71  drochner 	struct pcmcia_attach_args paa;
    217       1.75  drochner 	int locs[PCMCIACF_NLOCS];
    218       1.71  drochner 
    219       1.71  drochner 	if (sc->card.error ||
    220       1.71  drochner 	    SIMPLEQ_EMPTY(&sc->card.pf_head)) {
    221       1.71  drochner 		/* XXX silently ignore if no card present? */
    222       1.71  drochner 		return (EIO);
    223       1.71  drochner 	}
    224       1.71  drochner 
    225       1.29     lukem 	SIMPLEQ_FOREACH(pf, &sc->card.pf_head, pf_list) {
    226       1.29     lukem 		if (SIMPLEQ_EMPTY(&pf->cfe_head))
    227        1.2   thorpej 			continue;
    228        1.2   thorpej 
    229       1.71  drochner 		if ((locators[PCMCIACF_FUNCTION] != PCMCIACF_FUNCTION_DEFAULT)
    230       1.71  drochner 		    && (locators[PCMCIACF_FUNCTION] != pf->number))
    231       1.71  drochner 			continue;
    232       1.71  drochner 
    233       1.71  drochner 		if (pf->child)
    234       1.71  drochner 			continue;
    235       1.71  drochner 
    236       1.75  drochner 		locs[PCMCIACF_FUNCTION] = pf->number;
    237       1.71  drochner 
    238        1.2   thorpej 		paa.manufacturer = sc->card.manufacturer;
    239        1.2   thorpej 		paa.product = sc->card.product;
    240        1.2   thorpej 		paa.card = &sc->card;
    241        1.2   thorpej 		paa.pf = pf;
    242        1.2   thorpej 
    243       1.75  drochner 		pf->child = config_found_sm_loc(self, "pcmcia", locs, &paa,
    244       1.76  drochner 						pcmcia_print,
    245       1.76  drochner 						config_stdsubmatch);
    246        1.2   thorpej 	}
    247        1.2   thorpej 
    248       1.71  drochner 	return (0);
    249        1.2   thorpej }
    250        1.2   thorpej 
    251        1.2   thorpej void
    252       1.11   thorpej pcmcia_card_detach(dev, flags)
    253        1.2   thorpej 	struct device *dev;
    254       1.11   thorpej 	int flags;		/* DETACH_* flags */
    255        1.2   thorpej {
    256       1.10   thorpej 	struct pcmcia_softc *sc = (struct pcmcia_softc *) dev;
    257       1.11   thorpej 	struct pcmcia_function *pf;
    258       1.11   thorpej 	int error;
    259       1.10   thorpej 
    260       1.11   thorpej 	/*
    261       1.11   thorpej 	 * We are running on either the PCMCIA socket's event thread
    262       1.11   thorpej 	 * or in user context detaching a device by user request.
    263       1.10   thorpej 	 */
    264       1.29     lukem 	SIMPLEQ_FOREACH(pf, &sc->card.pf_head, pf_list) {
    265       1.69   mycroft 		pf->pf_flags |= PFF_DETACHED;
    266       1.29     lukem 		if (SIMPLEQ_EMPTY(&pf->cfe_head))
    267       1.11   thorpej 			continue;
    268       1.11   thorpej 		if (pf->child == NULL)
    269       1.11   thorpej 			continue;
    270       1.11   thorpej 		DPRINTF(("%s: detaching %s (function %d)\n",
    271       1.11   thorpej 		    sc->dev.dv_xname, pf->child->dv_xname, pf->number));
    272       1.11   thorpej 		if ((error = config_detach(pf->child, flags)) != 0) {
    273       1.11   thorpej 			printf("%s: error %d detaching %s (function %d)\n",
    274       1.11   thorpej 			    sc->dev.dv_xname, error, pf->child->dv_xname,
    275       1.11   thorpej 			    pf->number);
    276       1.71  drochner 		}
    277       1.11   thorpej 	}
    278       1.53   mycroft 
    279       1.53   mycroft 	if (sc->sc_enabled_count != 0) {
    280       1.53   mycroft #ifdef DIAGNOSTIC
    281       1.53   mycroft 		printf("pcmcia_card_detach: enabled_count should be 0 here??\n");
    282       1.53   mycroft #endif
    283       1.53   mycroft 		pcmcia_chip_socket_disable(sc->pct, sc->pch);
    284       1.53   mycroft 		sc->sc_enabled_count = 0;
    285       1.53   mycroft 	}
    286       1.11   thorpej }
    287       1.11   thorpej 
    288       1.11   thorpej void
    289       1.71  drochner pcmcia_childdetached(struct device *self, struct device *child)
    290       1.71  drochner {
    291       1.71  drochner 	struct pcmcia_softc *sc = (struct pcmcia_softc *)self;
    292       1.71  drochner 	struct pcmcia_function *pf;
    293       1.71  drochner 
    294       1.71  drochner 	SIMPLEQ_FOREACH(pf, &sc->card.pf_head, pf_list) {
    295       1.71  drochner 		if (SIMPLEQ_EMPTY(&pf->cfe_head))
    296       1.71  drochner 			continue;
    297       1.71  drochner 		if (pf->child == child) {
    298       1.79   thorpej 			KASSERT(device_locator(child, PCMCIACF_FUNCTION)
    299       1.71  drochner 				== pf->number);
    300       1.71  drochner 			pf->child = NULL;
    301       1.71  drochner 			return;
    302       1.71  drochner 		}
    303       1.71  drochner 	}
    304       1.71  drochner 
    305       1.71  drochner 	printf("%s: pcmcia_childdetached: %s not found\n",
    306       1.71  drochner 	       self->dv_xname, child->dv_xname);
    307       1.71  drochner }
    308       1.71  drochner 
    309       1.71  drochner void
    310       1.11   thorpej pcmcia_card_deactivate(dev)
    311       1.11   thorpej 	struct device *dev;
    312       1.11   thorpej {
    313       1.11   thorpej 	struct pcmcia_softc *sc = (struct pcmcia_softc *) dev;
    314       1.11   thorpej 	struct pcmcia_function *pf;
    315       1.10   thorpej 
    316       1.11   thorpej 	/*
    317       1.11   thorpej 	 * We're in the chip's card removal interrupt handler.
    318       1.11   thorpej 	 * Deactivate the child driver.  The PCMCIA socket's
    319       1.11   thorpej 	 * event thread will run later to finish the detach.
    320       1.11   thorpej 	 */
    321       1.29     lukem 	SIMPLEQ_FOREACH(pf, &sc->card.pf_head, pf_list) {
    322       1.29     lukem 		if (SIMPLEQ_EMPTY(&pf->cfe_head))
    323       1.11   thorpej 			continue;
    324       1.11   thorpej 		if (pf->child == NULL)
    325       1.11   thorpej 			continue;
    326       1.11   thorpej 		DPRINTF(("%s: deactivating %s (function %d)\n",
    327       1.11   thorpej 		    sc->dev.dv_xname, pf->child->dv_xname, pf->number));
    328       1.11   thorpej 		config_deactivate(pf->child);
    329       1.11   thorpej 	}
    330        1.2   thorpej }
    331        1.2   thorpej 
    332        1.2   thorpej int
    333        1.2   thorpej pcmcia_print(arg, pnp)
    334        1.2   thorpej 	void *arg;
    335        1.2   thorpej 	const char *pnp;
    336        1.2   thorpej {
    337        1.2   thorpej 	struct pcmcia_attach_args *pa = arg;
    338        1.2   thorpej 	struct pcmcia_softc *sc = pa->pf->sc;
    339        1.2   thorpej 	struct pcmcia_card *card = &sc->card;
    340       1.18  augustss 	char devinfo[256];
    341        1.2   thorpej 
    342       1.38   mycroft 	if (pnp)
    343       1.38   mycroft 		aprint_normal("%s", pnp);
    344       1.38   mycroft 
    345       1.38   mycroft 	pcmcia_devinfo(card, !!pnp, devinfo, sizeof(devinfo));
    346       1.38   mycroft 
    347       1.57   mycroft 	aprint_normal(" function %d: %s\n", pa->pf->number, devinfo);
    348        1.2   thorpej 
    349        1.2   thorpej 	return (UNCONF);
    350       1.18  augustss }
    351       1.18  augustss 
    352       1.18  augustss void
    353       1.18  augustss pcmcia_devinfo(card, showhex, cp, cplen)
    354       1.18  augustss 	struct pcmcia_card *card;
    355       1.19     enami 	int showhex;
    356       1.18  augustss 	char *cp;
    357       1.38   mycroft 	size_t cplen;
    358       1.18  augustss {
    359       1.18  augustss 	int i, n;
    360       1.18  augustss 
    361       1.37   mycroft 	if (cplen > 1) {
    362       1.37   mycroft 		*cp++ = '<';
    363       1.38   mycroft 		*cp = '\0';
    364       1.37   mycroft 		cplen--;
    365       1.37   mycroft 	}
    366       1.37   mycroft 
    367       1.37   mycroft 	for (i = 0; i < 4 && card->cis1_info[i] != NULL && cplen > 1; i++) {
    368       1.39   mycroft 		n = snprintf(cp, cplen, "%s%s", i ? ", " : "",
    369       1.18  augustss 		        card->cis1_info[i]);
    370       1.18  augustss 		cp += n;
    371       1.38   mycroft 		if (cplen < n)
    372       1.38   mycroft 			return;
    373       1.18  augustss 		cplen -= n;
    374       1.18  augustss 	}
    375       1.37   mycroft 
    376       1.37   mycroft 	if (cplen > 1) {
    377       1.37   mycroft 		*cp++ = '>';
    378       1.38   mycroft 		*cp = '\0';
    379       1.37   mycroft 		cplen--;
    380       1.37   mycroft 	}
    381       1.37   mycroft 
    382       1.37   mycroft 	if (showhex && cplen > 1)
    383       1.37   mycroft 		snprintf(cp, cplen, " (manufacturer 0x%04x, product 0x%04x)",
    384       1.37   mycroft 		    card->manufacturer, card->product);
    385       1.16       cgd }
    386       1.16       cgd 
    387       1.56   mycroft const void *
    388       1.56   mycroft pcmcia_product_lookup(pa, tab, nent, ent_size, matchfn)
    389       1.16       cgd 	struct pcmcia_attach_args *pa;
    390       1.56   mycroft 	const void *tab;
    391       1.56   mycroft 	size_t nent;
    392       1.16       cgd 	size_t ent_size;
    393       1.16       cgd 	pcmcia_product_match_fn matchfn;
    394       1.16       cgd {
    395       1.56   mycroft         const struct pcmcia_product *pp;
    396       1.56   mycroft 	int n;
    397       1.16       cgd 	int matches;
    398       1.16       cgd 
    399       1.16       cgd #ifdef DIAGNOSTIC
    400       1.56   mycroft 	if (sizeof *pp > ent_size)
    401       1.73     perry 		panic("pcmcia_product_lookup: bogus ent_size %ld",
    402       1.17   nathanw 		      (long) ent_size);
    403       1.16       cgd #endif
    404       1.16       cgd 
    405       1.56   mycroft         for (pp = tab, n = nent; n; pp = (const struct pcmcia_product *)
    406       1.56   mycroft 	      ((const char *)pp + ent_size), n--) {
    407       1.56   mycroft 		/* see if it matches vendor/product */
    408       1.58   mycroft 		matches = 0;
    409       1.56   mycroft 		if ((pp->pp_vendor != PCMCIA_VENDOR_INVALID &&
    410       1.56   mycroft 		     pp->pp_vendor == pa->manufacturer) &&
    411       1.56   mycroft 		    (pp->pp_product != PCMCIA_PRODUCT_INVALID &&
    412       1.56   mycroft 		     pp->pp_product == pa->product))
    413       1.56   mycroft 			matches = 1;
    414       1.58   mycroft 		if ((pp->pp_cisinfo[0] && pa->card->cis1_info[0] &&
    415       1.56   mycroft 		          !strcmp(pp->pp_cisinfo[0], pa->card->cis1_info[0])) &&
    416       1.56   mycroft 		         (pp->pp_cisinfo[1] && pa->card->cis1_info[1] &&
    417       1.56   mycroft 		          !strcmp(pp->pp_cisinfo[1], pa->card->cis1_info[1])) &&
    418       1.56   mycroft 		         (!pp->pp_cisinfo[2] || (pa->card->cis1_info[2] &&
    419       1.56   mycroft 		           !strcmp(pp->pp_cisinfo[2], pa->card->cis1_info[2]))) &&
    420       1.56   mycroft 		         (!pp->pp_cisinfo[3] || (pa->card->cis1_info[3] &&
    421       1.56   mycroft 		           !strcmp(pp->pp_cisinfo[3], pa->card->cis1_info[3]))))
    422       1.56   mycroft 			matches = 1;
    423       1.16       cgd 
    424       1.16       cgd 		/* if a separate match function is given, let it override */
    425       1.56   mycroft 		if (matchfn)
    426       1.56   mycroft 			matches = (*matchfn)(pa, pp, matches);
    427       1.16       cgd 
    428       1.16       cgd 		if (matches)
    429       1.56   mycroft                         return (pp);
    430       1.16       cgd         }
    431       1.56   mycroft         return (0);
    432        1.2   thorpej }
    433        1.2   thorpej 
    434       1.60   mycroft void
    435       1.70   mycroft pcmcia_socket_settype(dev, type)
    436       1.70   mycroft 	struct device *dev;
    437       1.70   mycroft 	int type;
    438        1.2   thorpej {
    439       1.60   mycroft 	struct pcmcia_softc *sc = (void *)dev;
    440        1.2   thorpej 
    441       1.60   mycroft 	pcmcia_chip_socket_settype(sc->pct, sc->pch, type);
    442        1.2   thorpej }
    443        1.2   thorpej 
    444        1.2   thorpej /*
    445        1.2   thorpej  * Initialize a PCMCIA function.  May be called as long as the function is
    446        1.2   thorpej  * disabled.
    447        1.2   thorpej  */
    448        1.2   thorpej void
    449        1.2   thorpej pcmcia_function_init(pf, cfe)
    450        1.2   thorpej 	struct pcmcia_function *pf;
    451        1.2   thorpej 	struct pcmcia_config_entry *cfe;
    452        1.2   thorpej {
    453        1.2   thorpej 	if (pf->pf_flags & PFF_ENABLED)
    454        1.2   thorpej 		panic("pcmcia_function_init: function is enabled");
    455        1.2   thorpej 
    456        1.2   thorpej 	/* Remember which configuration entry we are using. */
    457        1.2   thorpej 	pf->cfe = cfe;
    458        1.2   thorpej }
    459        1.2   thorpej 
    460       1.59   mycroft void
    461       1.59   mycroft pcmcia_socket_enable(dev)
    462       1.40   mycroft 	struct device *dev;
    463        1.5      marc {
    464       1.40   mycroft 	struct pcmcia_softc *sc = (void *)dev;
    465       1.40   mycroft 
    466       1.59   mycroft 	if (sc->sc_enabled_count++ == 0)
    467       1.59   mycroft 		pcmcia_chip_socket_enable(sc->pct, sc->pch);
    468       1.59   mycroft 	DPRINTF(("%s: ++enabled_count = %d\n", sc->dev.dv_xname,
    469       1.59   mycroft 		 sc->sc_enabled_count));
    470        1.5      marc }
    471        1.5      marc 
    472       1.59   mycroft void
    473       1.59   mycroft pcmcia_socket_disable(dev)
    474       1.40   mycroft 	struct device *dev;
    475        1.5      marc {
    476       1.40   mycroft 	struct pcmcia_softc *sc = (void *)dev;
    477       1.40   mycroft 
    478       1.59   mycroft 	if (--sc->sc_enabled_count == 0)
    479       1.59   mycroft 		pcmcia_chip_socket_disable(sc->pct, sc->pch);
    480       1.59   mycroft 	DPRINTF(("%s: --enabled_count = %d\n", sc->dev.dv_xname,
    481       1.59   mycroft 		 sc->sc_enabled_count));
    482        1.5      marc }
    483        1.5      marc 
    484        1.2   thorpej /* Enable a PCMCIA function */
    485        1.2   thorpej int
    486        1.2   thorpej pcmcia_function_enable(pf)
    487        1.2   thorpej 	struct pcmcia_function *pf;
    488        1.2   thorpej {
    489       1.53   mycroft 	struct pcmcia_softc *sc = pf->sc;
    490        1.2   thorpej 	struct pcmcia_function *tmp;
    491        1.2   thorpej 	int reg;
    492       1.55   mycroft 	int error;
    493        1.2   thorpej 
    494        1.2   thorpej 	if (pf->cfe == NULL)
    495        1.2   thorpej 		panic("pcmcia_function_enable: function not initialized");
    496        1.2   thorpej 
    497        1.5      marc 	/*
    498        1.5      marc 	 * Increase the reference count on the socket, enabling power, if
    499        1.5      marc 	 * necessary.
    500        1.5      marc 	 */
    501       1.59   mycroft 	pcmcia_socket_enable(&sc->dev);
    502       1.74  christos 	pcmcia_socket_settype(&sc->dev, pf->cfe->iftype);
    503        1.5      marc 
    504        1.2   thorpej 	if (pf->pf_flags & PFF_ENABLED) {
    505        1.2   thorpej 		/*
    506        1.2   thorpej 		 * Don't do anything if we're already enabled.
    507        1.2   thorpej 		 */
    508        1.2   thorpej 		return (0);
    509        1.2   thorpej 	}
    510        1.2   thorpej 
    511        1.2   thorpej 	/*
    512        1.2   thorpej 	 * it's possible for different functions' CCRs to be in the same
    513        1.2   thorpej 	 * underlying page.  Check for that.
    514        1.2   thorpej 	 */
    515        1.2   thorpej 
    516       1.53   mycroft 	SIMPLEQ_FOREACH(tmp, &sc->card.pf_head, pf_list) {
    517        1.2   thorpej 		if ((tmp->pf_flags & PFF_ENABLED) &&
    518        1.2   thorpej 		    (pf->ccr_base >= (tmp->ccr_base - tmp->pf_ccr_offset)) &&
    519        1.2   thorpej 		    ((pf->ccr_base + PCMCIA_CCR_SIZE) <=
    520        1.2   thorpej 		     (tmp->ccr_base - tmp->pf_ccr_offset +
    521        1.2   thorpej 		      tmp->pf_ccr_realsize))) {
    522        1.2   thorpej 			pf->pf_ccrt = tmp->pf_ccrt;
    523        1.2   thorpej 			pf->pf_ccrh = tmp->pf_ccrh;
    524        1.2   thorpej 			pf->pf_ccr_realsize = tmp->pf_ccr_realsize;
    525        1.2   thorpej 
    526        1.2   thorpej 			/*
    527        1.2   thorpej 			 * pf->pf_ccr_offset = (tmp->pf_ccr_offset -
    528        1.2   thorpej 			 * tmp->ccr_base) + pf->ccr_base;
    529        1.2   thorpej 			 */
    530        1.2   thorpej 			pf->pf_ccr_offset =
    531        1.2   thorpej 			    (tmp->pf_ccr_offset + pf->ccr_base) -
    532        1.2   thorpej 			    tmp->ccr_base;
    533        1.2   thorpej 			pf->pf_ccr_window = tmp->pf_ccr_window;
    534        1.2   thorpej 			break;
    535        1.2   thorpej 		}
    536        1.2   thorpej 	}
    537        1.2   thorpej 
    538        1.2   thorpej 	if (tmp == NULL) {
    539       1.55   mycroft 		error = pcmcia_mem_alloc(pf, PCMCIA_CCR_SIZE, &pf->pf_pcmh);
    540       1.55   mycroft 		if (error)
    541        1.2   thorpej 			goto bad;
    542        1.2   thorpej 
    543       1.55   mycroft 		error = pcmcia_mem_map(pf, PCMCIA_MEM_ATTR, pf->ccr_base,
    544        1.2   thorpej 		    PCMCIA_CCR_SIZE, &pf->pf_pcmh, &pf->pf_ccr_offset,
    545       1.55   mycroft 		    &pf->pf_ccr_window);
    546       1.55   mycroft 		if (error) {
    547        1.2   thorpej 			pcmcia_mem_free(pf, &pf->pf_pcmh);
    548        1.2   thorpej 			goto bad;
    549        1.2   thorpej 		}
    550        1.2   thorpej 	}
    551        1.2   thorpej 
    552       1.68   mycroft 	if (pcmcia_mfc(sc) || 1) {
    553       1.41   mycroft 		pcmcia_ccr_write(pf, PCMCIA_CCR_IOBASE0,
    554       1.65   mycroft 				 (pf->pf_mfc_iobase >>  0) & 0xff);
    555       1.41   mycroft 		pcmcia_ccr_write(pf, PCMCIA_CCR_IOBASE1,
    556       1.65   mycroft 				 (pf->pf_mfc_iobase >>  8) & 0xff);
    557       1.41   mycroft 		pcmcia_ccr_write(pf, PCMCIA_CCR_IOBASE2,
    558       1.65   mycroft 				 (pf->pf_mfc_iobase >> 16) & 0xff);
    559       1.41   mycroft 		pcmcia_ccr_write(pf, PCMCIA_CCR_IOBASE3,
    560       1.65   mycroft 				 (pf->pf_mfc_iobase >> 24) & 0xff);
    561       1.65   mycroft 		pcmcia_ccr_write(pf, PCMCIA_CCR_IOLIMIT,
    562       1.65   mycroft 				 pf->pf_mfc_iomax - pf->pf_mfc_iobase);
    563       1.41   mycroft 	}
    564       1.41   mycroft 
    565       1.67   mycroft 	reg = 0;
    566       1.67   mycroft 	if (pf->cfe->flags & PCMCIA_CFE_AUDIO)
    567       1.67   mycroft 		reg |= PCMCIA_CCR_STATUS_AUDIO;
    568       1.67   mycroft 	pcmcia_ccr_write(pf, PCMCIA_CCR_STATUS, reg);
    569       1.67   mycroft 
    570       1.67   mycroft 	pcmcia_ccr_write(pf, PCMCIA_CCR_SOCKETCOPY, 0);
    571       1.67   mycroft 
    572        1.2   thorpej 	reg = (pf->cfe->number & PCMCIA_CCR_OPTION_CFINDEX);
    573        1.2   thorpej 	reg |= PCMCIA_CCR_OPTION_LEVIREQ;
    574       1.53   mycroft 	if (pcmcia_mfc(sc)) {
    575        1.5      marc 		reg |= (PCMCIA_CCR_OPTION_FUNC_ENABLE |
    576        1.5      marc 			PCMCIA_CCR_OPTION_ADDR_DECODE);
    577       1.52   mycroft 		if (pf->pf_ih)
    578        1.5      marc 			reg |= PCMCIA_CCR_OPTION_IREQ_ENABLE;
    579        1.5      marc 
    580        1.5      marc 	}
    581        1.2   thorpej 	pcmcia_ccr_write(pf, PCMCIA_CCR_OPTION, reg);
    582        1.2   thorpej 
    583       1.12      marc #ifdef PCMCIADEBUG
    584       1.12      marc 	if (pcmcia_debug) {
    585       1.53   mycroft 		SIMPLEQ_FOREACH(tmp, &sc->card.pf_head, pf_list) {
    586       1.12      marc 			printf("%s: function %d CCR at %d offset %lx: "
    587       1.12      marc 			       "%x %x %x %x, %x %x %x %x, %x\n",
    588       1.12      marc 			       tmp->sc->dev.dv_xname, tmp->number,
    589       1.15   aymeric 			       tmp->pf_ccr_window,
    590       1.15   aymeric 			       (unsigned long) tmp->pf_ccr_offset,
    591       1.43   mycroft 			       pcmcia_ccr_read(tmp, 0),
    592       1.43   mycroft 			       pcmcia_ccr_read(tmp, 1),
    593       1.43   mycroft 			       pcmcia_ccr_read(tmp, 2),
    594       1.43   mycroft 			       pcmcia_ccr_read(tmp, 3),
    595       1.43   mycroft 
    596       1.43   mycroft 			       pcmcia_ccr_read(tmp, 5),
    597       1.73     perry 			       pcmcia_ccr_read(tmp, 6),
    598       1.43   mycroft 			       pcmcia_ccr_read(tmp, 7),
    599       1.43   mycroft 			       pcmcia_ccr_read(tmp, 8),
    600        1.5      marc 
    601       1.43   mycroft 			       pcmcia_ccr_read(tmp, 9));
    602       1.12      marc 		}
    603       1.12      marc 	}
    604       1.12      marc #endif
    605        1.5      marc 
    606       1.21       uch #ifdef IT8368E_LEGACY_MODE
    607       1.21       uch 	/* return to I/O mode */
    608       1.21       uch 	it8368_mode(pf, IT8368_IO_MODE, IT8368_WIDTH_16);
    609       1.21       uch #endif
    610       1.66   mycroft 
    611       1.66   mycroft 	pf->pf_flags |= PFF_ENABLED;
    612        1.2   thorpej 	return (0);
    613        1.2   thorpej 
    614       1.55   mycroft bad:
    615        1.2   thorpej 	/*
    616        1.2   thorpej 	 * Decrement the reference count, and power down the socket, if
    617        1.2   thorpej 	 * necessary.
    618        1.2   thorpej 	 */
    619       1.55   mycroft 	printf("%s: couldn't map the CCR\n", pf->child->dv_xname);
    620       1.59   mycroft 	pcmcia_socket_disable(&sc->dev);
    621        1.5      marc 
    622       1.55   mycroft 	return (error);
    623        1.2   thorpej }
    624        1.2   thorpej 
    625        1.2   thorpej /* Disable PCMCIA function. */
    626        1.2   thorpej void
    627        1.2   thorpej pcmcia_function_disable(pf)
    628        1.2   thorpej 	struct pcmcia_function *pf;
    629        1.2   thorpej {
    630       1.59   mycroft 	struct pcmcia_softc *sc = pf->sc;
    631        1.2   thorpej 	struct pcmcia_function *tmp;
    632       1.48   mycroft 	int reg;
    633        1.2   thorpej 
    634        1.2   thorpej 	if (pf->cfe == NULL)
    635        1.2   thorpej 		panic("pcmcia_function_enable: function not initialized");
    636        1.2   thorpej 
    637        1.2   thorpej 	if ((pf->pf_flags & PFF_ENABLED) == 0) {
    638        1.2   thorpej 		/*
    639       1.36    briggs 		 * Don't do anything but decrement if we're already disabled.
    640        1.2   thorpej 		 */
    641       1.36    briggs 		goto out;
    642        1.2   thorpej 	}
    643        1.2   thorpej 
    644       1.69   mycroft 	if (pcmcia_mfc(sc) &&
    645       1.69   mycroft 	    (pf->pf_flags & PFF_DETACHED) == 0) {
    646       1.48   mycroft 		reg = pcmcia_ccr_read(pf, PCMCIA_CCR_OPTION);
    647       1.48   mycroft 		reg &= ~(PCMCIA_CCR_OPTION_FUNC_ENABLE|
    648       1.48   mycroft 			 PCMCIA_CCR_OPTION_ADDR_DECODE|
    649       1.48   mycroft 		         PCMCIA_CCR_OPTION_IREQ_ENABLE);
    650       1.48   mycroft 		pcmcia_ccr_write(pf, PCMCIA_CCR_OPTION, reg);
    651       1.48   mycroft 	}
    652       1.48   mycroft 
    653        1.2   thorpej 	/*
    654        1.2   thorpej 	 * it's possible for different functions' CCRs to be in the same
    655        1.2   thorpej 	 * underlying page.  Check for that.  Note we mark us as disabled
    656        1.2   thorpej 	 * first to avoid matching ourself.
    657        1.2   thorpej 	 */
    658        1.2   thorpej 
    659        1.2   thorpej 	pf->pf_flags &= ~PFF_ENABLED;
    660       1.59   mycroft 	SIMPLEQ_FOREACH(tmp, &sc->card.pf_head, pf_list) {
    661        1.2   thorpej 		if ((tmp->pf_flags & PFF_ENABLED) &&
    662        1.2   thorpej 		    (pf->ccr_base >= (tmp->ccr_base - tmp->pf_ccr_offset)) &&
    663        1.2   thorpej 		    ((pf->ccr_base + PCMCIA_CCR_SIZE) <=
    664        1.2   thorpej 		(tmp->ccr_base - tmp->pf_ccr_offset + tmp->pf_ccr_realsize)))
    665        1.2   thorpej 			break;
    666        1.2   thorpej 	}
    667        1.2   thorpej 
    668        1.2   thorpej 	/* Not used by anyone else; unmap the CCR. */
    669        1.2   thorpej 	if (tmp == NULL) {
    670        1.2   thorpej 		pcmcia_mem_unmap(pf, pf->pf_ccr_window);
    671        1.2   thorpej 		pcmcia_mem_free(pf, &pf->pf_pcmh);
    672        1.2   thorpej 	}
    673        1.2   thorpej 
    674       1.36    briggs out:
    675        1.2   thorpej 	/*
    676        1.2   thorpej 	 * Decrement the reference count, and power down the socket, if
    677        1.2   thorpej 	 * necessary.
    678        1.2   thorpej 	 */
    679       1.59   mycroft 	pcmcia_socket_disable(&sc->dev);
    680        1.2   thorpej }
    681        1.2   thorpej 
    682        1.2   thorpej int
    683       1.41   mycroft pcmcia_io_map(pf, width, pcihp, windowp)
    684        1.2   thorpej 	struct pcmcia_function *pf;
    685        1.2   thorpej 	int width;
    686        1.2   thorpej 	struct pcmcia_io_handle *pcihp;
    687        1.2   thorpej 	int *windowp;
    688        1.2   thorpej {
    689       1.68   mycroft 	struct pcmcia_softc *sc = pf->sc;
    690       1.49   mycroft 	int error;
    691        1.2   thorpej 
    692       1.49   mycroft 	if (pf->pf_flags & PFF_ENABLED)
    693       1.51   mycroft 		printf("pcmcia_io_map: function is enabled!\n");
    694       1.49   mycroft 
    695       1.68   mycroft 	error = pcmcia_chip_io_map(sc->pct, sc->pch,
    696       1.49   mycroft 	    width, 0, pcihp->size, pcihp, windowp);
    697       1.49   mycroft 	if (error)
    698       1.49   mycroft 		return (error);
    699        1.2   thorpej 
    700        1.2   thorpej 	/*
    701        1.2   thorpej 	 * XXX in the multifunction multi-iospace-per-function case, this
    702        1.2   thorpej 	 * needs to cooperate with io_alloc to make sure that the spaces
    703        1.2   thorpej 	 * don't overlap, and that the ccr's are set correctly
    704        1.2   thorpej 	 */
    705        1.2   thorpej 
    706       1.68   mycroft 	if (pcmcia_mfc(sc) || 1) {
    707       1.65   mycroft 		bus_addr_t iobase = pcihp->addr;
    708       1.65   mycroft 		bus_addr_t iomax = pcihp->addr + pcihp->size - 1;
    709        1.5      marc 
    710       1.65   mycroft 		DPRINTF(("window iobase %lx iomax %lx\n", (long)iobase,
    711       1.65   mycroft 		    (long)iomax));
    712       1.65   mycroft 		if (pf->pf_mfc_iobase == 0) {
    713       1.65   mycroft 			pf->pf_mfc_iobase = iobase;
    714       1.65   mycroft 			pf->pf_mfc_iomax = iomax;
    715       1.65   mycroft 		} else {
    716       1.65   mycroft 			if (iobase < pf->pf_mfc_iobase)
    717       1.65   mycroft 				pf->pf_mfc_iobase = iobase;
    718       1.65   mycroft 			if (iomax > pf->pf_mfc_iomax)
    719       1.65   mycroft 				pf->pf_mfc_iomax = iomax;
    720       1.65   mycroft 		}
    721       1.65   mycroft 		DPRINTF(("function iobase %lx iomax %lx\n",
    722       1.65   mycroft 		    (long)pf->pf_mfc_iobase, (long)pf->pf_mfc_iomax));
    723        1.2   thorpej 	}
    724       1.41   mycroft 
    725        1.2   thorpej 	return (0);
    726       1.11   thorpej }
    727       1.11   thorpej 
    728       1.11   thorpej void
    729       1.11   thorpej pcmcia_io_unmap(pf, window)
    730       1.11   thorpej 	struct pcmcia_function *pf;
    731       1.11   thorpej 	int window;
    732       1.11   thorpej {
    733       1.68   mycroft 	struct pcmcia_softc *sc = pf->sc;
    734       1.11   thorpej 
    735       1.49   mycroft 	if (pf->pf_flags & PFF_ENABLED)
    736       1.51   mycroft 		printf("pcmcia_io_unmap: function is enabled!\n");
    737       1.49   mycroft 
    738       1.68   mycroft 	pcmcia_chip_io_unmap(sc->pct, sc->pch, window);
    739        1.2   thorpej }
    740        1.2   thorpej 
    741        1.2   thorpej void *
    742        1.2   thorpej pcmcia_intr_establish(pf, ipl, ih_fct, ih_arg)
    743        1.2   thorpej 	struct pcmcia_function *pf;
    744        1.2   thorpej 	int ipl;
    745       1.72     perry 	int (*ih_fct)(void *);
    746        1.2   thorpej 	void *ih_arg;
    747        1.2   thorpej {
    748        1.2   thorpej 
    749       1.49   mycroft 	if (pf->pf_flags & PFF_ENABLED)
    750       1.51   mycroft 		printf("pcmcia_intr_establish: function is enabled!\n");
    751       1.52   mycroft 	if (pf->pf_ih)
    752       1.52   mycroft 		panic("pcmcia_intr_establish: already done\n");
    753       1.49   mycroft 
    754       1.52   mycroft 	pf->pf_ih = pcmcia_chip_intr_establish(pf->sc->pct, pf->sc->pch,
    755       1.52   mycroft 	    pf, ipl, ih_fct, ih_arg);
    756       1.55   mycroft 	if (!pf->pf_ih)
    757       1.55   mycroft 		printf("%s: interrupt establish failed\n", pf->child->dv_xname);
    758       1.52   mycroft 	return (pf->pf_ih);
    759        1.2   thorpej }
    760        1.2   thorpej 
    761        1.2   thorpej void
    762        1.2   thorpej pcmcia_intr_disestablish(pf, ih)
    763        1.2   thorpej 	struct pcmcia_function *pf;
    764        1.2   thorpej 	void *ih;
    765        1.2   thorpej {
    766       1.52   mycroft 
    767       1.49   mycroft 	if (pf->pf_flags & PFF_ENABLED)
    768       1.51   mycroft 		printf("pcmcia_intr_disestablish: function is enabled!\n");
    769       1.52   mycroft 	if (!pf->pf_ih)
    770       1.52   mycroft 		panic("pcmcia_intr_distestablish: already done\n");
    771       1.49   mycroft 
    772       1.52   mycroft 	pcmcia_chip_intr_disestablish(pf->sc->pct, pf->sc->pch, ih);
    773       1.52   mycroft 	pf->pf_ih = 0;
    774        1.2   thorpej }
    775       1.53   mycroft 
    776       1.53   mycroft int
    777       1.53   mycroft pcmcia_config_alloc(pf, cfe)
    778       1.53   mycroft 	struct pcmcia_function *pf;
    779       1.53   mycroft 	struct pcmcia_config_entry *cfe;
    780       1.53   mycroft {
    781       1.61   mycroft 	int error = 0;
    782       1.53   mycroft 	int n, m;
    783       1.53   mycroft 
    784       1.53   mycroft 	for (n = 0; n < cfe->num_iospace; n++) {
    785       1.53   mycroft 		bus_addr_t start = cfe->iospace[n].start;
    786       1.53   mycroft 		bus_size_t length = cfe->iospace[n].length;
    787       1.53   mycroft 		bus_size_t align = cfe->iomask ? (1 << cfe->iomask) :
    788       1.53   mycroft 		    length;
    789       1.53   mycroft 		bus_size_t skew = start & (align - 1);
    790       1.53   mycroft 
    791       1.54   mycroft 		if ((start - skew) == 0 && align < 0x400) {
    792       1.54   mycroft 			if (skew)
    793       1.54   mycroft 				printf("Drats!  I need a skew!\n");
    794       1.53   mycroft 			start = 0;
    795       1.54   mycroft 		}
    796       1.53   mycroft 
    797       1.53   mycroft 		DPRINTF(("pcmcia_config_alloc: io %d start=%lx length=%lx align=%lx skew=%lx\n",
    798       1.53   mycroft 		    n, (long)start, (long)length, (long)align, (long)skew));
    799       1.53   mycroft 
    800       1.53   mycroft 		error = pcmcia_io_alloc(pf, start, length, align,
    801       1.53   mycroft 		    &cfe->iospace[n].handle);
    802       1.53   mycroft 		if (error)
    803       1.53   mycroft 			break;
    804       1.53   mycroft 	}
    805       1.53   mycroft 	if (n < cfe->num_iospace) {
    806       1.53   mycroft 		for (m = 0; m < n; m++)
    807       1.53   mycroft 			pcmcia_io_free(pf, &cfe->iospace[m].handle);
    808       1.53   mycroft 		return (error);
    809       1.53   mycroft 	}
    810       1.53   mycroft 
    811       1.53   mycroft 	for (n = 0; n < cfe->num_memspace; n++) {
    812       1.53   mycroft 		bus_size_t length = cfe->memspace[n].length;
    813       1.53   mycroft 
    814       1.53   mycroft 		DPRINTF(("pcmcia_config_alloc: mem %d length %lx\n", n,
    815       1.53   mycroft 		    (long)length));
    816       1.53   mycroft 
    817       1.53   mycroft 		error = pcmcia_mem_alloc(pf, length, &cfe->memspace[n].handle);
    818       1.53   mycroft 		if (error)
    819       1.53   mycroft 			break;
    820       1.53   mycroft 	}
    821       1.53   mycroft 	if (n < cfe->num_memspace) {
    822       1.53   mycroft 		for (m = 0; m < cfe->num_iospace; m++)
    823       1.53   mycroft 			pcmcia_io_free(pf, &cfe->iospace[m].handle);
    824       1.53   mycroft 		for (m = 0; m < n; m++)
    825       1.53   mycroft 			pcmcia_mem_free(pf, &cfe->memspace[m].handle);
    826       1.53   mycroft 		return (error);
    827       1.53   mycroft 	}
    828       1.53   mycroft 
    829       1.53   mycroft 	/* This one's good! */
    830       1.61   mycroft 	return (error);
    831       1.53   mycroft }
    832       1.53   mycroft 
    833       1.53   mycroft void
    834       1.53   mycroft pcmcia_config_free(pf)
    835       1.53   mycroft 	struct pcmcia_function *pf;
    836       1.53   mycroft {
    837       1.53   mycroft 	struct pcmcia_config_entry *cfe = pf->cfe;
    838       1.53   mycroft 	int m;
    839       1.53   mycroft 
    840       1.53   mycroft 	for (m = 0; m < cfe->num_iospace; m++)
    841       1.53   mycroft 		pcmcia_io_free(pf, &cfe->iospace[m].handle);
    842       1.53   mycroft 	for (m = 0; m < cfe->num_memspace; m++)
    843       1.53   mycroft 		pcmcia_mem_free(pf, &cfe->memspace[m].handle);
    844       1.53   mycroft }
    845       1.53   mycroft 
    846       1.53   mycroft int
    847       1.53   mycroft pcmcia_config_map(pf)
    848       1.53   mycroft 	struct pcmcia_function *pf;
    849       1.53   mycroft {
    850       1.53   mycroft 	struct pcmcia_config_entry *cfe = pf->cfe;
    851       1.61   mycroft 	int error = 0;
    852       1.53   mycroft 	int n, m;
    853       1.53   mycroft 
    854       1.53   mycroft 	for (n = 0; n < cfe->num_iospace; n++) {
    855       1.53   mycroft 		int width;
    856       1.53   mycroft 
    857       1.62   mycroft 		if (cfe->flags & PCMCIA_CFE_IO16)
    858       1.62   mycroft 			width = PCMCIA_WIDTH_AUTO;
    859       1.62   mycroft 		else
    860       1.53   mycroft 			width = PCMCIA_WIDTH_IO8;
    861       1.53   mycroft 		error = pcmcia_io_map(pf, width, &cfe->iospace[n].handle,
    862       1.53   mycroft 		    &cfe->iospace[n].window);
    863       1.53   mycroft 		if (error)
    864       1.53   mycroft 			break;
    865       1.53   mycroft 	}
    866       1.53   mycroft 	if (n < cfe->num_iospace) {
    867       1.53   mycroft 		for (m = 0; m < n; m++)
    868       1.53   mycroft 			pcmcia_io_unmap(pf, cfe->iospace[m].window);
    869       1.53   mycroft 		return (error);
    870       1.53   mycroft 	}
    871       1.53   mycroft 
    872       1.53   mycroft 	for (n = 0; n < cfe->num_memspace; n++) {
    873       1.53   mycroft 		bus_size_t length = cfe->memspace[n].length;
    874       1.53   mycroft 		int width;
    875       1.53   mycroft 
    876       1.53   mycroft 		DPRINTF(("pcmcia_config_alloc: mem %d length %lx\n", n,
    877       1.53   mycroft 		    (long)length));
    878       1.53   mycroft 
    879       1.53   mycroft 		/*XXX*/
    880       1.53   mycroft 		width = PCMCIA_WIDTH_MEM8|PCMCIA_MEM_COMMON;
    881       1.53   mycroft 		error = pcmcia_mem_map(pf, width, 0, length,
    882       1.53   mycroft 		    &cfe->memspace[n].handle, &cfe->memspace[n].offset,
    883       1.53   mycroft 		    &cfe->memspace[n].window);
    884       1.53   mycroft 		if (error)
    885       1.53   mycroft 			break;
    886       1.53   mycroft 	}
    887       1.53   mycroft 	if (n < cfe->num_memspace) {
    888       1.53   mycroft 		for (m = 0; m < cfe->num_iospace; m++)
    889       1.53   mycroft 			pcmcia_io_unmap(pf, cfe->iospace[m].window);
    890       1.53   mycroft 		for (m = 0; m < n; m++)
    891       1.53   mycroft 			pcmcia_mem_unmap(pf, cfe->memspace[m].window);
    892       1.53   mycroft 		return (error);
    893       1.53   mycroft 	}
    894       1.53   mycroft 
    895       1.53   mycroft 	/* This one's good! */
    896       1.61   mycroft 	return (error);
    897       1.53   mycroft }
    898       1.53   mycroft 
    899       1.53   mycroft void
    900       1.53   mycroft pcmcia_config_unmap(pf)
    901       1.53   mycroft 	struct pcmcia_function *pf;
    902       1.53   mycroft {
    903       1.53   mycroft 	struct pcmcia_config_entry *cfe = pf->cfe;
    904       1.53   mycroft 	int m;
    905       1.53   mycroft 
    906       1.53   mycroft 	for (m = 0; m < cfe->num_iospace; m++)
    907       1.53   mycroft 		pcmcia_io_unmap(pf, cfe->iospace[m].window);
    908       1.53   mycroft 	for (m = 0; m < cfe->num_memspace; m++)
    909       1.53   mycroft 		pcmcia_mem_unmap(pf, cfe->memspace[m].window);
    910       1.53   mycroft }
    911       1.53   mycroft 
    912       1.53   mycroft int
    913       1.53   mycroft pcmcia_function_configure(pf, validator)
    914       1.53   mycroft 	struct pcmcia_function *pf;
    915       1.72     perry 	int (*validator)(struct pcmcia_config_entry *);
    916       1.53   mycroft {
    917       1.53   mycroft 	struct pcmcia_config_entry *cfe;
    918       1.53   mycroft 	int error = ENOENT;
    919       1.53   mycroft 
    920       1.53   mycroft 	SIMPLEQ_FOREACH(cfe, &pf->cfe_head, cfe_list) {
    921       1.53   mycroft 		error = validator(cfe);
    922       1.53   mycroft 		if (error)
    923       1.53   mycroft 			continue;
    924       1.53   mycroft 		error = pcmcia_config_alloc(pf, cfe);
    925       1.53   mycroft 		if (!error)
    926       1.53   mycroft 			break;
    927       1.53   mycroft 	}
    928       1.53   mycroft 	if (!cfe) {
    929       1.53   mycroft 		DPRINTF(("pcmcia_function_configure: no config entry found, error=%d\n",
    930       1.53   mycroft 		    error));
    931       1.53   mycroft 		return (error);
    932       1.53   mycroft 	}
    933       1.53   mycroft 
    934       1.53   mycroft 	/* Remember which configuration entry we are using. */
    935       1.53   mycroft 	pf->cfe = cfe;
    936       1.53   mycroft 
    937       1.53   mycroft 	error = pcmcia_config_map(pf);
    938       1.53   mycroft 	if (error) {
    939       1.53   mycroft 		DPRINTF(("pcmcia_function_configure: map failed, error=%d\n",
    940       1.53   mycroft 		    error));
    941       1.53   mycroft 		return (error);
    942       1.53   mycroft 	}
    943       1.53   mycroft 
    944       1.53   mycroft 	return (0);
    945       1.53   mycroft }
    946       1.53   mycroft 
    947       1.53   mycroft void
    948       1.53   mycroft pcmcia_function_unconfigure(pf)
    949       1.53   mycroft 	struct pcmcia_function *pf;
    950       1.53   mycroft {
    951       1.53   mycroft 
    952       1.53   mycroft 	pcmcia_config_unmap(pf);
    953       1.53   mycroft 	pcmcia_config_free(pf);
    954       1.53   mycroft }
    955