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