Home | History | Annotate | Line # | Download | only in gemini
gemini_pci.c revision 1.17.6.1
      1  1.17.6.1     skrll /*	$NetBSD: gemini_pci.c,v 1.17.6.1 2015/12/27 12:09:30 skrll Exp $	*/
      2       1.1      matt 
      3       1.1      matt /* adapted from:
      4       1.1      matt  *	NetBSD: i80312_pci.c,v 1.9 2005/12/11 12:16:51 christos Exp
      5       1.1      matt  */
      6       1.1      matt 
      7       1.1      matt /*
      8       1.1      matt  * Copyright (c) 2001 Wasabi Systems, Inc.
      9       1.1      matt  * All rights reserved.
     10       1.1      matt  *
     11       1.1      matt  * Written by Jason R. Thorpe for Wasabi Systems, Inc.
     12       1.1      matt  *
     13       1.1      matt  * Redistribution and use in source and binary forms, with or without
     14       1.1      matt  * modification, are permitted provided that the following conditions
     15       1.1      matt  * are met:
     16       1.1      matt  * 1. Redistributions of source code must retain the above copyright
     17       1.1      matt  *    notice, this list of conditions and the following disclaimer.
     18       1.1      matt  * 2. Redistributions in binary form must reproduce the above copyright
     19       1.1      matt  *    notice, this list of conditions and the following disclaimer in the
     20       1.1      matt  *    documentation and/or other materials provided with the distribution.
     21       1.1      matt  * 3. All advertising materials mentioning features or use of this software
     22       1.1      matt  *    must display the following acknowledgement:
     23       1.1      matt  *	This product includes software developed for the NetBSD Project by
     24       1.1      matt  *	Wasabi Systems, Inc.
     25       1.1      matt  * 4. The name of Wasabi Systems, Inc. may not be used to endorse
     26       1.1      matt  *    or promote products derived from this software without specific prior
     27       1.1      matt  *    written permission.
     28       1.1      matt  *
     29       1.1      matt  * THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``AS IS'' AND
     30       1.1      matt  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     31       1.1      matt  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     32       1.1      matt  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL WASABI SYSTEMS, INC
     33       1.1      matt  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     34       1.1      matt  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     35       1.1      matt  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     36       1.1      matt  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     37       1.1      matt  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     38       1.1      matt  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     39       1.1      matt  * POSSIBILITY OF SUCH DAMAGE.
     40       1.1      matt  */
     41       1.1      matt 
     42       1.1      matt /*
     43       1.1      matt  * PCI configuration support for i80312 Companion I/O chip.
     44       1.1      matt  */
     45       1.1      matt 
     46       1.1      matt #include <sys/cdefs.h>
     47  1.17.6.1     skrll __KERNEL_RCSID(0, "$NetBSD: gemini_pci.c,v 1.17.6.1 2015/12/27 12:09:30 skrll Exp $");
     48       1.1      matt 
     49      1.15      matt #include "opt_gemini.h"
     50      1.15      matt #include "opt_pci.h"
     51      1.15      matt #include "pci.h"
     52       1.1      matt 
     53       1.1      matt #include <sys/param.h>
     54       1.1      matt #include <sys/systm.h>
     55       1.1      matt #include <sys/device.h>
     56       1.1      matt #include <sys/extent.h>
     57       1.1      matt #include <sys/malloc.h>
     58      1.15      matt #include <sys/bus.h>
     59      1.15      matt #include <sys/intr.h>
     60       1.1      matt 
     61       1.1      matt #include <uvm/uvm_extern.h>
     62       1.1      matt 
     63      1.15      matt #include <dev/pci/pcivar.h>
     64      1.15      matt #include <dev/pci/pcidevs.h>
     65      1.15      matt #include <dev/pci/pciconf.h>
     66      1.15      matt 
     67      1.15      matt #include <arm/locore.h>
     68       1.1      matt 
     69       1.1      matt #include <arm/pic/picvar.h>
     70       1.1      matt 
     71       1.1      matt #include <arm/gemini/gemini_reg.h>
     72       1.1      matt #include <arm/gemini/gemini_pcivar.h>
     73       1.1      matt #include <arm/gemini/gemini_obiovar.h>
     74       1.1      matt 
     75      1.14       chs void		gemini_pci_attach_hook(device_t, device_t,
     76       1.1      matt 		    struct pcibus_attach_args *);
     77       1.1      matt int		gemini_pci_bus_maxdevs(void *, int);
     78       1.1      matt pcitag_t	gemini_pci_make_tag(void *, int, int, int);
     79       1.1      matt void		gemini_pci_decompose_tag(void *, pcitag_t, int *, int *,
     80       1.1      matt 		    int *);
     81       1.1      matt pcireg_t	gemini_pci_conf_read(void *, pcitag_t, int);
     82       1.1      matt void		gemini_pci_conf_write(void *, pcitag_t, int, pcireg_t);
     83      1.12      matt int		gemini_pci_conf_hook(void *, int, int, int, pcireg_t);
     84      1.13      matt void		gemini_pci_conf_interrupt(void *, int, int, int, int, int *);
     85       1.1      matt 
     86       1.9    dyoung int		gemini_pci_intr_map(const struct pci_attach_args *,
     87       1.1      matt 		    pci_intr_handle_t *);
     88      1.17  christos const char	*gemini_pci_intr_string(void *, pci_intr_handle_t,
     89      1.17  christos 		    char *, size_t);
     90       1.1      matt const struct evcnt *gemini_pci_intr_evcnt(void *, pci_intr_handle_t);
     91       1.1      matt void		*gemini_pci_intr_establish(void *, pci_intr_handle_t,
     92       1.1      matt 		    int, int (*)(void *), void *);
     93       1.1      matt void		gemini_pci_intr_disestablish(void *, void *);
     94       1.1      matt int		gemini_pci_intr_handler(void *v);
     95       1.1      matt 
     96       1.1      matt #define	PCI_CONF_LOCK(s)	(s) = disable_interrupts(I32_bit)
     97       1.1      matt #define	PCI_CONF_UNLOCK(s)	restore_interrupts((s))
     98       1.1      matt 
     99       1.1      matt struct gemini_pci_intrq {
    100       1.1      matt 	SIMPLEQ_ENTRY(gemini_pci_intrq) iq_q;
    101       1.1      matt 	int (*iq_func)(void *);
    102       1.1      matt 	void *iq_arg;
    103       1.1      matt 	void *iq_ih;
    104       1.1      matt };
    105       1.1      matt 
    106       1.1      matt static SIMPLEQ_HEAD(, gemini_pci_intrq) gemini_pci_intrq =
    107       1.1      matt 	SIMPLEQ_HEAD_INITIALIZER(gemini_pci_intrq);
    108       1.1      matt 
    109       1.1      matt static inline int
    110       1.1      matt gemini_pci_intrq_empty(void)
    111       1.1      matt {
    112       1.1      matt 	return SIMPLEQ_EMPTY(&gemini_pci_intrq);
    113       1.1      matt }
    114       1.1      matt 
    115       1.1      matt static inline void *
    116       1.1      matt gemini_pci_intrq_insert(void *ih, int (*func)(void *), void *arg)
    117       1.1      matt {
    118       1.1      matt 	struct gemini_pci_intrq *iqp;
    119       1.1      matt 
    120       1.1      matt         iqp = malloc(sizeof(*iqp), M_DEVBUF, M_NOWAIT|M_ZERO);
    121       1.1      matt         if (iqp == NULL) {
    122       1.1      matt 		printf("gemini_pci_intrq_insert: malloc failed\n");
    123       1.1      matt 		return NULL;
    124       1.1      matt 	}
    125       1.1      matt 
    126       1.1      matt         iqp->iq_func = func;
    127       1.1      matt         iqp->iq_arg = arg;
    128       1.1      matt         iqp->iq_ih = ih;
    129       1.1      matt         SIMPLEQ_INSERT_TAIL(&gemini_pci_intrq, iqp, iq_q);
    130       1.1      matt 
    131       1.1      matt 	return (void *)iqp;
    132       1.1      matt }
    133       1.1      matt 
    134       1.1      matt static inline void
    135       1.1      matt gemini_pci_intrq_remove(void *cookie)
    136       1.1      matt {
    137       1.1      matt 	struct gemini_pci_intrq *iqp;
    138       1.1      matt 
    139       1.1      matt 	SIMPLEQ_FOREACH(iqp, &gemini_pci_intrq, iq_q) {
    140       1.1      matt 		if ((void *)iqp == cookie) {
    141       1.1      matt 			SIMPLEQ_REMOVE(&gemini_pci_intrq,
    142       1.1      matt 				iqp, gemini_pci_intrq, iq_q);
    143       1.1      matt 			free(iqp, M_DEVBUF);
    144       1.1      matt 			return;
    145       1.1      matt 		}
    146       1.1      matt 	}
    147       1.1      matt }
    148       1.1      matt 
    149       1.1      matt static inline int
    150       1.1      matt gemini_pci_intrq_dispatch(void)
    151       1.1      matt {
    152       1.1      matt 	struct gemini_pci_intrq *iqp;
    153       1.1      matt 
    154       1.1      matt 	SIMPLEQ_FOREACH(iqp, &gemini_pci_intrq, iq_q) {
    155       1.1      matt 		(*iqp->iq_func)(iqp->iq_arg);
    156       1.1      matt 	}
    157       1.1      matt 
    158       1.1      matt 	return 1;
    159       1.1      matt }
    160       1.1      matt 
    161       1.1      matt void
    162       1.1      matt gemini_pci_init(pci_chipset_tag_t pc, void *cookie)
    163       1.1      matt {
    164       1.1      matt #if NPCI > 0 && defined(PCI_NETBSD_CONFIGURE)
    165       1.1      matt 	struct obio_softc *sc = cookie;
    166       1.1      matt 	struct extent *ioext, *memext;
    167       1.1      matt #endif
    168       1.1      matt 
    169       1.1      matt 	pc->pc_conf_v = cookie;
    170       1.1      matt 	pc->pc_attach_hook = gemini_pci_attach_hook;
    171       1.1      matt 	pc->pc_bus_maxdevs = gemini_pci_bus_maxdevs;
    172       1.1      matt 	pc->pc_make_tag = gemini_pci_make_tag;
    173       1.1      matt 	pc->pc_decompose_tag = gemini_pci_decompose_tag;
    174       1.1      matt 	pc->pc_conf_read = gemini_pci_conf_read;
    175       1.1      matt 	pc->pc_conf_write = gemini_pci_conf_write;
    176       1.1      matt 
    177       1.1      matt 	pc->pc_intr_v = cookie;
    178       1.1      matt 	pc->pc_intr_map = gemini_pci_intr_map;
    179       1.1      matt 	pc->pc_intr_string = gemini_pci_intr_string;
    180       1.1      matt 	pc->pc_intr_evcnt = gemini_pci_intr_evcnt;
    181       1.1      matt 	pc->pc_intr_establish = gemini_pci_intr_establish;
    182       1.1      matt 	pc->pc_intr_disestablish = gemini_pci_intr_disestablish;
    183       1.1      matt 
    184       1.1      matt 	pc->pc_conf_hook = gemini_pci_conf_hook;
    185      1.12      matt 	pc->pc_conf_interrupt = gemini_pci_conf_interrupt;
    186       1.1      matt 
    187       1.1      matt 	/*
    188       1.1      matt 	 * initialize copy of CFG_CMD
    189       1.1      matt 	 */
    190       1.1      matt 	sc->sc_pci_chipset.pc_cfg_cmd =
    191       1.1      matt 		gemini_pci_conf_read(sc, 0, GEMINI_PCI_CFG_CMD);
    192       1.1      matt 
    193       1.1      matt #if NPCI > 0 && defined(PCI_NETBSD_CONFIGURE)
    194       1.1      matt 	/*
    195       1.1      matt 	 * Configure the PCI bus.
    196       1.1      matt 	 *
    197       1.1      matt 	 * XXX We need to revisit this.  We only configure the Secondary
    198       1.1      matt 	 * bus (and its children).  The bus configure code needs changes
    199       1.1      matt 	 * to support how the busses are arranged on this chip.  We also
    200       1.1      matt 	 * need to only configure devices in the private device space on
    201       1.1      matt 	 * the Secondary bus.
    202       1.1      matt 	 */
    203       1.1      matt 
    204       1.1      matt 	aprint_normal("%s: configuring Secondary PCI bus\n",
    205       1.6     cliff 		device_xname(sc->sc_dev));
    206       1.1      matt 
    207       1.1      matt 	/*
    208       1.2     cliff 	 * XXX PCI IO addr should be inherited ?
    209       1.1      matt 	 */
    210       1.1      matt 	ioext  = extent_create("pciio",
    211       1.1      matt 		GEMINI_PCIIO_BASE,
    212       1.1      matt 		GEMINI_PCIIO_BASE + GEMINI_PCIIO_SIZE - 1,
    213      1.11      para 		NULL, 0, EX_NOWAIT);
    214       1.1      matt 
    215       1.1      matt 	/*
    216       1.1      matt 	 * XXX PCI mem addr should be inherited ?
    217       1.1      matt 	 */
    218       1.1      matt 	memext = extent_create("pcimem",
    219       1.1      matt 		GEMINI_PCIMEM_BASE,
    220       1.1      matt 		GEMINI_PCIMEM_BASE + GEMINI_PCIMEM_SIZE - 1,
    221      1.11      para 		NULL, 0, EX_NOWAIT);
    222       1.1      matt 
    223       1.1      matt 	pci_configure_bus(pc, ioext, memext, NULL, 0, arm_dcache_align);
    224       1.1      matt 
    225       1.4     cliff 	gemini_pci_conf_write(sc, 0, GEMINI_PCI_CFG_REG_MEM1,
    226       1.5     cliff 		PCI_CFG_REG_MEM_BASE((GEMINI_DRAM_BASE + (GEMINI_BUSBASE * 1024 * 1024)))
    227       1.5     cliff 		| gemini_pci_cfg_reg_mem_size(MEMSIZE * 1024 * 1024));
    228       1.1      matt 
    229       1.1      matt 	extent_destroy(ioext);
    230       1.1      matt 	extent_destroy(memext);
    231       1.1      matt #endif
    232       1.1      matt }
    233       1.1      matt 
    234       1.1      matt void
    235      1.12      matt gemini_pci_conf_interrupt(void *v, int a, int b, int c, int d, int *p)
    236       1.1      matt {
    237       1.1      matt }
    238       1.1      matt 
    239       1.1      matt int
    240      1.12      matt gemini_pci_conf_hook(void *v, int bus, int device, int function, pcireg_t id)
    241       1.1      matt {
    242       1.1      matt 	int rv;
    243       1.1      matt 
    244       1.1      matt 	rv = PCI_CONF_ALL;
    245       1.1      matt 
    246       1.1      matt 	return rv;
    247       1.1      matt }
    248       1.1      matt 
    249       1.1      matt void
    250      1.14       chs gemini_pci_attach_hook(device_t parent, device_t self,
    251       1.1      matt 	struct pcibus_attach_args *pba)
    252       1.1      matt {
    253       1.1      matt 	/* Nothing to do. */
    254       1.1      matt }
    255       1.1      matt 
    256       1.1      matt int
    257       1.1      matt gemini_pci_bus_maxdevs(void *v, int busno)
    258       1.1      matt {
    259       1.1      matt 	return (32);
    260       1.1      matt }
    261       1.1      matt 
    262       1.1      matt pcitag_t
    263       1.1      matt gemini_pci_make_tag(void *v, int b, int d, int f)
    264       1.1      matt {
    265       1.1      matt 	return ((b << 16) | (d << 11) | (f << 8));
    266       1.1      matt }
    267       1.1      matt 
    268       1.1      matt void
    269       1.1      matt gemini_pci_decompose_tag(void *v, pcitag_t tag, int *bp, int *dp, int *fp)
    270       1.1      matt {
    271       1.1      matt 	if (bp != NULL)
    272       1.1      matt 		*bp = (tag >> 16) & 0xff;
    273       1.1      matt 	if (dp != NULL)
    274       1.1      matt 		*dp = (tag >> 11) & 0x1f;
    275       1.1      matt 	if (fp != NULL)
    276       1.1      matt 		*fp = (tag >> 8) & 0x7;
    277       1.1      matt }
    278       1.1      matt 
    279       1.1      matt struct pciconf_state {
    280       1.1      matt 	uint32_t ps_addr_val;
    281       1.1      matt 	int ps_b, ps_d, ps_f;
    282       1.1      matt };
    283       1.1      matt 
    284       1.1      matt static int
    285       1.1      matt gemini_pci_conf_setup(struct obio_softc *sc, pcitag_t tag, int offset,
    286       1.1      matt 	struct pciconf_state *ps)
    287       1.1      matt {
    288  1.17.6.1     skrll 
    289  1.17.6.1     skrll 	if ((unsigned int)offset >= PCI_CONF_SIZE)
    290  1.17.6.1     skrll 		return (1);
    291  1.17.6.1     skrll 
    292       1.1      matt 	gemini_pci_decompose_tag(sc, tag, &ps->ps_b, &ps->ps_d, &ps->ps_f);
    293       1.1      matt 
    294       1.1      matt 	ps->ps_addr_val =
    295       1.1      matt 		  PCI_CFG_CMD_ENB
    296       1.1      matt 		| PCI_CFG_CMD_BUSn(ps->ps_b)
    297       1.1      matt 		| PCI_CFG_CMD_DEVn(ps->ps_d)
    298       1.1      matt 		| PCI_CFG_CMD_FUNCn(ps->ps_f)
    299       1.1      matt 		| PCI_CFG_CMD_REGn(offset);
    300       1.1      matt 
    301       1.1      matt 	return (0);
    302       1.1      matt }
    303       1.1      matt 
    304       1.1      matt pcireg_t
    305       1.1      matt gemini_pci_conf_read(void *v, pcitag_t tag, int offset)
    306       1.1      matt {
    307       1.1      matt 	struct obio_softc *sc = v;
    308       1.1      matt 	struct pciconf_state ps;
    309       1.1      matt 	vaddr_t va;
    310       1.1      matt 	pcireg_t rv;
    311       1.1      matt 	u_int s;
    312       1.1      matt 
    313       1.1      matt 	if (gemini_pci_conf_setup(sc, tag, offset, &ps))
    314       1.1      matt 		return ((pcireg_t) -1);
    315       1.1      matt 
    316       1.1      matt 	PCI_CONF_LOCK(s);
    317       1.1      matt 
    318       1.1      matt 	if (sc->sc_pci_chipset.pc_cfg_cmd != ps.ps_addr_val) {
    319       1.1      matt 		sc->sc_pci_chipset.pc_cfg_cmd = ps.ps_addr_val;
    320       1.1      matt 		bus_space_write_4(sc->sc_iot, sc->sc_pcicfg_ioh,
    321       1.1      matt 			GEMINI_PCI_CFG_CMD, ps.ps_addr_val);
    322       1.1      matt 	}
    323       1.1      matt 
    324       1.1      matt 	va = (vaddr_t) bus_space_vaddr(sc->sc_iot, sc->sc_pcicfg_ioh);
    325       1.1      matt 	if (badaddr_read((void *) (va + GEMINI_PCI_CFG_DATA), sizeof(rv), &rv)) {
    326       1.1      matt 		/*
    327       1.1      matt 		 * XXX Clear the Master Abort
    328       1.1      matt 		 */
    329       1.1      matt #if 1
    330       1.1      matt 		printf("conf_read: %d/%d/%d bad address\n",
    331       1.1      matt 			ps.ps_b, ps.ps_d, ps.ps_f);
    332       1.1      matt #endif
    333       1.1      matt 		rv = (pcireg_t) -1;
    334       1.1      matt 	}
    335       1.1      matt 
    336       1.1      matt 	PCI_CONF_UNLOCK(s);
    337       1.1      matt 
    338       1.1      matt 	return (rv);
    339       1.1      matt }
    340       1.1      matt 
    341       1.1      matt void
    342       1.1      matt gemini_pci_conf_write(void *v, pcitag_t tag, int offset, pcireg_t val)
    343       1.1      matt {
    344       1.1      matt 	struct obio_softc *sc = v;
    345       1.1      matt 	struct pciconf_state ps;
    346       1.1      matt 	u_int s;
    347       1.1      matt 
    348       1.1      matt 	if (gemini_pci_conf_setup(sc, tag, offset, &ps))
    349       1.1      matt 		return;
    350       1.1      matt 
    351       1.1      matt 	PCI_CONF_LOCK(s);
    352       1.1      matt 
    353       1.1      matt 	if (sc->sc_pci_chipset.pc_cfg_cmd != ps.ps_addr_val) {
    354       1.1      matt 		sc->sc_pci_chipset.pc_cfg_cmd = ps.ps_addr_val;
    355       1.1      matt 		bus_space_write_4(sc->sc_iot, sc->sc_pcicfg_ioh,
    356       1.1      matt 			GEMINI_PCI_CFG_CMD, ps.ps_addr_val);
    357       1.1      matt 	}
    358       1.1      matt 
    359       1.1      matt 	bus_space_write_4(sc->sc_iot, sc->sc_pcicfg_ioh,
    360       1.1      matt 		GEMINI_PCI_CFG_DATA, val);
    361       1.1      matt 
    362       1.1      matt 	PCI_CONF_UNLOCK(s);
    363       1.1      matt }
    364       1.1      matt 
    365       1.1      matt int
    366       1.9    dyoung gemini_pci_intr_map(const struct pci_attach_args *pa, pci_intr_handle_t *ihp)
    367       1.1      matt {
    368       1.1      matt 	int irq;
    369       1.1      matt 
    370       1.1      matt 	irq = 8;
    371       1.1      matt 
    372       1.1      matt 	*ihp = irq;
    373       1.1      matt 	return 0;
    374       1.1      matt }
    375       1.1      matt 
    376       1.1      matt const char *
    377      1.16  christos gemini_pci_intr_string(void *v, pci_intr_handle_t ih, char *buf, size_t len)
    378       1.1      matt {
    379      1.16  christos 	strlcpy(buf, "pci", len);
    380      1.16  christos 	return buf;
    381       1.1      matt }
    382       1.1      matt 
    383       1.1      matt const struct evcnt *
    384       1.1      matt gemini_pci_intr_evcnt(void *v, pci_intr_handle_t ih)
    385       1.1      matt {
    386       1.1      matt 	return NULL;
    387       1.1      matt }
    388       1.1      matt 
    389       1.1      matt void *
    390       1.1      matt gemini_pci_intr_establish(void *v, pci_intr_handle_t pci_ih, int ipl,
    391       1.1      matt 	int (*func)(void *), void *arg)
    392       1.1      matt {
    393       1.1      matt 	pcireg_t r;
    394       1.1      matt 	void *ih=NULL;
    395       1.1      matt 	int irq;
    396       1.1      matt 	void *cookie;
    397       1.1      matt 
    398       1.1      matt 	irq = (int)pci_ih;
    399       1.1      matt 
    400       1.1      matt 	r = gemini_pci_conf_read(v, 0, GEMINI_PCI_CFG_REG_CTL2);
    401       1.1      matt 	r |= CFG_REG_CTL2_INTMASK_INT_ABCD;
    402       1.1      matt 	gemini_pci_conf_write(v, 0, GEMINI_PCI_CFG_REG_CTL2, r);
    403       1.1      matt 
    404       1.1      matt 	if (gemini_pci_intrq_empty())
    405       1.1      matt 		ih = intr_establish(irq, ipl, IST_LEVEL_HIGH,
    406       1.1      matt 			gemini_pci_intr_handler, v);
    407       1.1      matt 
    408       1.1      matt 	cookie = gemini_pci_intrq_insert(ih, func, arg);
    409       1.1      matt 	if (cookie == NULL) {
    410       1.1      matt 		if (gemini_pci_intrq_empty())
    411       1.1      matt 			intr_disestablish(ih);
    412       1.1      matt 	}
    413       1.1      matt 
    414       1.1      matt 	return cookie;
    415       1.1      matt }
    416       1.1      matt 
    417       1.1      matt void
    418       1.1      matt gemini_pci_intr_disestablish(void *v, void *cookie)
    419       1.1      matt {
    420       1.1      matt 	pcireg_t r;
    421       1.8   mbalmer 	struct gemini_pci_intrq *iqp = (struct gemini_pci_intrq *)cookie;
    422       1.1      matt 	void *ih = iqp->iq_ih;
    423       1.1      matt 
    424       1.1      matt 	gemini_pci_intrq_remove(cookie);
    425       1.1      matt 	if (gemini_pci_intrq_empty()) {
    426       1.1      matt 		r = gemini_pci_conf_read(v, 0, GEMINI_PCI_CFG_REG_CTL2);
    427       1.1      matt 		r &= ~CFG_REG_CTL2_INTMASK_INT_ABCD;
    428       1.1      matt 		gemini_pci_conf_write(v, 0, GEMINI_PCI_CFG_REG_CTL2, r);
    429       1.1      matt 		intr_disestablish(ih);
    430       1.1      matt 	}
    431       1.1      matt }
    432       1.1      matt 
    433       1.1      matt int
    434       1.1      matt gemini_pci_intr_handler(void *v)
    435       1.1      matt {
    436       1.1      matt 	pcireg_t r;
    437       1.1      matt 	int rv;
    438       1.1      matt 
    439       1.1      matt 	/*
    440       1.1      matt 	 * dispatch PCI device interrupt handlers
    441       1.1      matt 	 */
    442       1.1      matt 	rv = gemini_pci_intrq_dispatch();
    443       1.1      matt 
    444       1.1      matt 	/*
    445       1.1      matt 	 * ack Gemini PCI interrupts
    446       1.1      matt 	 */
    447       1.1      matt 	r = gemini_pci_conf_read(v, 0, GEMINI_PCI_CFG_REG_CTL2);
    448       1.1      matt 	gemini_pci_conf_write(v, 0, GEMINI_PCI_CFG_REG_CTL2, r);
    449       1.1      matt 
    450       1.1      matt 	return rv;
    451       1.1      matt }
    452