Home | History | Annotate | Line # | Download | only in gemini
gemini_pci.c revision 1.18.18.1
      1  1.18.18.1  christos /*	$NetBSD: gemini_pci.c,v 1.18.18.1 2019/06/10 22:05:53 christos 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.18.18.1  christos __KERNEL_RCSID(0, "$NetBSD: gemini_pci.c,v 1.18.18.1 2019/06/10 22:05:53 christos 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.18.18.1  christos 		    int, int (*)(void *), void *, const char *);
     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.18   msaitoh 
    289       1.18   msaitoh 	if ((unsigned int)offset >= PCI_CONF_SIZE)
    290       1.18   msaitoh 		return (1);
    291       1.18   msaitoh 
    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.18.18.1  christos 	int (*func)(void *), void *arg, const char *xname)
    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.18.18.1  christos 		ih = intr_establish_xname(irq, ipl, IST_LEVEL_HIGH,
    406  1.18.18.1  christos 			gemini_pci_intr_handler, v, xname);
    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