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