Home | History | Annotate | Line # | Download | only in pcmcia
pcmcia.c revision 1.75
      1  1.75  drochner /*	$NetBSD: pcmcia.c,v 1.75 2005/08/25 18:35:39 drochner 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.75  drochner __KERNEL_RCSID(0, "$NetBSD: pcmcia.c,v 1.75 2005/08/25 18:35:39 drochner 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.2   thorpej #include <dev/pcmcia/pcmciareg.h>
     60   1.2   thorpej #include <dev/pcmcia/pcmciachip.h>
     61   1.2   thorpej #include <dev/pcmcia/pcmciavar.h>
     62  1.21       uch #ifdef IT8368E_LEGACY_MODE /* XXX -uch */
     63  1.21       uch #include <arch/hpcmips/dev/it8368var.h>
     64  1.21       uch #endif
     65   1.2   thorpej 
     66   1.3     enami #include "locators.h"
     67   1.3     enami 
     68   1.2   thorpej #ifdef PCMCIADEBUG
     69   1.2   thorpej int	pcmcia_debug = 0;
     70   1.2   thorpej #define	DPRINTF(arg) if (pcmcia_debug) printf arg
     71   1.2   thorpej #else
     72   1.2   thorpej #define	DPRINTF(arg)
     73   1.2   thorpej #endif
     74   1.2   thorpej 
     75   1.2   thorpej #ifdef PCMCIAVERBOSE
     76   1.2   thorpej int	pcmcia_verbose = 1;
     77   1.2   thorpej #else
     78   1.2   thorpej int	pcmcia_verbose = 0;
     79   1.2   thorpej #endif
     80   1.2   thorpej 
     81  1.72     perry int	pcmcia_match(struct device *, struct cfdata *, void *);
     82  1.72     perry int	pcmcia_submatch(struct device *, struct cfdata *,
     83  1.72     perry 			     const locdesc_t *, 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.2   thorpej pcmcia_match(parent, match, aux)
    118   1.2   thorpej 	struct device *parent;
    119   1.2   thorpej 	struct cfdata *match;
    120   1.2   thorpej 	void *aux;
    121   1.2   thorpej {
    122  1.14      haya 	struct pcmciabus_attach_args *paa = aux;
    123  1.14      haya 
    124  1.30   thorpej 	if (strcmp(paa->paa_busname, match->cf_name)) {
    125  1.14      haya 	    return 0;
    126  1.14      haya 	}
    127   1.2   thorpej 	/* if the autoconfiguration got this far, there's a socket here */
    128   1.2   thorpej 	return (1);
    129   1.2   thorpej }
    130   1.2   thorpej 
    131   1.2   thorpej void
    132   1.2   thorpej pcmcia_attach(parent, self, aux)
    133   1.2   thorpej 	struct device *parent, *self;
    134   1.2   thorpej 	void *aux;
    135   1.2   thorpej {
    136   1.2   thorpej 	struct pcmciabus_attach_args *paa = aux;
    137   1.2   thorpej 	struct pcmcia_softc *sc = (struct pcmcia_softc *) self;
    138   1.2   thorpej 
    139   1.2   thorpej 	printf("\n");
    140   1.2   thorpej 
    141   1.2   thorpej 	sc->pct = paa->pct;
    142   1.2   thorpej 	sc->pch = paa->pch;
    143   1.2   thorpej 	sc->iobase = paa->iobase;
    144   1.2   thorpej 	sc->iosize = paa->iosize;
    145   1.2   thorpej 
    146   1.2   thorpej 	sc->ih = NULL;
    147   1.2   thorpej }
    148   1.2   thorpej 
    149   1.2   thorpej int
    150   1.2   thorpej pcmcia_card_attach(dev)
    151   1.2   thorpej 	struct device *dev;
    152   1.2   thorpej {
    153   1.2   thorpej 	struct pcmcia_softc *sc = (struct pcmcia_softc *) dev;
    154   1.2   thorpej 	struct pcmcia_function *pf;
    155  1.71  drochner 	int error;
    156  1.71  drochner 	static const int wildcard[2] = {
    157  1.71  drochner 		PCMCIACF_FUNCTION_DEFAULT, PCMCIACF_IRQ_DEFAULT
    158  1.71  drochner 	};
    159   1.2   thorpej 
    160   1.2   thorpej 	/*
    161   1.2   thorpej 	 * this is here so that when socket_enable calls gettype, trt happens
    162   1.2   thorpej 	 */
    163  1.29     lukem 	SIMPLEQ_FIRST(&sc->card.pf_head) = NULL;
    164   1.2   thorpej 
    165  1.59   mycroft 	pcmcia_socket_enable(dev);
    166   1.2   thorpej 
    167   1.2   thorpej 	pcmcia_read_cis(sc);
    168  1.59   mycroft 	pcmcia_check_cis_quirks(sc);
    169   1.2   thorpej 
    170  1.71  drochner #if 1 /* XXX remove this, done below ??? */
    171   1.2   thorpej 	/*
    172   1.2   thorpej 	 * bail now if the card has no functions, or if there was an error in
    173   1.2   thorpej 	 * the cis.
    174   1.2   thorpej 	 */
    175  1.64   mycroft 	if (sc->card.error ||
    176  1.64   mycroft 	    SIMPLEQ_EMPTY(&sc->card.pf_head)) {
    177  1.64   mycroft 		printf("%s: card appears to have bogus CIS\n",
    178  1.64   mycroft 		    sc->dev.dv_xname);
    179  1.71  drochner 		error = EIO;
    180  1.59   mycroft 		goto done;
    181  1.64   mycroft 	}
    182  1.71  drochner #endif
    183   1.2   thorpej 
    184   1.2   thorpej 	if (pcmcia_verbose)
    185   1.2   thorpej 		pcmcia_print_cis(sc);
    186   1.2   thorpej 
    187  1.29     lukem 	SIMPLEQ_FOREACH(pf, &sc->card.pf_head, pf_list) {
    188  1.29     lukem 		if (SIMPLEQ_EMPTY(&pf->cfe_head))
    189   1.2   thorpej 			continue;
    190   1.2   thorpej 
    191  1.11   thorpej #ifdef DIAGNOSTIC
    192  1.11   thorpej 		if (pf->child != NULL) {
    193  1.11   thorpej 			printf("%s: %s still attached to function %d!\n",
    194  1.11   thorpej 			    sc->dev.dv_xname, pf->child->dv_xname,
    195  1.11   thorpej 			    pf->number);
    196  1.11   thorpej 			panic("pcmcia_card_attach");
    197  1.11   thorpej 		}
    198  1.11   thorpej #endif
    199   1.2   thorpej 		pf->sc = sc;
    200  1.11   thorpej 		pf->child = NULL;
    201   1.2   thorpej 		pf->cfe = NULL;
    202  1.52   mycroft 		pf->pf_ih = NULL;
    203   1.2   thorpej 	}
    204   1.2   thorpej 
    205  1.71  drochner 	error = pcmcia_rescan(dev, "pcmcia", wildcard);
    206  1.71  drochner done:
    207  1.71  drochner 	pcmcia_socket_disable(dev);
    208  1.71  drochner 	return (error);
    209  1.71  drochner }
    210  1.71  drochner 
    211  1.71  drochner int
    212  1.71  drochner pcmcia_rescan(struct device *self, const char *ifattr, 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.75  drochner 		locs[PCMCIACF_IRQ] = PCMCIACF_IRQ_DEFAULT;
    238  1.71  drochner 
    239   1.2   thorpej 		paa.manufacturer = sc->card.manufacturer;
    240   1.2   thorpej 		paa.product = sc->card.product;
    241   1.2   thorpej 		paa.card = &sc->card;
    242   1.2   thorpej 		paa.pf = pf;
    243   1.2   thorpej 
    244  1.75  drochner 		pf->child = config_found_sm_loc(self, "pcmcia", locs, &paa,
    245  1.71  drochner 						pcmcia_print, pcmcia_submatch);
    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.71  drochner 			KASSERT(child->dv_locators[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.75  drochner pcmcia_submatch(parent, cf, locs, aux)
    334   1.2   thorpej 	struct device *parent;
    335  1.75  drochner 	const locdesc_t *locs;
    336   1.2   thorpej 	struct cfdata *cf;
    337   1.2   thorpej 	void *aux;
    338   1.2   thorpej {
    339   1.2   thorpej 
    340   1.3     enami 	if (cf->cf_loc[PCMCIACF_FUNCTION] != PCMCIACF_FUNCTION_DEFAULT &&
    341  1.75  drochner 	    cf->cf_loc[PCMCIACF_FUNCTION] != locs[PCMCIACF_FUNCTION])
    342   1.2   thorpej 		return (0);
    343   1.2   thorpej 
    344  1.31   thorpej 	return (config_match(parent, cf, aux));
    345   1.2   thorpej }
    346   1.2   thorpej 
    347   1.2   thorpej int
    348   1.2   thorpej pcmcia_print(arg, pnp)
    349   1.2   thorpej 	void *arg;
    350   1.2   thorpej 	const char *pnp;
    351   1.2   thorpej {
    352   1.2   thorpej 	struct pcmcia_attach_args *pa = arg;
    353   1.2   thorpej 	struct pcmcia_softc *sc = pa->pf->sc;
    354   1.2   thorpej 	struct pcmcia_card *card = &sc->card;
    355  1.18  augustss 	char devinfo[256];
    356   1.2   thorpej 
    357  1.38   mycroft 	if (pnp)
    358  1.38   mycroft 		aprint_normal("%s", pnp);
    359  1.38   mycroft 
    360  1.38   mycroft 	pcmcia_devinfo(card, !!pnp, devinfo, sizeof(devinfo));
    361  1.38   mycroft 
    362  1.57   mycroft 	aprint_normal(" function %d: %s\n", pa->pf->number, devinfo);
    363   1.2   thorpej 
    364   1.2   thorpej 	return (UNCONF);
    365  1.18  augustss }
    366  1.18  augustss 
    367  1.18  augustss void
    368  1.18  augustss pcmcia_devinfo(card, showhex, cp, cplen)
    369  1.18  augustss 	struct pcmcia_card *card;
    370  1.19     enami 	int showhex;
    371  1.18  augustss 	char *cp;
    372  1.38   mycroft 	size_t cplen;
    373  1.18  augustss {
    374  1.18  augustss 	int i, n;
    375  1.18  augustss 
    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 	for (i = 0; i < 4 && card->cis1_info[i] != NULL && cplen > 1; i++) {
    383  1.39   mycroft 		n = snprintf(cp, cplen, "%s%s", i ? ", " : "",
    384  1.18  augustss 		        card->cis1_info[i]);
    385  1.18  augustss 		cp += n;
    386  1.38   mycroft 		if (cplen < n)
    387  1.38   mycroft 			return;
    388  1.18  augustss 		cplen -= n;
    389  1.18  augustss 	}
    390  1.37   mycroft 
    391  1.37   mycroft 	if (cplen > 1) {
    392  1.37   mycroft 		*cp++ = '>';
    393  1.38   mycroft 		*cp = '\0';
    394  1.37   mycroft 		cplen--;
    395  1.37   mycroft 	}
    396  1.37   mycroft 
    397  1.37   mycroft 	if (showhex && cplen > 1)
    398  1.37   mycroft 		snprintf(cp, cplen, " (manufacturer 0x%04x, product 0x%04x)",
    399  1.37   mycroft 		    card->manufacturer, card->product);
    400  1.16       cgd }
    401  1.16       cgd 
    402  1.56   mycroft const void *
    403  1.56   mycroft pcmcia_product_lookup(pa, tab, nent, ent_size, matchfn)
    404  1.16       cgd 	struct pcmcia_attach_args *pa;
    405  1.56   mycroft 	const void *tab;
    406  1.56   mycroft 	size_t nent;
    407  1.16       cgd 	size_t ent_size;
    408  1.16       cgd 	pcmcia_product_match_fn matchfn;
    409  1.16       cgd {
    410  1.56   mycroft         const struct pcmcia_product *pp;
    411  1.56   mycroft 	int n;
    412  1.16       cgd 	int matches;
    413  1.16       cgd 
    414  1.16       cgd #ifdef DIAGNOSTIC
    415  1.56   mycroft 	if (sizeof *pp > ent_size)
    416  1.73     perry 		panic("pcmcia_product_lookup: bogus ent_size %ld",
    417  1.17   nathanw 		      (long) ent_size);
    418  1.16       cgd #endif
    419  1.16       cgd 
    420  1.56   mycroft         for (pp = tab, n = nent; n; pp = (const struct pcmcia_product *)
    421  1.56   mycroft 	      ((const char *)pp + ent_size), n--) {
    422  1.56   mycroft 		/* see if it matches vendor/product */
    423  1.58   mycroft 		matches = 0;
    424  1.56   mycroft 		if ((pp->pp_vendor != PCMCIA_VENDOR_INVALID &&
    425  1.56   mycroft 		     pp->pp_vendor == pa->manufacturer) &&
    426  1.56   mycroft 		    (pp->pp_product != PCMCIA_PRODUCT_INVALID &&
    427  1.56   mycroft 		     pp->pp_product == pa->product))
    428  1.56   mycroft 			matches = 1;
    429  1.58   mycroft 		if ((pp->pp_cisinfo[0] && pa->card->cis1_info[0] &&
    430  1.56   mycroft 		          !strcmp(pp->pp_cisinfo[0], pa->card->cis1_info[0])) &&
    431  1.56   mycroft 		         (pp->pp_cisinfo[1] && pa->card->cis1_info[1] &&
    432  1.56   mycroft 		          !strcmp(pp->pp_cisinfo[1], pa->card->cis1_info[1])) &&
    433  1.56   mycroft 		         (!pp->pp_cisinfo[2] || (pa->card->cis1_info[2] &&
    434  1.56   mycroft 		           !strcmp(pp->pp_cisinfo[2], pa->card->cis1_info[2]))) &&
    435  1.56   mycroft 		         (!pp->pp_cisinfo[3] || (pa->card->cis1_info[3] &&
    436  1.56   mycroft 		           !strcmp(pp->pp_cisinfo[3], pa->card->cis1_info[3]))))
    437  1.56   mycroft 			matches = 1;
    438  1.16       cgd 
    439  1.16       cgd 		/* if a separate match function is given, let it override */
    440  1.56   mycroft 		if (matchfn)
    441  1.56   mycroft 			matches = (*matchfn)(pa, pp, matches);
    442  1.16       cgd 
    443  1.16       cgd 		if (matches)
    444  1.56   mycroft                         return (pp);
    445  1.16       cgd         }
    446  1.56   mycroft         return (0);
    447   1.2   thorpej }
    448   1.2   thorpej 
    449  1.60   mycroft void
    450  1.70   mycroft pcmcia_socket_settype(dev, type)
    451  1.70   mycroft 	struct device *dev;
    452  1.70   mycroft 	int type;
    453   1.2   thorpej {
    454  1.60   mycroft 	struct pcmcia_softc *sc = (void *)dev;
    455   1.2   thorpej 
    456  1.60   mycroft 	pcmcia_chip_socket_settype(sc->pct, sc->pch, type);
    457   1.2   thorpej }
    458   1.2   thorpej 
    459   1.2   thorpej /*
    460   1.2   thorpej  * Initialize a PCMCIA function.  May be called as long as the function is
    461   1.2   thorpej  * disabled.
    462   1.2   thorpej  */
    463   1.2   thorpej void
    464   1.2   thorpej pcmcia_function_init(pf, cfe)
    465   1.2   thorpej 	struct pcmcia_function *pf;
    466   1.2   thorpej 	struct pcmcia_config_entry *cfe;
    467   1.2   thorpej {
    468   1.2   thorpej 	if (pf->pf_flags & PFF_ENABLED)
    469   1.2   thorpej 		panic("pcmcia_function_init: function is enabled");
    470   1.2   thorpej 
    471   1.2   thorpej 	/* Remember which configuration entry we are using. */
    472   1.2   thorpej 	pf->cfe = cfe;
    473   1.2   thorpej }
    474   1.2   thorpej 
    475  1.59   mycroft void
    476  1.59   mycroft pcmcia_socket_enable(dev)
    477  1.40   mycroft 	struct device *dev;
    478   1.5      marc {
    479  1.40   mycroft 	struct pcmcia_softc *sc = (void *)dev;
    480  1.40   mycroft 
    481  1.59   mycroft 	if (sc->sc_enabled_count++ == 0)
    482  1.59   mycroft 		pcmcia_chip_socket_enable(sc->pct, sc->pch);
    483  1.59   mycroft 	DPRINTF(("%s: ++enabled_count = %d\n", sc->dev.dv_xname,
    484  1.59   mycroft 		 sc->sc_enabled_count));
    485   1.5      marc }
    486   1.5      marc 
    487  1.59   mycroft void
    488  1.59   mycroft pcmcia_socket_disable(dev)
    489  1.40   mycroft 	struct device *dev;
    490   1.5      marc {
    491  1.40   mycroft 	struct pcmcia_softc *sc = (void *)dev;
    492  1.40   mycroft 
    493  1.59   mycroft 	if (--sc->sc_enabled_count == 0)
    494  1.59   mycroft 		pcmcia_chip_socket_disable(sc->pct, sc->pch);
    495  1.59   mycroft 	DPRINTF(("%s: --enabled_count = %d\n", sc->dev.dv_xname,
    496  1.59   mycroft 		 sc->sc_enabled_count));
    497   1.5      marc }
    498   1.5      marc 
    499   1.2   thorpej /* Enable a PCMCIA function */
    500   1.2   thorpej int
    501   1.2   thorpej pcmcia_function_enable(pf)
    502   1.2   thorpej 	struct pcmcia_function *pf;
    503   1.2   thorpej {
    504  1.53   mycroft 	struct pcmcia_softc *sc = pf->sc;
    505   1.2   thorpej 	struct pcmcia_function *tmp;
    506   1.2   thorpej 	int reg;
    507  1.55   mycroft 	int error;
    508   1.2   thorpej 
    509   1.2   thorpej 	if (pf->cfe == NULL)
    510   1.2   thorpej 		panic("pcmcia_function_enable: function not initialized");
    511   1.2   thorpej 
    512   1.5      marc 	/*
    513   1.5      marc 	 * Increase the reference count on the socket, enabling power, if
    514   1.5      marc 	 * necessary.
    515   1.5      marc 	 */
    516  1.59   mycroft 	pcmcia_socket_enable(&sc->dev);
    517  1.74  christos 	pcmcia_socket_settype(&sc->dev, pf->cfe->iftype);
    518   1.5      marc 
    519   1.2   thorpej 	if (pf->pf_flags & PFF_ENABLED) {
    520   1.2   thorpej 		/*
    521   1.2   thorpej 		 * Don't do anything if we're already enabled.
    522   1.2   thorpej 		 */
    523   1.2   thorpej 		return (0);
    524   1.2   thorpej 	}
    525   1.2   thorpej 
    526   1.2   thorpej 	/*
    527   1.2   thorpej 	 * it's possible for different functions' CCRs to be in the same
    528   1.2   thorpej 	 * underlying page.  Check for that.
    529   1.2   thorpej 	 */
    530   1.2   thorpej 
    531  1.53   mycroft 	SIMPLEQ_FOREACH(tmp, &sc->card.pf_head, pf_list) {
    532   1.2   thorpej 		if ((tmp->pf_flags & PFF_ENABLED) &&
    533   1.2   thorpej 		    (pf->ccr_base >= (tmp->ccr_base - tmp->pf_ccr_offset)) &&
    534   1.2   thorpej 		    ((pf->ccr_base + PCMCIA_CCR_SIZE) <=
    535   1.2   thorpej 		     (tmp->ccr_base - tmp->pf_ccr_offset +
    536   1.2   thorpej 		      tmp->pf_ccr_realsize))) {
    537   1.2   thorpej 			pf->pf_ccrt = tmp->pf_ccrt;
    538   1.2   thorpej 			pf->pf_ccrh = tmp->pf_ccrh;
    539   1.2   thorpej 			pf->pf_ccr_realsize = tmp->pf_ccr_realsize;
    540   1.2   thorpej 
    541   1.2   thorpej 			/*
    542   1.2   thorpej 			 * pf->pf_ccr_offset = (tmp->pf_ccr_offset -
    543   1.2   thorpej 			 * tmp->ccr_base) + pf->ccr_base;
    544   1.2   thorpej 			 */
    545   1.2   thorpej 			pf->pf_ccr_offset =
    546   1.2   thorpej 			    (tmp->pf_ccr_offset + pf->ccr_base) -
    547   1.2   thorpej 			    tmp->ccr_base;
    548   1.2   thorpej 			pf->pf_ccr_window = tmp->pf_ccr_window;
    549   1.2   thorpej 			break;
    550   1.2   thorpej 		}
    551   1.2   thorpej 	}
    552   1.2   thorpej 
    553   1.2   thorpej 	if (tmp == NULL) {
    554  1.55   mycroft 		error = pcmcia_mem_alloc(pf, PCMCIA_CCR_SIZE, &pf->pf_pcmh);
    555  1.55   mycroft 		if (error)
    556   1.2   thorpej 			goto bad;
    557   1.2   thorpej 
    558  1.55   mycroft 		error = pcmcia_mem_map(pf, PCMCIA_MEM_ATTR, pf->ccr_base,
    559   1.2   thorpej 		    PCMCIA_CCR_SIZE, &pf->pf_pcmh, &pf->pf_ccr_offset,
    560  1.55   mycroft 		    &pf->pf_ccr_window);
    561  1.55   mycroft 		if (error) {
    562   1.2   thorpej 			pcmcia_mem_free(pf, &pf->pf_pcmh);
    563   1.2   thorpej 			goto bad;
    564   1.2   thorpej 		}
    565   1.2   thorpej 	}
    566   1.2   thorpej 
    567  1.68   mycroft 	if (pcmcia_mfc(sc) || 1) {
    568  1.41   mycroft 		pcmcia_ccr_write(pf, PCMCIA_CCR_IOBASE0,
    569  1.65   mycroft 				 (pf->pf_mfc_iobase >>  0) & 0xff);
    570  1.41   mycroft 		pcmcia_ccr_write(pf, PCMCIA_CCR_IOBASE1,
    571  1.65   mycroft 				 (pf->pf_mfc_iobase >>  8) & 0xff);
    572  1.41   mycroft 		pcmcia_ccr_write(pf, PCMCIA_CCR_IOBASE2,
    573  1.65   mycroft 				 (pf->pf_mfc_iobase >> 16) & 0xff);
    574  1.41   mycroft 		pcmcia_ccr_write(pf, PCMCIA_CCR_IOBASE3,
    575  1.65   mycroft 				 (pf->pf_mfc_iobase >> 24) & 0xff);
    576  1.65   mycroft 		pcmcia_ccr_write(pf, PCMCIA_CCR_IOLIMIT,
    577  1.65   mycroft 				 pf->pf_mfc_iomax - pf->pf_mfc_iobase);
    578  1.41   mycroft 	}
    579  1.41   mycroft 
    580  1.67   mycroft 	reg = 0;
    581  1.67   mycroft 	if (pf->cfe->flags & PCMCIA_CFE_AUDIO)
    582  1.67   mycroft 		reg |= PCMCIA_CCR_STATUS_AUDIO;
    583  1.67   mycroft 	pcmcia_ccr_write(pf, PCMCIA_CCR_STATUS, reg);
    584  1.67   mycroft 
    585  1.67   mycroft 	pcmcia_ccr_write(pf, PCMCIA_CCR_SOCKETCOPY, 0);
    586  1.67   mycroft 
    587   1.2   thorpej 	reg = (pf->cfe->number & PCMCIA_CCR_OPTION_CFINDEX);
    588   1.2   thorpej 	reg |= PCMCIA_CCR_OPTION_LEVIREQ;
    589  1.53   mycroft 	if (pcmcia_mfc(sc)) {
    590   1.5      marc 		reg |= (PCMCIA_CCR_OPTION_FUNC_ENABLE |
    591   1.5      marc 			PCMCIA_CCR_OPTION_ADDR_DECODE);
    592  1.52   mycroft 		if (pf->pf_ih)
    593   1.5      marc 			reg |= PCMCIA_CCR_OPTION_IREQ_ENABLE;
    594   1.5      marc 
    595   1.5      marc 	}
    596   1.2   thorpej 	pcmcia_ccr_write(pf, PCMCIA_CCR_OPTION, reg);
    597   1.2   thorpej 
    598  1.12      marc #ifdef PCMCIADEBUG
    599  1.12      marc 	if (pcmcia_debug) {
    600  1.53   mycroft 		SIMPLEQ_FOREACH(tmp, &sc->card.pf_head, pf_list) {
    601  1.12      marc 			printf("%s: function %d CCR at %d offset %lx: "
    602  1.12      marc 			       "%x %x %x %x, %x %x %x %x, %x\n",
    603  1.12      marc 			       tmp->sc->dev.dv_xname, tmp->number,
    604  1.15   aymeric 			       tmp->pf_ccr_window,
    605  1.15   aymeric 			       (unsigned long) tmp->pf_ccr_offset,
    606  1.43   mycroft 			       pcmcia_ccr_read(tmp, 0),
    607  1.43   mycroft 			       pcmcia_ccr_read(tmp, 1),
    608  1.43   mycroft 			       pcmcia_ccr_read(tmp, 2),
    609  1.43   mycroft 			       pcmcia_ccr_read(tmp, 3),
    610  1.43   mycroft 
    611  1.43   mycroft 			       pcmcia_ccr_read(tmp, 5),
    612  1.73     perry 			       pcmcia_ccr_read(tmp, 6),
    613  1.43   mycroft 			       pcmcia_ccr_read(tmp, 7),
    614  1.43   mycroft 			       pcmcia_ccr_read(tmp, 8),
    615   1.5      marc 
    616  1.43   mycroft 			       pcmcia_ccr_read(tmp, 9));
    617  1.12      marc 		}
    618  1.12      marc 	}
    619  1.12      marc #endif
    620   1.5      marc 
    621  1.21       uch #ifdef IT8368E_LEGACY_MODE
    622  1.21       uch 	/* return to I/O mode */
    623  1.21       uch 	it8368_mode(pf, IT8368_IO_MODE, IT8368_WIDTH_16);
    624  1.21       uch #endif
    625  1.66   mycroft 
    626  1.66   mycroft 	pf->pf_flags |= PFF_ENABLED;
    627   1.2   thorpej 	return (0);
    628   1.2   thorpej 
    629  1.55   mycroft bad:
    630   1.2   thorpej 	/*
    631   1.2   thorpej 	 * Decrement the reference count, and power down the socket, if
    632   1.2   thorpej 	 * necessary.
    633   1.2   thorpej 	 */
    634  1.55   mycroft 	printf("%s: couldn't map the CCR\n", pf->child->dv_xname);
    635  1.59   mycroft 	pcmcia_socket_disable(&sc->dev);
    636   1.5      marc 
    637  1.55   mycroft 	return (error);
    638   1.2   thorpej }
    639   1.2   thorpej 
    640   1.2   thorpej /* Disable PCMCIA function. */
    641   1.2   thorpej void
    642   1.2   thorpej pcmcia_function_disable(pf)
    643   1.2   thorpej 	struct pcmcia_function *pf;
    644   1.2   thorpej {
    645  1.59   mycroft 	struct pcmcia_softc *sc = pf->sc;
    646   1.2   thorpej 	struct pcmcia_function *tmp;
    647  1.48   mycroft 	int reg;
    648   1.2   thorpej 
    649   1.2   thorpej 	if (pf->cfe == NULL)
    650   1.2   thorpej 		panic("pcmcia_function_enable: function not initialized");
    651   1.2   thorpej 
    652   1.2   thorpej 	if ((pf->pf_flags & PFF_ENABLED) == 0) {
    653   1.2   thorpej 		/*
    654  1.36    briggs 		 * Don't do anything but decrement if we're already disabled.
    655   1.2   thorpej 		 */
    656  1.36    briggs 		goto out;
    657   1.2   thorpej 	}
    658   1.2   thorpej 
    659  1.69   mycroft 	if (pcmcia_mfc(sc) &&
    660  1.69   mycroft 	    (pf->pf_flags & PFF_DETACHED) == 0) {
    661  1.48   mycroft 		reg = pcmcia_ccr_read(pf, PCMCIA_CCR_OPTION);
    662  1.48   mycroft 		reg &= ~(PCMCIA_CCR_OPTION_FUNC_ENABLE|
    663  1.48   mycroft 			 PCMCIA_CCR_OPTION_ADDR_DECODE|
    664  1.48   mycroft 		         PCMCIA_CCR_OPTION_IREQ_ENABLE);
    665  1.48   mycroft 		pcmcia_ccr_write(pf, PCMCIA_CCR_OPTION, reg);
    666  1.48   mycroft 	}
    667  1.48   mycroft 
    668   1.2   thorpej 	/*
    669   1.2   thorpej 	 * it's possible for different functions' CCRs to be in the same
    670   1.2   thorpej 	 * underlying page.  Check for that.  Note we mark us as disabled
    671   1.2   thorpej 	 * first to avoid matching ourself.
    672   1.2   thorpej 	 */
    673   1.2   thorpej 
    674   1.2   thorpej 	pf->pf_flags &= ~PFF_ENABLED;
    675  1.59   mycroft 	SIMPLEQ_FOREACH(tmp, &sc->card.pf_head, pf_list) {
    676   1.2   thorpej 		if ((tmp->pf_flags & PFF_ENABLED) &&
    677   1.2   thorpej 		    (pf->ccr_base >= (tmp->ccr_base - tmp->pf_ccr_offset)) &&
    678   1.2   thorpej 		    ((pf->ccr_base + PCMCIA_CCR_SIZE) <=
    679   1.2   thorpej 		(tmp->ccr_base - tmp->pf_ccr_offset + tmp->pf_ccr_realsize)))
    680   1.2   thorpej 			break;
    681   1.2   thorpej 	}
    682   1.2   thorpej 
    683   1.2   thorpej 	/* Not used by anyone else; unmap the CCR. */
    684   1.2   thorpej 	if (tmp == NULL) {
    685   1.2   thorpej 		pcmcia_mem_unmap(pf, pf->pf_ccr_window);
    686   1.2   thorpej 		pcmcia_mem_free(pf, &pf->pf_pcmh);
    687   1.2   thorpej 	}
    688   1.2   thorpej 
    689  1.36    briggs out:
    690   1.2   thorpej 	/*
    691   1.2   thorpej 	 * Decrement the reference count, and power down the socket, if
    692   1.2   thorpej 	 * necessary.
    693   1.2   thorpej 	 */
    694  1.59   mycroft 	pcmcia_socket_disable(&sc->dev);
    695   1.2   thorpej }
    696   1.2   thorpej 
    697   1.2   thorpej int
    698  1.41   mycroft pcmcia_io_map(pf, width, pcihp, windowp)
    699   1.2   thorpej 	struct pcmcia_function *pf;
    700   1.2   thorpej 	int width;
    701   1.2   thorpej 	struct pcmcia_io_handle *pcihp;
    702   1.2   thorpej 	int *windowp;
    703   1.2   thorpej {
    704  1.68   mycroft 	struct pcmcia_softc *sc = pf->sc;
    705  1.49   mycroft 	int error;
    706   1.2   thorpej 
    707  1.49   mycroft 	if (pf->pf_flags & PFF_ENABLED)
    708  1.51   mycroft 		printf("pcmcia_io_map: function is enabled!\n");
    709  1.49   mycroft 
    710  1.68   mycroft 	error = pcmcia_chip_io_map(sc->pct, sc->pch,
    711  1.49   mycroft 	    width, 0, pcihp->size, pcihp, windowp);
    712  1.49   mycroft 	if (error)
    713  1.49   mycroft 		return (error);
    714   1.2   thorpej 
    715   1.2   thorpej 	/*
    716   1.2   thorpej 	 * XXX in the multifunction multi-iospace-per-function case, this
    717   1.2   thorpej 	 * needs to cooperate with io_alloc to make sure that the spaces
    718   1.2   thorpej 	 * don't overlap, and that the ccr's are set correctly
    719   1.2   thorpej 	 */
    720   1.2   thorpej 
    721  1.68   mycroft 	if (pcmcia_mfc(sc) || 1) {
    722  1.65   mycroft 		bus_addr_t iobase = pcihp->addr;
    723  1.65   mycroft 		bus_addr_t iomax = pcihp->addr + pcihp->size - 1;
    724   1.5      marc 
    725  1.65   mycroft 		DPRINTF(("window iobase %lx iomax %lx\n", (long)iobase,
    726  1.65   mycroft 		    (long)iomax));
    727  1.65   mycroft 		if (pf->pf_mfc_iobase == 0) {
    728  1.65   mycroft 			pf->pf_mfc_iobase = iobase;
    729  1.65   mycroft 			pf->pf_mfc_iomax = iomax;
    730  1.65   mycroft 		} else {
    731  1.65   mycroft 			if (iobase < pf->pf_mfc_iobase)
    732  1.65   mycroft 				pf->pf_mfc_iobase = iobase;
    733  1.65   mycroft 			if (iomax > pf->pf_mfc_iomax)
    734  1.65   mycroft 				pf->pf_mfc_iomax = iomax;
    735  1.65   mycroft 		}
    736  1.65   mycroft 		DPRINTF(("function iobase %lx iomax %lx\n",
    737  1.65   mycroft 		    (long)pf->pf_mfc_iobase, (long)pf->pf_mfc_iomax));
    738   1.2   thorpej 	}
    739  1.41   mycroft 
    740   1.2   thorpej 	return (0);
    741  1.11   thorpej }
    742  1.11   thorpej 
    743  1.11   thorpej void
    744  1.11   thorpej pcmcia_io_unmap(pf, window)
    745  1.11   thorpej 	struct pcmcia_function *pf;
    746  1.11   thorpej 	int window;
    747  1.11   thorpej {
    748  1.68   mycroft 	struct pcmcia_softc *sc = pf->sc;
    749  1.11   thorpej 
    750  1.49   mycroft 	if (pf->pf_flags & PFF_ENABLED)
    751  1.51   mycroft 		printf("pcmcia_io_unmap: function is enabled!\n");
    752  1.49   mycroft 
    753  1.68   mycroft 	pcmcia_chip_io_unmap(sc->pct, sc->pch, window);
    754   1.2   thorpej }
    755   1.2   thorpej 
    756   1.2   thorpej void *
    757   1.2   thorpej pcmcia_intr_establish(pf, ipl, ih_fct, ih_arg)
    758   1.2   thorpej 	struct pcmcia_function *pf;
    759   1.2   thorpej 	int ipl;
    760  1.72     perry 	int (*ih_fct)(void *);
    761   1.2   thorpej 	void *ih_arg;
    762   1.2   thorpej {
    763   1.2   thorpej 
    764  1.49   mycroft 	if (pf->pf_flags & PFF_ENABLED)
    765  1.51   mycroft 		printf("pcmcia_intr_establish: function is enabled!\n");
    766  1.52   mycroft 	if (pf->pf_ih)
    767  1.52   mycroft 		panic("pcmcia_intr_establish: already done\n");
    768  1.49   mycroft 
    769  1.52   mycroft 	pf->pf_ih = pcmcia_chip_intr_establish(pf->sc->pct, pf->sc->pch,
    770  1.52   mycroft 	    pf, ipl, ih_fct, ih_arg);
    771  1.55   mycroft 	if (!pf->pf_ih)
    772  1.55   mycroft 		printf("%s: interrupt establish failed\n", pf->child->dv_xname);
    773  1.52   mycroft 	return (pf->pf_ih);
    774   1.2   thorpej }
    775   1.2   thorpej 
    776   1.2   thorpej void
    777   1.2   thorpej pcmcia_intr_disestablish(pf, ih)
    778   1.2   thorpej 	struct pcmcia_function *pf;
    779   1.2   thorpej 	void *ih;
    780   1.2   thorpej {
    781  1.52   mycroft 
    782  1.49   mycroft 	if (pf->pf_flags & PFF_ENABLED)
    783  1.51   mycroft 		printf("pcmcia_intr_disestablish: function is enabled!\n");
    784  1.52   mycroft 	if (!pf->pf_ih)
    785  1.52   mycroft 		panic("pcmcia_intr_distestablish: already done\n");
    786  1.49   mycroft 
    787  1.52   mycroft 	pcmcia_chip_intr_disestablish(pf->sc->pct, pf->sc->pch, ih);
    788  1.52   mycroft 	pf->pf_ih = 0;
    789   1.2   thorpej }
    790  1.53   mycroft 
    791  1.53   mycroft int
    792  1.53   mycroft pcmcia_config_alloc(pf, cfe)
    793  1.53   mycroft 	struct pcmcia_function *pf;
    794  1.53   mycroft 	struct pcmcia_config_entry *cfe;
    795  1.53   mycroft {
    796  1.61   mycroft 	int error = 0;
    797  1.53   mycroft 	int n, m;
    798  1.53   mycroft 
    799  1.53   mycroft 	for (n = 0; n < cfe->num_iospace; n++) {
    800  1.53   mycroft 		bus_addr_t start = cfe->iospace[n].start;
    801  1.53   mycroft 		bus_size_t length = cfe->iospace[n].length;
    802  1.53   mycroft 		bus_size_t align = cfe->iomask ? (1 << cfe->iomask) :
    803  1.53   mycroft 		    length;
    804  1.53   mycroft 		bus_size_t skew = start & (align - 1);
    805  1.53   mycroft 
    806  1.54   mycroft 		if ((start - skew) == 0 && align < 0x400) {
    807  1.54   mycroft 			if (skew)
    808  1.54   mycroft 				printf("Drats!  I need a skew!\n");
    809  1.53   mycroft 			start = 0;
    810  1.54   mycroft 		}
    811  1.53   mycroft 
    812  1.53   mycroft 		DPRINTF(("pcmcia_config_alloc: io %d start=%lx length=%lx align=%lx skew=%lx\n",
    813  1.53   mycroft 		    n, (long)start, (long)length, (long)align, (long)skew));
    814  1.53   mycroft 
    815  1.53   mycroft 		error = pcmcia_io_alloc(pf, start, length, align,
    816  1.53   mycroft 		    &cfe->iospace[n].handle);
    817  1.53   mycroft 		if (error)
    818  1.53   mycroft 			break;
    819  1.53   mycroft 	}
    820  1.53   mycroft 	if (n < cfe->num_iospace) {
    821  1.53   mycroft 		for (m = 0; m < n; m++)
    822  1.53   mycroft 			pcmcia_io_free(pf, &cfe->iospace[m].handle);
    823  1.53   mycroft 		return (error);
    824  1.53   mycroft 	}
    825  1.53   mycroft 
    826  1.53   mycroft 	for (n = 0; n < cfe->num_memspace; n++) {
    827  1.53   mycroft 		bus_size_t length = cfe->memspace[n].length;
    828  1.53   mycroft 
    829  1.53   mycroft 		DPRINTF(("pcmcia_config_alloc: mem %d length %lx\n", n,
    830  1.53   mycroft 		    (long)length));
    831  1.53   mycroft 
    832  1.53   mycroft 		error = pcmcia_mem_alloc(pf, length, &cfe->memspace[n].handle);
    833  1.53   mycroft 		if (error)
    834  1.53   mycroft 			break;
    835  1.53   mycroft 	}
    836  1.53   mycroft 	if (n < cfe->num_memspace) {
    837  1.53   mycroft 		for (m = 0; m < cfe->num_iospace; m++)
    838  1.53   mycroft 			pcmcia_io_free(pf, &cfe->iospace[m].handle);
    839  1.53   mycroft 		for (m = 0; m < n; m++)
    840  1.53   mycroft 			pcmcia_mem_free(pf, &cfe->memspace[m].handle);
    841  1.53   mycroft 		return (error);
    842  1.53   mycroft 	}
    843  1.53   mycroft 
    844  1.53   mycroft 	/* This one's good! */
    845  1.61   mycroft 	return (error);
    846  1.53   mycroft }
    847  1.53   mycroft 
    848  1.53   mycroft void
    849  1.53   mycroft pcmcia_config_free(pf)
    850  1.53   mycroft 	struct pcmcia_function *pf;
    851  1.53   mycroft {
    852  1.53   mycroft 	struct pcmcia_config_entry *cfe = pf->cfe;
    853  1.53   mycroft 	int m;
    854  1.53   mycroft 
    855  1.53   mycroft 	for (m = 0; m < cfe->num_iospace; m++)
    856  1.53   mycroft 		pcmcia_io_free(pf, &cfe->iospace[m].handle);
    857  1.53   mycroft 	for (m = 0; m < cfe->num_memspace; m++)
    858  1.53   mycroft 		pcmcia_mem_free(pf, &cfe->memspace[m].handle);
    859  1.53   mycroft }
    860  1.53   mycroft 
    861  1.53   mycroft int
    862  1.53   mycroft pcmcia_config_map(pf)
    863  1.53   mycroft 	struct pcmcia_function *pf;
    864  1.53   mycroft {
    865  1.53   mycroft 	struct pcmcia_config_entry *cfe = pf->cfe;
    866  1.61   mycroft 	int error = 0;
    867  1.53   mycroft 	int n, m;
    868  1.53   mycroft 
    869  1.53   mycroft 	for (n = 0; n < cfe->num_iospace; n++) {
    870  1.53   mycroft 		int width;
    871  1.53   mycroft 
    872  1.62   mycroft 		if (cfe->flags & PCMCIA_CFE_IO16)
    873  1.62   mycroft 			width = PCMCIA_WIDTH_AUTO;
    874  1.62   mycroft 		else
    875  1.53   mycroft 			width = PCMCIA_WIDTH_IO8;
    876  1.53   mycroft 		error = pcmcia_io_map(pf, width, &cfe->iospace[n].handle,
    877  1.53   mycroft 		    &cfe->iospace[n].window);
    878  1.53   mycroft 		if (error)
    879  1.53   mycroft 			break;
    880  1.53   mycroft 	}
    881  1.53   mycroft 	if (n < cfe->num_iospace) {
    882  1.53   mycroft 		for (m = 0; m < n; m++)
    883  1.53   mycroft 			pcmcia_io_unmap(pf, cfe->iospace[m].window);
    884  1.53   mycroft 		return (error);
    885  1.53   mycroft 	}
    886  1.53   mycroft 
    887  1.53   mycroft 	for (n = 0; n < cfe->num_memspace; n++) {
    888  1.53   mycroft 		bus_size_t length = cfe->memspace[n].length;
    889  1.53   mycroft 		int width;
    890  1.53   mycroft 
    891  1.53   mycroft 		DPRINTF(("pcmcia_config_alloc: mem %d length %lx\n", n,
    892  1.53   mycroft 		    (long)length));
    893  1.53   mycroft 
    894  1.53   mycroft 		/*XXX*/
    895  1.53   mycroft 		width = PCMCIA_WIDTH_MEM8|PCMCIA_MEM_COMMON;
    896  1.53   mycroft 		error = pcmcia_mem_map(pf, width, 0, length,
    897  1.53   mycroft 		    &cfe->memspace[n].handle, &cfe->memspace[n].offset,
    898  1.53   mycroft 		    &cfe->memspace[n].window);
    899  1.53   mycroft 		if (error)
    900  1.53   mycroft 			break;
    901  1.53   mycroft 	}
    902  1.53   mycroft 	if (n < cfe->num_memspace) {
    903  1.53   mycroft 		for (m = 0; m < cfe->num_iospace; m++)
    904  1.53   mycroft 			pcmcia_io_unmap(pf, cfe->iospace[m].window);
    905  1.53   mycroft 		for (m = 0; m < n; m++)
    906  1.53   mycroft 			pcmcia_mem_unmap(pf, cfe->memspace[m].window);
    907  1.53   mycroft 		return (error);
    908  1.53   mycroft 	}
    909  1.53   mycroft 
    910  1.53   mycroft 	/* This one's good! */
    911  1.61   mycroft 	return (error);
    912  1.53   mycroft }
    913  1.53   mycroft 
    914  1.53   mycroft void
    915  1.53   mycroft pcmcia_config_unmap(pf)
    916  1.53   mycroft 	struct pcmcia_function *pf;
    917  1.53   mycroft {
    918  1.53   mycroft 	struct pcmcia_config_entry *cfe = pf->cfe;
    919  1.53   mycroft 	int m;
    920  1.53   mycroft 
    921  1.53   mycroft 	for (m = 0; m < cfe->num_iospace; m++)
    922  1.53   mycroft 		pcmcia_io_unmap(pf, cfe->iospace[m].window);
    923  1.53   mycroft 	for (m = 0; m < cfe->num_memspace; m++)
    924  1.53   mycroft 		pcmcia_mem_unmap(pf, cfe->memspace[m].window);
    925  1.53   mycroft }
    926  1.53   mycroft 
    927  1.53   mycroft int
    928  1.53   mycroft pcmcia_function_configure(pf, validator)
    929  1.53   mycroft 	struct pcmcia_function *pf;
    930  1.72     perry 	int (*validator)(struct pcmcia_config_entry *);
    931  1.53   mycroft {
    932  1.53   mycroft 	struct pcmcia_config_entry *cfe;
    933  1.53   mycroft 	int error = ENOENT;
    934  1.53   mycroft 
    935  1.53   mycroft 	SIMPLEQ_FOREACH(cfe, &pf->cfe_head, cfe_list) {
    936  1.53   mycroft 		error = validator(cfe);
    937  1.53   mycroft 		if (error)
    938  1.53   mycroft 			continue;
    939  1.53   mycroft 		error = pcmcia_config_alloc(pf, cfe);
    940  1.53   mycroft 		if (!error)
    941  1.53   mycroft 			break;
    942  1.53   mycroft 	}
    943  1.53   mycroft 	if (!cfe) {
    944  1.53   mycroft 		DPRINTF(("pcmcia_function_configure: no config entry found, error=%d\n",
    945  1.53   mycroft 		    error));
    946  1.53   mycroft 		return (error);
    947  1.53   mycroft 	}
    948  1.53   mycroft 
    949  1.53   mycroft 	/* Remember which configuration entry we are using. */
    950  1.53   mycroft 	pf->cfe = cfe;
    951  1.53   mycroft 
    952  1.53   mycroft 	error = pcmcia_config_map(pf);
    953  1.53   mycroft 	if (error) {
    954  1.53   mycroft 		DPRINTF(("pcmcia_function_configure: map failed, error=%d\n",
    955  1.53   mycroft 		    error));
    956  1.53   mycroft 		return (error);
    957  1.53   mycroft 	}
    958  1.53   mycroft 
    959  1.53   mycroft 	return (0);
    960  1.53   mycroft }
    961  1.53   mycroft 
    962  1.53   mycroft void
    963  1.53   mycroft pcmcia_function_unconfigure(pf)
    964  1.53   mycroft 	struct pcmcia_function *pf;
    965  1.53   mycroft {
    966  1.53   mycroft 
    967  1.53   mycroft 	pcmcia_config_unmap(pf);
    968  1.53   mycroft 	pcmcia_config_free(pf);
    969  1.53   mycroft }
    970