Home | History | Annotate | Line # | Download | only in dev
schizo.c revision 1.16
      1  1.16       mrg /*	$NetBSD: schizo.c,v 1.16 2010/03/11 03:54:56 mrg Exp $	*/
      2   1.1       mrg /*	$OpenBSD: schizo.c,v 1.55 2008/08/18 20:29:37 brad Exp $	*/
      3   1.1       mrg 
      4   1.1       mrg /*
      5   1.1       mrg  * Copyright (c) 2002 Jason L. Wright (jason (at) thought.net)
      6   1.1       mrg  * Copyright (c) 2003 Henric Jungheim
      7   1.1       mrg  * All rights reserved.
      8   1.1       mrg  *
      9   1.1       mrg  * Redistribution and use in source and binary forms, with or without
     10   1.1       mrg  * modification, are permitted provided that the following conditions
     11   1.1       mrg  * are met:
     12   1.1       mrg  * 1. Redistributions of source code must retain the above copyright
     13   1.1       mrg  *    notice, this list of conditions and the following disclaimer.
     14   1.1       mrg  * 2. Redistributions in binary form must reproduce the above copyright
     15   1.1       mrg  *    notice, this list of conditions and the following disclaimer in the
     16   1.1       mrg  *    documentation and/or other materials provided with the distribution.
     17   1.1       mrg  *
     18   1.1       mrg  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     19   1.1       mrg  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
     20   1.1       mrg  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
     21   1.1       mrg  * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
     22   1.1       mrg  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
     23   1.1       mrg  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
     24   1.1       mrg  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     25   1.1       mrg  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
     26   1.1       mrg  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
     27   1.1       mrg  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     28   1.1       mrg  * POSSIBILITY OF SUCH DAMAGE.
     29   1.1       mrg  */
     30   1.1       mrg 
     31   1.1       mrg #include <sys/param.h>
     32   1.1       mrg #include <sys/device.h>
     33   1.1       mrg #include <sys/errno.h>
     34   1.1       mrg #include <sys/extent.h>
     35   1.1       mrg #include <sys/malloc.h>
     36   1.1       mrg #include <sys/systm.h>
     37   1.1       mrg #include <sys/time.h>
     38   1.1       mrg #include <sys/reboot.h>
     39   1.1       mrg 
     40   1.1       mrg #define _SPARC_BUS_DMA_PRIVATE
     41   1.1       mrg #include <machine/bus.h>
     42   1.1       mrg #include <machine/autoconf.h>
     43   1.1       mrg #include <machine/psl.h>
     44   1.1       mrg 
     45   1.1       mrg #include <dev/pci/pcivar.h>
     46   1.1       mrg #include <dev/pci/pcireg.h>
     47   1.1       mrg 
     48   1.1       mrg #include <sparc64/dev/iommureg.h>
     49   1.1       mrg #include <sparc64/dev/iommuvar.h>
     50   1.1       mrg #include <sparc64/dev/schizoreg.h>
     51   1.1       mrg #include <sparc64/dev/schizovar.h>
     52   1.1       mrg #include <sparc64/sparc64/cache.h>
     53   1.1       mrg 
     54   1.1       mrg #ifdef DEBUG
     55   1.1       mrg #define SDB_PROM        0x01
     56   1.1       mrg #define SDB_BUSMAP      0x02
     57   1.1       mrg #define SDB_INTR        0x04
     58   1.2       mrg #define SDB_INTMAP      0x08
     59   1.2       mrg #define SDB_CONF        0x10
     60   1.7       mrg int schizo_debug = 0x0;
     61   1.1       mrg #define DPRINTF(l, s)   do { if (schizo_debug & l) printf s; } while (0)
     62   1.1       mrg #else
     63   1.1       mrg #define DPRINTF(l, s)
     64   1.1       mrg #endif
     65   1.1       mrg 
     66   1.1       mrg extern struct sparc_pci_chipset _sparc_pci_chipset;
     67   1.1       mrg 
     68   1.2       mrg static	int	schizo_match(struct device *, struct cfdata *, void *);
     69   1.2       mrg static	void	schizo_attach(struct device *, struct device *, void *);
     70   1.2       mrg static	int	schizo_print(void *aux, const char *p);
     71   1.2       mrg 
     72   1.2       mrg CFATTACH_DECL(schizo, sizeof(struct schizo_softc),
     73   1.2       mrg     schizo_match, schizo_attach, NULL, NULL);
     74   1.2       mrg 
     75   1.1       mrg void schizo_init_iommu(struct schizo_softc *, struct schizo_pbm *);
     76   1.1       mrg 
     77   1.1       mrg void schizo_set_intr(struct schizo_softc *, struct schizo_pbm *, int,
     78   1.2       mrg     int (*handler)(void *), void *, int, const char *);
     79   1.1       mrg int schizo_ue(void *);
     80   1.1       mrg int schizo_ce(void *);
     81   1.1       mrg int schizo_safari_error(void *);
     82   1.1       mrg int schizo_pci_error(void *);
     83   1.1       mrg 
     84   1.1       mrg pci_chipset_tag_t schizo_alloc_chipset(struct schizo_pbm *, int,
     85   1.1       mrg     pci_chipset_tag_t);
     86   1.1       mrg bus_space_tag_t schizo_alloc_mem_tag(struct schizo_pbm *);
     87   1.1       mrg bus_space_tag_t schizo_alloc_io_tag(struct schizo_pbm *);
     88   1.1       mrg bus_space_tag_t schizo_alloc_config_tag(struct schizo_pbm *);
     89   1.1       mrg bus_space_tag_t schizo_alloc_bus_tag(struct schizo_pbm *, const char *,
     90   1.2       mrg     int);
     91   1.1       mrg bus_dma_tag_t schizo_alloc_dma_tag(struct schizo_pbm *);
     92   1.1       mrg 
     93   1.1       mrg pcireg_t schizo_conf_read(pci_chipset_tag_t, pcitag_t, int);
     94   1.1       mrg void schizo_conf_write(pci_chipset_tag_t, pcitag_t, int, pcireg_t);
     95   1.1       mrg 
     96   1.2       mrg int schizo_bus_map(bus_space_tag_t t, bus_addr_t offset, bus_size_t size,
     97   1.2       mrg 	           int flags, vaddr_t unused, bus_space_handle_t *hp);
     98   1.2       mrg static paddr_t schizo_bus_mmap(bus_space_tag_t t, bus_addr_t paddr,
     99   1.2       mrg                                off_t off, int prot, int flags);
    100   1.2       mrg static void *schizo_intr_establish(bus_space_tag_t, int, int, int (*)(void *),
    101   1.2       mrg 	void *, void(*)(void));
    102  1.10       mrg static int schizo_pci_intr_map(struct pci_attach_args *, pci_intr_handle_t *);
    103   1.2       mrg static void *schizo_pci_intr_establish(pci_chipset_tag_t, pci_intr_handle_t,
    104   1.2       mrg                                        int, int (*)(void *), void *);
    105   1.2       mrg static int schizo_pci_find_ino(struct pci_attach_args *, pci_intr_handle_t *);
    106   1.4       mrg static int schizo_dmamap_create(bus_dma_tag_t, bus_size_t, int, bus_size_t,
    107   1.4       mrg 	bus_size_t, int, bus_dmamap_t *);
    108   1.1       mrg 
    109   1.1       mrg int
    110   1.2       mrg schizo_match(struct device *parent, struct cfdata *match, void *aux)
    111   1.1       mrg {
    112   1.1       mrg 	struct mainbus_attach_args *ma = aux;
    113   1.1       mrg 	char *str;
    114   1.1       mrg 
    115   1.1       mrg 	if (strcmp(ma->ma_name, "pci") != 0)
    116   1.1       mrg 		return (0);
    117   1.1       mrg 
    118   1.2       mrg 	str = prom_getpropstring(ma->ma_node, "model");
    119   1.1       mrg 	if (strcmp(str, "schizo") == 0)
    120   1.1       mrg 		return (1);
    121   1.1       mrg 
    122   1.2       mrg 	str = prom_getpropstring(ma->ma_node, "compatible");
    123   1.1       mrg 	if (strcmp(str, "pci108e,8001") == 0)
    124   1.1       mrg 		return (1);
    125   1.1       mrg 	if (strcmp(str, "pci108e,8002") == 0)		/* XMITS */
    126   1.1       mrg 		return (1);
    127   1.1       mrg 	if (strcmp(str, "pci108e,a801") == 0)		/* Tomatillo */
    128   1.1       mrg 		return (1);
    129   1.1       mrg 
    130   1.1       mrg 	return (0);
    131   1.1       mrg }
    132   1.1       mrg 
    133   1.1       mrg void
    134   1.1       mrg schizo_attach(struct device *parent, struct device *self, void *aux)
    135   1.1       mrg {
    136   1.1       mrg 	struct schizo_softc *sc = (struct schizo_softc *)self;
    137   1.1       mrg 	struct mainbus_attach_args *ma = aux;
    138  1.13       mrg 	struct schizo_pbm *pbm;
    139  1.15       mrg 	struct iommu_state *is;
    140  1.13       mrg 	struct pcibus_attach_args pba;
    141  1.13       mrg 	uint64_t reg, eccctrl;
    142  1.13       mrg 	int *busranges = NULL, nranges;
    143   1.1       mrg 	char *str;
    144   1.1       mrg 
    145  1.16       mrg 	aprint_normal(": addr %" PRIx64, ma->ma_reg[0].ur_paddr);
    146   1.2       mrg 	str = prom_getpropstring(ma->ma_node, "compatible");
    147   1.1       mrg 	if (strcmp(str, "pci108e,a801") == 0)
    148   1.1       mrg 		sc->sc_tomatillo = 1;
    149   1.1       mrg 
    150   1.1       mrg 	sc->sc_node = ma->ma_node;
    151   1.1       mrg 	sc->sc_dmat = ma->ma_dmatag;
    152   1.2       mrg 	sc->sc_bustag = ma->ma_bustag;
    153   1.1       mrg 
    154  1.13       mrg 	if (bus_space_map(sc->sc_bustag, ma->ma_reg[1].ur_paddr - 0x10000UL,
    155   1.2       mrg 	    sizeof(struct schizo_regs), 0,
    156   1.2       mrg 	    &sc->sc_ctrlh)) {
    157  1.16       mrg 		aprint_error(": failed to map registers\n");
    158   1.1       mrg 		return;
    159   1.1       mrg 	}
    160   1.1       mrg 
    161  1.10       mrg 	sc->sc_ign = INTIGN(ma->ma_upaid << INTMAP_IGN_SHIFT);
    162   1.6       mrg 
    163   1.1       mrg 	/* enable schizo ecc error interrupts */
    164   1.2       mrg 	eccctrl = schizo_read(sc, SCZ_ECCCTRL);
    165   1.2       mrg 	eccctrl |= SCZ_ECCCTRL_EE_INTEN |
    166   1.2       mrg 		   SCZ_ECCCTRL_UE_INTEN |
    167   1.2       mrg 		   SCZ_ECCCTRL_CE_INTEN;
    168   1.2       mrg 	schizo_write(sc, SCZ_ECCCTRL, eccctrl);
    169   1.1       mrg 
    170   1.1       mrg 	pbm = malloc(sizeof(*pbm), M_DEVBUF, M_NOWAIT | M_ZERO);
    171   1.1       mrg 	if (pbm == NULL)
    172   1.1       mrg 		panic("schizo: can't alloc schizo pbm");
    173   1.1       mrg 
    174   1.1       mrg 	pbm->sp_sc = sc;
    175   1.2       mrg 	pbm->sp_regt = sc->sc_bustag;
    176   1.1       mrg 
    177  1.13       mrg 	if ((ma->ma_reg[0].ur_paddr & 0x00700000) == 0x00600000)
    178   1.5       mrg 		pbm->sp_bus_a = 1;
    179   1.5       mrg 	else
    180   1.5       mrg 		pbm->sp_bus_a = 0;
    181   1.5       mrg 
    182  1.13       mrg 	/*
    183  1.13       mrg 	 * Map interrupt registers
    184  1.13       mrg 	 */
    185  1.13       mrg 	if (bus_space_map(sc->sc_bustag, ma->ma_reg[0].ur_paddr,
    186  1.13       mrg 			  ma->ma_reg[0].ur_len,
    187  1.13       mrg 			  BUS_SPACE_MAP_LINEAR, &pbm->sp_intrh)) {
    188  1.16       mrg 		aprint_error(": failed to interrupt map registers\n");
    189  1.13       mrg 		return;
    190  1.13       mrg 	}
    191  1.13       mrg 
    192   1.2       mrg 	if (prom_getprop(sc->sc_node, "ranges", sizeof(struct schizo_range),
    193   1.1       mrg 	    &pbm->sp_nrange, (void **)&pbm->sp_range))
    194   1.1       mrg 		panic("schizo: can't get ranges");
    195   1.1       mrg 
    196   1.2       mrg 	if (prom_getprop(sc->sc_node, "bus-range", sizeof(int), &nranges,
    197   1.1       mrg 	    (void **)&busranges))
    198   1.1       mrg 		panic("schizo: can't get bus-range");
    199   1.1       mrg 
    200  1.16       mrg 	aprint_normal(": \"%s\", version %d, ign %x, bus %c %d to %d\n",
    201   1.1       mrg 	    sc->sc_tomatillo ? "Tomatillo" : "Schizo",
    202   1.2       mrg 	    prom_getpropint(sc->sc_node, "version#", 0), sc->sc_ign,
    203   1.2       mrg 	    pbm->sp_bus_a ? 'A' : 'B', busranges[0], busranges[1]);
    204  1.16       mrg 	aprint_naive("\n");
    205   1.1       mrg 
    206   1.1       mrg 	if (bus_space_subregion(pbm->sp_regt, sc->sc_ctrlh,
    207   1.2       mrg 	    pbm->sp_bus_a ? offsetof(struct schizo_regs, pbm_a) :
    208   1.1       mrg 	    offsetof(struct schizo_regs, pbm_b),
    209   1.1       mrg 	    sizeof(struct schizo_pbm_regs),
    210   1.1       mrg 	    &pbm->sp_regh)) {
    211   1.1       mrg 		panic("schizo: unable to create PBM handle");
    212   1.1       mrg 	}
    213   1.1       mrg 
    214  1.15       mrg 	is = &pbm->sp_is;
    215  1.15       mrg 	pbm->sp_sb.sb_is = is;
    216  1.15       mrg 	if (prom_getproplen(sc->sc_node, "no-streaming-cache") < 0) {
    217  1.15       mrg 		vaddr_t va = (vaddr_t)&pbm->sp_flush[0x40];
    218  1.15       mrg 
    219  1.15       mrg 		/*
    220  1.15       mrg 		 * Initialize the strbuf_ctl.
    221  1.15       mrg 		 *
    222  1.15       mrg 		 * The flush sync buffer must be 64-byte aligned.
    223  1.15       mrg 		 */
    224  1.15       mrg 		is->is_sb[0] = &pbm->sp_sb;
    225  1.15       mrg 		is->is_sb[0]->sb_flush = (void *)(va & ~0x3f);
    226  1.15       mrg 
    227  1.15       mrg 		bus_space_subregion(pbm->sp_regt, pbm->sp_regh,
    228  1.15       mrg 			offsetof(struct schizo_pbm_regs, strbuf),
    229  1.15       mrg 			sizeof(struct iommu_strbuf), &is->is_sb[0]->sb_sb);
    230  1.15       mrg 	} else {
    231  1.15       mrg 		aprint_debug("%s: no streaming buffers\n", sc->sc_dv.dv_xname);
    232  1.15       mrg 	}
    233  1.15       mrg 
    234  1.16       mrg 	aprint_normal("%s: ", sc->sc_dv.dv_xname);
    235   1.1       mrg 	schizo_init_iommu(sc, pbm);
    236   1.1       mrg 
    237   1.1       mrg 	pbm->sp_memt = schizo_alloc_mem_tag(pbm);
    238   1.1       mrg 	pbm->sp_iot = schizo_alloc_io_tag(pbm);
    239   1.1       mrg 	pbm->sp_cfgt = schizo_alloc_config_tag(pbm);
    240   1.1       mrg 	pbm->sp_dmat = schizo_alloc_dma_tag(pbm);
    241   1.2       mrg 	pbm->sp_flags = (pbm->sp_memt ? PCI_FLAGS_MEM_ENABLED : 0) |
    242   1.2       mrg 		        (pbm->sp_iot ? PCI_FLAGS_IO_ENABLED : 0);
    243   1.1       mrg 
    244   1.1       mrg 	if (bus_space_map(pbm->sp_cfgt, 0, 0x1000000, 0, &pbm->sp_cfgh))
    245   1.1       mrg 		panic("schizo: could not map config space");
    246   1.1       mrg 
    247   1.1       mrg 	pbm->sp_pc = schizo_alloc_chipset(pbm, sc->sc_node,
    248   1.1       mrg 	    &_sparc_pci_chipset);
    249   1.3  nakayama 	pbm->sp_pc->spc_busmax = busranges[1];
    250   1.3  nakayama 	pbm->sp_pc->spc_busnode = malloc(sizeof(*pbm->sp_pc->spc_busnode),
    251   1.3  nakayama 	    M_DEVBUF, M_NOWAIT | M_ZERO);
    252   1.3  nakayama 	if (pbm->sp_pc->spc_busnode == NULL)
    253   1.3  nakayama 		panic("schizo: malloc busnode");
    254   1.1       mrg 
    255   1.1       mrg 	pba.pba_bus = busranges[0];
    256   1.1       mrg 	pba.pba_bridgetag = NULL;
    257   1.1       mrg 	pba.pba_pc = pbm->sp_pc;
    258   1.1       mrg 	pba.pba_flags = pbm->sp_flags;
    259   1.1       mrg 	pba.pba_dmat = pbm->sp_dmat;
    260   1.2       mrg 	pba.pba_dmat64 = NULL;	/* XXX */
    261   1.1       mrg 	pba.pba_memt = pbm->sp_memt;
    262   1.1       mrg 	pba.pba_iot = pbm->sp_iot;
    263   1.1       mrg 
    264   1.1       mrg 	free(busranges, M_DEVBUF);
    265   1.1       mrg 
    266   1.1       mrg 	schizo_pbm_write(pbm, SCZ_PCI_INTR_RETRY, 5);
    267   1.1       mrg 
    268   1.1       mrg 	/* clear out the bus errors */
    269   1.1       mrg 	schizo_pbm_write(pbm, SCZ_PCI_CTRL, schizo_pbm_read(pbm, SCZ_PCI_CTRL));
    270   1.1       mrg 	schizo_pbm_write(pbm, SCZ_PCI_AFSR, schizo_pbm_read(pbm, SCZ_PCI_AFSR));
    271   1.1       mrg 	schizo_cfg_write(pbm, PCI_COMMAND_STATUS_REG,
    272   1.1       mrg 	    schizo_cfg_read(pbm, PCI_COMMAND_STATUS_REG));
    273   1.1       mrg 
    274   1.1       mrg 	reg = schizo_pbm_read(pbm, SCZ_PCI_CTRL);
    275   1.1       mrg 	/* enable/disable error interrupts and arbiter */
    276   1.1       mrg 	reg |= SCZ_PCICTRL_EEN | SCZ_PCICTRL_MMU_INT | SCZ_PCICTRL_ARB;
    277   1.1       mrg 	reg &= ~SCZ_PCICTRL_SBH_INT;
    278   1.1       mrg 	schizo_pbm_write(pbm, SCZ_PCI_CTRL, reg);
    279   1.1       mrg 
    280   1.1       mrg 	reg = schizo_pbm_read(pbm, SCZ_PCI_DIAG);
    281   1.1       mrg 	reg &= ~(SCZ_PCIDIAG_D_RTRYARB | SCZ_PCIDIAG_D_RETRY |
    282   1.1       mrg 	    SCZ_PCIDIAG_D_INTSYNC);
    283   1.1       mrg 	schizo_pbm_write(pbm, SCZ_PCI_DIAG, reg);
    284   1.1       mrg 
    285   1.2       mrg 	if (pbm->sp_bus_a)
    286   1.1       mrg 		schizo_set_intr(sc, pbm, PIL_HIGH, schizo_pci_error,
    287   1.1       mrg 		   pbm, SCZ_PCIERR_A_INO, "pci_a");
    288   1.1       mrg 	else
    289   1.1       mrg 		schizo_set_intr(sc, pbm, PIL_HIGH, schizo_pci_error,
    290   1.1       mrg 		   pbm, SCZ_PCIERR_B_INO, "pci_b");
    291   1.1       mrg 
    292   1.1       mrg 	/* double mapped */
    293   1.1       mrg 	schizo_set_intr(sc, pbm, PIL_HIGH, schizo_ue, sc, SCZ_UE_INO,
    294   1.1       mrg 	    "ue");
    295   1.1       mrg 	schizo_set_intr(sc, pbm, PIL_HIGH, schizo_ce, sc, SCZ_CE_INO,
    296   1.1       mrg 	    "ce");
    297   1.1       mrg 	schizo_set_intr(sc, pbm, PIL_HIGH, schizo_safari_error, sc,
    298   1.1       mrg 	    SCZ_SERR_INO, "safari");
    299   1.1       mrg 
    300   1.1       mrg 	config_found(&sc->sc_dv, &pba, schizo_print);
    301   1.1       mrg }
    302   1.1       mrg 
    303   1.1       mrg int
    304   1.1       mrg schizo_ue(void *vsc)
    305   1.1       mrg {
    306   1.1       mrg 	struct schizo_softc *sc = vsc;
    307   1.1       mrg 
    308   1.1       mrg 	panic("%s: uncorrectable error", sc->sc_dv.dv_xname);
    309   1.1       mrg 	return (1);
    310   1.1       mrg }
    311   1.1       mrg 
    312   1.1       mrg int
    313   1.1       mrg schizo_ce(void *vsc)
    314   1.1       mrg {
    315   1.1       mrg 	struct schizo_softc *sc = vsc;
    316   1.1       mrg 
    317   1.1       mrg 	panic("%s: correctable error", sc->sc_dv.dv_xname);
    318   1.1       mrg 	return (1);
    319   1.1       mrg }
    320   1.1       mrg 
    321   1.1       mrg int
    322   1.1       mrg schizo_pci_error(void *vpbm)
    323   1.1       mrg {
    324   1.1       mrg 	struct schizo_pbm *sp = vpbm;
    325   1.1       mrg 	struct schizo_softc *sc = sp->sp_sc;
    326   1.2       mrg 	u_int64_t afsr, afar, ctrl, tfar;
    327   1.1       mrg 	u_int32_t csr;
    328   1.2       mrg 	char bits[128];
    329   1.1       mrg 
    330   1.1       mrg 	afsr = schizo_pbm_read(sp, SCZ_PCI_AFSR);
    331   1.1       mrg 	afar = schizo_pbm_read(sp, SCZ_PCI_AFAR);
    332   1.1       mrg 	ctrl = schizo_pbm_read(sp, SCZ_PCI_CTRL);
    333   1.1       mrg 	csr = schizo_cfg_read(sp, PCI_COMMAND_STATUS_REG);
    334   1.1       mrg 
    335   1.1       mrg 	printf("%s: pci bus %c error\n", sc->sc_dv.dv_xname,
    336   1.1       mrg 	    sp->sp_bus_a ? 'A' : 'B');
    337   1.1       mrg 
    338   1.8  christos 	snprintb(bits, sizeof(bits), SCZ_PCIAFSR_BITS, afsr);
    339   1.8  christos 	printf("PCIAFSR=%s\n", bits);
    340  1.14  nakayama 	printf("PCIAFAR=%" PRIx64 "\n", afar);
    341   1.8  christos 	snprintb(bits, sizeof(bits), SCZ_PCICTRL_BITS, ctrl);
    342   1.8  christos 	printf("PCICTRL=%s\n", bits);
    343   1.2       mrg #ifdef PCI_COMMAND_STATUS_BITS
    344   1.8  christos 	snprintb(bits, sizeof(bits), PCI_COMMAND_STATUS_BITS, csr);
    345   1.8  christos 	printf("PCICSR=%s\n", bits);
    346   1.2       mrg #endif
    347   1.1       mrg 
    348   1.1       mrg 	if (ctrl & SCZ_PCICTRL_MMU_ERR) {
    349   1.1       mrg 		ctrl = schizo_pbm_read(sp, SCZ_PCI_IOMMU_CTRL);
    350  1.14  nakayama 		printf("IOMMUCTRL=%" PRIx64 "\n", ctrl);
    351   1.1       mrg 
    352   1.1       mrg 		if ((ctrl & TOM_IOMMU_ERR) == 0)
    353   1.1       mrg 			goto clear_error;
    354   1.1       mrg 
    355   1.1       mrg 		if (sc->sc_tomatillo) {
    356   1.1       mrg 			tfar = schizo_pbm_read(sp, TOM_PCI_IOMMU_TFAR);
    357  1.14  nakayama 			printf("IOMMUTFAR=%" PRIx64 "\n", tfar);
    358   1.1       mrg 		}
    359   1.1       mrg 
    360   1.1       mrg 		/* These are non-fatal if target abort was signalled. */
    361   1.1       mrg 		if ((ctrl & TOM_IOMMU_ERR_MASK) == TOM_IOMMU_INV_ERR ||
    362   1.1       mrg 		    ctrl & TOM_IOMMU_ILLTSBTBW_ERR ||
    363   1.1       mrg 		    ctrl & TOM_IOMMU_BADVA_ERR) {
    364   1.1       mrg 			if (csr & PCI_STATUS_TARGET_TARGET_ABORT) {
    365   1.1       mrg 				schizo_pbm_write(sp, SCZ_PCI_IOMMU_CTRL, ctrl);
    366   1.1       mrg 				goto clear_error;
    367   1.1       mrg 			}
    368   1.1       mrg 		}
    369   1.1       mrg 	}
    370   1.1       mrg 
    371   1.1       mrg 	panic("%s: fatal", sc->sc_dv.dv_xname);
    372   1.1       mrg 
    373   1.1       mrg  clear_error:
    374   1.1       mrg 	schizo_cfg_write(sp, PCI_COMMAND_STATUS_REG, csr);
    375   1.1       mrg 	schizo_pbm_write(sp, SCZ_PCI_CTRL, ctrl);
    376   1.1       mrg 	schizo_pbm_write(sp, SCZ_PCI_AFSR, afsr);
    377   1.1       mrg 	return (1);
    378   1.1       mrg }
    379   1.1       mrg 
    380   1.1       mrg int
    381   1.1       mrg schizo_safari_error(void *vsc)
    382   1.1       mrg {
    383   1.1       mrg 	struct schizo_softc *sc = vsc;
    384   1.1       mrg 
    385   1.1       mrg 	printf("%s: safari error\n", sc->sc_dv.dv_xname);
    386   1.1       mrg 
    387  1.14  nakayama 	printf("ERRLOG=%" PRIx64 "\n", schizo_read(sc, SCZ_SAFARI_ERRLOG));
    388  1.14  nakayama 	printf("UE_AFSR=%" PRIx64 "\n", schizo_read(sc, SCZ_UE_AFSR));
    389  1.14  nakayama 	printf("UE_AFAR=%" PRIx64 "\n", schizo_read(sc, SCZ_UE_AFAR));
    390  1.14  nakayama 	printf("CE_AFSR=%" PRIx64 "\n", schizo_read(sc, SCZ_CE_AFSR));
    391  1.14  nakayama 	printf("CE_AFAR=%" PRIx64 "\n", schizo_read(sc, SCZ_CE_AFAR));
    392   1.1       mrg 
    393   1.1       mrg 	panic("%s: fatal", sc->sc_dv.dv_xname);
    394   1.1       mrg 	return (1);
    395   1.1       mrg }
    396   1.1       mrg 
    397   1.1       mrg void
    398   1.1       mrg schizo_init_iommu(struct schizo_softc *sc, struct schizo_pbm *pbm)
    399   1.1       mrg {
    400   1.1       mrg 	struct iommu_state *is = &pbm->sp_is;
    401   1.1       mrg 	int *vdma = NULL, nitem, tsbsize = 7;
    402   1.1       mrg 	u_int32_t iobase = -1;
    403   1.1       mrg 	char *name;
    404   1.1       mrg 
    405   1.4       mrg 	/* punch in our copies */
    406   1.1       mrg 	is->is_bustag = pbm->sp_regt;
    407  1.15       mrg 	bus_space_subregion(is->is_bustag, pbm->sp_regh,
    408  1.15       mrg 		offsetof(struct schizo_pbm_regs, iommu),
    409  1.15       mrg 		sizeof(struct schizo_iommureg),
    410  1.15       mrg 		&is->is_iommu);
    411   1.1       mrg 
    412   1.1       mrg 	/*
    413   1.1       mrg 	 * Separate the men from the boys.  If the `virtual-dma'
    414   1.1       mrg 	 * property exists, use it.
    415   1.1       mrg 	 */
    416   1.2       mrg 	if (!prom_getprop(sc->sc_node, "virtual-dma", sizeof(vdma), &nitem,
    417   1.1       mrg 	    (void **)&vdma)) {
    418   1.1       mrg 		/* Damn.  Gotta use these values. */
    419   1.1       mrg 		iobase = vdma[0];
    420   1.1       mrg #define	TSBCASE(x)	case 1 << ((x) + 23): tsbsize = (x); break
    421   1.1       mrg 		switch (vdma[1]) {
    422   1.1       mrg 			TSBCASE(1); TSBCASE(2); TSBCASE(3);
    423   1.1       mrg 			TSBCASE(4); TSBCASE(5); TSBCASE(6);
    424   1.1       mrg 		default:
    425   1.1       mrg 			printf("bogus tsb size %x, using 7\n", vdma[1]);
    426   1.1       mrg 			TSBCASE(7);
    427   1.1       mrg 		}
    428   1.1       mrg #undef TSBCASE
    429   1.2       mrg 		DPRINTF(SDB_BUSMAP, ("schizo_init_iommu: iobase=0x%x\n", iobase));
    430   1.1       mrg 		free(vdma, M_DEVBUF);
    431   1.1       mrg 	} else {
    432   1.2       mrg 		DPRINTF(SDB_BUSMAP, ("schizo_init_iommu: getprop failed, "
    433   1.1       mrg 		    "using iobase=0x%x, tsbsize=%d\n", iobase, tsbsize));
    434   1.1       mrg 	}
    435   1.1       mrg 
    436  1.15       mrg 	/* give us a nice name.. */
    437  1.15       mrg 	name = (char *)malloc(32, M_DEVBUF, M_NOWAIT);
    438  1.15       mrg 	if (name == NULL)
    439  1.15       mrg 		panic("couldn't malloc iommu name");
    440  1.15       mrg 	snprintf(name, 32, "%s dvma", sc->sc_dv.dv_xname);
    441  1.15       mrg 
    442   1.1       mrg 	iommu_init(name, is, tsbsize, iobase);
    443   1.1       mrg }
    444   1.1       mrg 
    445   1.1       mrg int
    446   1.1       mrg schizo_print(void *aux, const char *p)
    447   1.1       mrg {
    448   1.2       mrg 
    449   1.1       mrg 	if (p == NULL)
    450   1.1       mrg 		return (UNCONF);
    451   1.1       mrg 	return (QUIET);
    452   1.1       mrg }
    453   1.1       mrg 
    454   1.1       mrg pcireg_t
    455   1.1       mrg schizo_conf_read(pci_chipset_tag_t pc, pcitag_t tag, int reg)
    456   1.1       mrg {
    457   1.2       mrg 	struct schizo_pbm *sp = pc->cookie;
    458  1.11  nakayama 	pcireg_t val = (pcireg_t)~0;
    459   1.2       mrg 
    460   1.2       mrg 	DPRINTF(SDB_CONF, ("%s: tag %lx reg %x ", __func__, (long)tag, reg));
    461  1.11  nakayama 	if (PCITAG_NODE(tag) != -1)
    462  1.11  nakayama 		val = bus_space_read_4(sp->sp_cfgt, sp->sp_cfgh,
    463  1.11  nakayama 		    PCITAG_OFFSET(tag) + reg);
    464   1.2       mrg 	DPRINTF(SDB_CONF, (" returning %08x\n", (u_int)val));
    465   1.2       mrg 	return (val);
    466   1.1       mrg }
    467   1.1       mrg 
    468   1.1       mrg void
    469   1.1       mrg schizo_conf_write(pci_chipset_tag_t pc, pcitag_t tag, int reg, pcireg_t data)
    470   1.1       mrg {
    471   1.2       mrg 	struct schizo_pbm *sp = pc->cookie;
    472   1.2       mrg 
    473   1.2       mrg 	DPRINTF(SDB_CONF, ("%s: tag %lx; reg %x; data %x", __func__,
    474   1.2       mrg 		(long)tag, reg, (int)data));
    475  1.11  nakayama 
    476  1.11  nakayama 	/* If we don't know it, just punt it.  */
    477  1.11  nakayama 	if (PCITAG_NODE(tag) == -1) {
    478  1.11  nakayama 		DPRINTF(SDB_CONF, (" .. bad addr\n"));
    479  1.11  nakayama 		return;
    480  1.11  nakayama 	}
    481  1.11  nakayama 
    482   1.2       mrg         bus_space_write_4(sp->sp_cfgt, sp->sp_cfgh,
    483   1.1       mrg 	    PCITAG_OFFSET(tag) + reg, data);
    484   1.2       mrg 	DPRINTF(SDB_CONF, (" .. done\n"));
    485   1.1       mrg }
    486   1.1       mrg 
    487   1.1       mrg void
    488   1.1       mrg schizo_set_intr(struct schizo_softc *sc, struct schizo_pbm *pbm, int ipl,
    489   1.2       mrg     int (*handler)(void *), void *arg, int ino, const char *what)
    490   1.1       mrg {
    491   1.1       mrg 	struct intrhand *ih;
    492   1.2       mrg 	u_int64_t mapoff, clroff;
    493  1.13       mrg 	uintptr_t intrregs;
    494   1.2       mrg 
    495   1.6       mrg 	DPRINTF(SDB_INTR, ("%s: ino %x ign %x fn %p arg %p", __func__,
    496   1.6       mrg 	    ino, sc->sc_ign, handler, arg));
    497   1.6       mrg 
    498   1.2       mrg 	mapoff = offsetof(struct schizo_pbm_regs, imap[ino]);
    499   1.2       mrg 	clroff = offsetof(struct schizo_pbm_regs, iclr[ino]);
    500  1.12       mrg 	ino |= sc->sc_ign;
    501   1.1       mrg 
    502  1.14  nakayama 	DPRINTF(SDB_INTR, (" mapoff %" PRIx64 " clroff %" PRIx64 "\n",
    503  1.14  nakayama 	    mapoff, clroff));
    504   1.6       mrg 
    505   1.2       mrg 	ih = (struct intrhand *)
    506   1.2       mrg 		malloc(sizeof(struct intrhand), M_DEVBUF, M_NOWAIT);
    507   1.2       mrg 	if (ih == NULL)
    508   1.1       mrg 		return;
    509   1.2       mrg 	ih->ih_arg = arg;
    510  1.13       mrg 	intrregs = (uintptr_t)bus_space_vaddr(pbm->sp_regt, pbm->sp_intrh);
    511  1.14  nakayama 	ih->ih_map = (uint64_t *)(uintptr_t)(intrregs + mapoff);
    512  1.14  nakayama 	ih->ih_clr = (uint64_t *)(uintptr_t)(intrregs + clroff);
    513   1.2       mrg 	ih->ih_fun = handler;
    514   1.2       mrg 	ih->ih_pil = (1<<ipl);
    515   1.2       mrg 	ih->ih_number = INTVEC(schizo_pbm_read(pbm, mapoff));
    516   1.2       mrg 	intr_establish(ipl, ipl != IPL_VM, ih);
    517   1.2       mrg 
    518   1.2       mrg 	schizo_pbm_write(pbm, mapoff,
    519   1.2       mrg 	    ih->ih_number | INTMAP_V | (CPU_UPAID << INTMAP_TID_SHIFT));
    520   1.1       mrg }
    521   1.1       mrg 
    522   1.1       mrg bus_space_tag_t
    523   1.1       mrg schizo_alloc_mem_tag(struct schizo_pbm *sp)
    524   1.1       mrg {
    525   1.1       mrg 	return (schizo_alloc_bus_tag(sp, "mem",
    526   1.2       mrg 	    PCI_MEMORY_BUS_SPACE));
    527   1.1       mrg }
    528   1.1       mrg 
    529   1.1       mrg bus_space_tag_t
    530   1.1       mrg schizo_alloc_io_tag(struct schizo_pbm *sp)
    531   1.1       mrg {
    532   1.1       mrg 	return (schizo_alloc_bus_tag(sp, "io",
    533   1.2       mrg 	    PCI_IO_BUS_SPACE));
    534   1.1       mrg }
    535   1.1       mrg 
    536   1.1       mrg bus_space_tag_t
    537   1.1       mrg schizo_alloc_config_tag(struct schizo_pbm *sp)
    538   1.1       mrg {
    539   1.1       mrg 	return (schizo_alloc_bus_tag(sp, "cfg",
    540   1.2       mrg 	    PCI_CONFIG_BUS_SPACE));
    541   1.1       mrg }
    542   1.1       mrg 
    543   1.1       mrg bus_space_tag_t
    544   1.2       mrg schizo_alloc_bus_tag(struct schizo_pbm *pbm, const char *name, int type)
    545   1.1       mrg {
    546   1.1       mrg 	struct schizo_softc *sc = pbm->sp_sc;
    547   1.2       mrg 	bus_space_tag_t bt;
    548   1.1       mrg 
    549   1.2       mrg 	bt = (bus_space_tag_t) malloc(sizeof(struct sparc_bus_space_tag),
    550   1.2       mrg 		    M_DEVBUF, M_NOWAIT | M_ZERO);
    551   1.1       mrg 	if (bt == NULL)
    552   1.1       mrg 		panic("schizo: could not allocate bus tag");
    553   1.1       mrg 
    554   1.1       mrg 	bt->cookie = pbm;
    555   1.2       mrg 	bt->parent = sc->sc_bustag;
    556   1.2       mrg 	bt->type = type;
    557   1.1       mrg 	bt->sparc_bus_map = schizo_bus_map;
    558   1.1       mrg 	bt->sparc_bus_mmap = schizo_bus_mmap;
    559   1.1       mrg 	bt->sparc_intr_establish = schizo_intr_establish;
    560   1.1       mrg 	return (bt);
    561   1.1       mrg }
    562   1.1       mrg 
    563   1.1       mrg bus_dma_tag_t
    564   1.1       mrg schizo_alloc_dma_tag(struct schizo_pbm *pbm)
    565   1.1       mrg {
    566   1.1       mrg 	struct schizo_softc *sc = pbm->sp_sc;
    567   1.1       mrg 	bus_dma_tag_t dt, pdt = sc->sc_dmat;
    568   1.1       mrg 
    569   1.1       mrg 	dt = malloc(sizeof(*dt), M_DEVBUF, M_NOWAIT | M_ZERO);
    570   1.1       mrg 	if (dt == NULL)
    571   1.1       mrg 		panic("schizo: could not alloc dma tag");
    572   1.1       mrg 
    573   1.1       mrg 	dt->_cookie = pbm;
    574   1.1       mrg 	dt->_parent = pdt;
    575   1.2       mrg #define PCOPY(x)	dt->x = pdt->x
    576   1.4       mrg 	dt->_dmamap_create = schizo_dmamap_create;
    577   1.2       mrg 	PCOPY(_dmamap_destroy);
    578   1.2       mrg 	dt->_dmamap_load = iommu_dvmamap_load;
    579   1.2       mrg 	PCOPY(_dmamap_load_mbuf);
    580   1.2       mrg 	PCOPY(_dmamap_load_uio);
    581   1.2       mrg 	dt->_dmamap_load_raw = iommu_dvmamap_load_raw;
    582   1.2       mrg 	dt->_dmamap_unload = iommu_dvmamap_unload;
    583   1.2       mrg 	dt->_dmamap_sync = iommu_dvmamap_sync;
    584   1.2       mrg 	dt->_dmamem_alloc = iommu_dvmamem_alloc;
    585   1.2       mrg 	dt->_dmamem_free = iommu_dvmamem_free;
    586   1.2       mrg 	dt->_dmamem_map = iommu_dvmamem_map;
    587   1.2       mrg 	dt->_dmamem_unmap = iommu_dvmamem_unmap;
    588   1.2       mrg 	PCOPY(_dmamem_mmap);
    589   1.2       mrg #undef	PCOPY
    590   1.1       mrg 	return (dt);
    591   1.1       mrg }
    592   1.1       mrg 
    593   1.1       mrg pci_chipset_tag_t
    594   1.1       mrg schizo_alloc_chipset(struct schizo_pbm *pbm, int node, pci_chipset_tag_t pc)
    595   1.1       mrg {
    596   1.1       mrg 	pci_chipset_tag_t npc;
    597   1.1       mrg 
    598   1.1       mrg 	npc = malloc(sizeof *npc, M_DEVBUF, M_NOWAIT);
    599   1.1       mrg 	if (npc == NULL)
    600   1.1       mrg 		panic("schizo: could not allocate pci_chipset_tag_t");
    601   1.1       mrg 	memcpy(npc, pc, sizeof *pc);
    602   1.1       mrg 	npc->cookie = pbm;
    603   1.1       mrg 	npc->rootnode = node;
    604   1.2       mrg 	npc->spc_conf_read = schizo_conf_read;
    605   1.2       mrg 	npc->spc_conf_write = schizo_conf_write;
    606  1.10       mrg 	npc->spc_intr_map = schizo_pci_intr_map;
    607   1.2       mrg 	npc->spc_intr_establish = schizo_pci_intr_establish;
    608   1.2       mrg 	npc->spc_find_ino = schizo_pci_find_ino;
    609   1.1       mrg 	return (npc);
    610   1.1       mrg }
    611   1.1       mrg 
    612   1.1       mrg int
    613   1.2       mrg schizo_dmamap_create(bus_dma_tag_t t, bus_size_t size,
    614   1.1       mrg     int nsegments, bus_size_t maxsegsz, bus_size_t boundary, int flags,
    615   1.1       mrg     bus_dmamap_t *dmamp)
    616   1.1       mrg {
    617   1.2       mrg 	struct schizo_pbm *pbm = t->_cookie;
    618   1.4       mrg 	int error;
    619   1.1       mrg 
    620   1.4       mrg 	error = bus_dmamap_create(t->_parent, size, nsegments, maxsegsz,
    621   1.4       mrg 				  boundary, flags, dmamp);
    622   1.4       mrg 	if (error == 0)
    623   1.4       mrg 		(*dmamp)->_dm_cookie = &pbm->sp_sb;
    624   1.4       mrg 	return error;
    625   1.1       mrg }
    626   1.2       mrg 
    627   1.2       mrg static struct schizo_range *
    628   1.2       mrg get_schizorange(struct schizo_pbm *pbm, int ss)
    629   1.2       mrg {
    630   1.2       mrg 	int i;
    631   1.2       mrg 
    632   1.2       mrg 	for (i = 0; i < pbm->sp_nrange; i++) {
    633   1.2       mrg 		if (((pbm->sp_range[i].cspace >> 24) & 0x03) == ss)
    634   1.2       mrg 			return (&pbm->sp_range[i]);
    635   1.2       mrg 	}
    636   1.2       mrg 	/* not found */
    637   1.2       mrg 	return (NULL);
    638   1.2       mrg }
    639   1.1       mrg 
    640   1.1       mrg int
    641   1.2       mrg schizo_bus_map(bus_space_tag_t t, bus_addr_t offset, bus_size_t size,
    642   1.2       mrg 	       int flags, vaddr_t unused, bus_space_handle_t *hp)
    643   1.1       mrg {
    644   1.2       mrg 	bus_addr_t paddr;
    645   1.1       mrg 	struct schizo_pbm *pbm = t->cookie;
    646   1.2       mrg 	struct schizo_softc *sc = pbm->sp_sc;
    647   1.2       mrg 	struct schizo_range *sr;
    648   1.2       mrg 	int ss;
    649   1.1       mrg 
    650   1.1       mrg 	DPRINTF(SDB_BUSMAP, ("schizo_bus_map: type %d off %qx sz %qx flags %d",
    651   1.2       mrg 	    t->type,
    652   1.1       mrg 	    (unsigned long long)offset,
    653   1.1       mrg 	    (unsigned long long)size,
    654   1.1       mrg 	    flags));
    655   1.1       mrg 
    656   1.2       mrg 	ss = sparc_pci_childspace(t->type);
    657   1.2       mrg 	DPRINTF(SDB_BUSMAP, (" cspace %d\n", ss));
    658   1.1       mrg 
    659   1.2       mrg 	sr = get_schizorange(pbm, ss);
    660   1.2       mrg 	if (sr != NULL) {
    661   1.2       mrg 		paddr = BUS_ADDR(sr->phys_hi, sr->phys_lo + offset);
    662   1.2       mrg 		DPRINTF(SDB_BUSMAP, ("%s: mapping paddr "
    663   1.2       mrg 				     "space %lx offset %lx paddr %qx\n",
    664   1.2       mrg 			       __func__, (long)ss, (long)offset,
    665   1.2       mrg 			       (unsigned long long)paddr));
    666   1.2       mrg 		return ((*sc->sc_bustag->sparc_bus_map)(t, paddr, size,
    667   1.2       mrg 			flags, 0, hp));
    668   1.1       mrg 	}
    669   1.2       mrg 	DPRINTF(SDB_BUSMAP, ("%s: FAILED\n", __func__));
    670   1.1       mrg 	return (EINVAL);
    671   1.1       mrg }
    672   1.1       mrg 
    673   1.2       mrg static paddr_t
    674   1.2       mrg schizo_bus_mmap(bus_space_tag_t t, bus_addr_t paddr, off_t off, int prot,
    675   1.2       mrg 	int flags)
    676   1.1       mrg {
    677   1.1       mrg 	bus_addr_t offset = paddr;
    678   1.1       mrg 	struct schizo_pbm *pbm = t->cookie;
    679   1.2       mrg 	struct schizo_softc *sc = pbm->sp_sc;
    680   1.2       mrg 	struct schizo_range *sr;
    681   1.2       mrg 	int ss;
    682   1.1       mrg 
    683   1.2       mrg 	ss = sparc_pci_childspace(t->type);
    684   1.1       mrg 
    685   1.1       mrg 	DPRINTF(SDB_BUSMAP, ("schizo_bus_mmap: prot %d flags %d pa %qx\n",
    686   1.1       mrg 	    prot, flags, (unsigned long long)paddr));
    687   1.1       mrg 
    688   1.2       mrg 	sr = get_schizorange(pbm, ss);
    689   1.2       mrg 	if (sr != NULL) {
    690   1.2       mrg 		paddr = BUS_ADDR(sr->phys_hi, sr->phys_lo + offset);
    691   1.2       mrg 		DPRINTF(SDB_BUSMAP, ("%s: mapping paddr "
    692   1.2       mrg 				     "space %lx offset %lx paddr %qx\n",
    693   1.2       mrg 			       __func__, (long)ss, (long)offset,
    694   1.2       mrg 			       (unsigned long long)paddr));
    695   1.2       mrg 		return (bus_space_mmap(sc->sc_bustag, paddr, off,
    696   1.2       mrg 				       prot, flags));
    697   1.1       mrg 	}
    698   1.2       mrg 	DPRINTF(SDB_BUSMAP, ("%s: FAILED\n", __func__));
    699   1.1       mrg 	return (-1);
    700   1.1       mrg }
    701   1.1       mrg 
    702  1.10       mrg /*
    703  1.12       mrg  * Set the IGN for this schizo into the handle.
    704  1.10       mrg  */
    705  1.10       mrg int
    706  1.10       mrg schizo_pci_intr_map(struct pci_attach_args *pa, pci_intr_handle_t *ihp)
    707  1.10       mrg {
    708  1.10       mrg 	struct schizo_pbm *pbm = pa->pa_pc->cookie;
    709  1.10       mrg 	struct schizo_softc *sc = pbm->sp_sc;
    710  1.10       mrg 
    711  1.12       mrg 	*ihp |= sc->sc_ign;
    712  1.10       mrg 	DPRINTF(SDB_INTMAP, ("returning IGN adjusted to %x\n", *ihp));
    713  1.10       mrg 	return (0);
    714  1.10       mrg }
    715  1.10       mrg 
    716   1.2       mrg static void *
    717   1.2       mrg schizo_intr_establish(bus_space_tag_t t, int ihandle, int level,
    718   1.2       mrg 	int (*handler)(void *), void *arg, void (*fastvec)(void) /* ignored */)
    719   1.1       mrg {
    720   1.1       mrg 	struct schizo_pbm *pbm = t->cookie;
    721   1.1       mrg 	struct intrhand *ih = NULL;
    722   1.7       mrg 	uint64_t mapoff, clroff;
    723  1.13       mrg 	uintptr_t intrregs;
    724   1.7       mrg 	volatile uint64_t *intrmapptr = NULL, *intrclrptr = NULL;
    725   1.1       mrg 	int ino;
    726   1.5       mrg 	long vec;
    727   1.1       mrg 
    728   1.1       mrg 	vec = INTVEC(ihandle);
    729   1.1       mrg 	ino = INTINO(vec);
    730   1.1       mrg 
    731   1.5       mrg 	ih = malloc(sizeof *ih, M_DEVBUF, M_NOWAIT);
    732   1.5       mrg 	if (ih == NULL)
    733   1.5       mrg 		return (NULL);
    734   1.5       mrg 
    735   1.6       mrg 	DPRINTF(SDB_INTR, ("\n%s: ihandle %d level %d fn %p arg %p\n", __func__,
    736   1.2       mrg 	    ihandle, level, handler, arg));
    737   1.2       mrg 
    738   1.1       mrg 	if (level == IPL_NONE)
    739   1.1       mrg 		level = INTLEV(vec);
    740   1.1       mrg 	if (level == IPL_NONE) {
    741   1.1       mrg 		printf(": no IPL, setting IPL 2.\n");
    742   1.1       mrg 		level = 2;
    743   1.1       mrg 	}
    744   1.1       mrg 
    745   1.5       mrg 	mapoff = offsetof(struct schizo_pbm_regs, imap[ino]);
    746   1.5       mrg 	clroff = offsetof(struct schizo_pbm_regs, iclr[ino]);
    747   1.1       mrg 
    748  1.14  nakayama 	DPRINTF(SDB_INTR, ("%s: intr %x: %p mapoff %" PRIx64 " clroff %"
    749  1.14  nakayama 	    PRIx64 "\n", __func__, ino, intrlev[ino], mapoff, clroff));
    750   1.6       mrg 
    751  1.13       mrg 	intrregs = (uintptr_t)bus_space_vaddr(pbm->sp_regt, pbm->sp_intrh);
    752  1.14  nakayama 	intrmapptr = (uint64_t *)(uintptr_t)(intrregs + mapoff);
    753  1.14  nakayama 	intrclrptr = (uint64_t *)(uintptr_t)(intrregs + clroff);
    754   1.6       mrg 
    755   1.5       mrg 	if (INTIGN(vec) == 0)
    756  1.13       mrg 		ino |= schizo_pbm_readintr(pbm, mapoff) & INTMAP_IGN;
    757   1.5       mrg 	else
    758   1.5       mrg 		ino |= vec & INTMAP_IGN;
    759   1.1       mrg 
    760   1.5       mrg 	/* Register the map and clear intr registers */
    761   1.2       mrg 	ih->ih_map = intrmapptr;
    762   1.2       mrg 	ih->ih_clr = intrclrptr;
    763   1.2       mrg 
    764   1.2       mrg 	ih->ih_fun = handler;
    765   1.2       mrg 	ih->ih_arg = arg;
    766   1.2       mrg 	ih->ih_pil = level;
    767   1.6       mrg 	ih->ih_number = ino;
    768   1.2       mrg 
    769   1.5       mrg 	DPRINTF(SDB_INTR, (
    770   1.6       mrg 	    "; installing handler %p arg %p with inr %x pil %u\n",
    771   1.6       mrg 	    handler, arg, ino, (u_int)ih->ih_pil));
    772   1.5       mrg 
    773   1.2       mrg 	intr_establish(ih->ih_pil, level != IPL_VM, ih);
    774   1.1       mrg 
    775   1.5       mrg 	/*
    776   1.5       mrg 	 * Enable the interrupt now we have the handler installed.
    777   1.5       mrg 	 * Read the current value as we can't change it besides the
    778   1.5       mrg 	 * valid bit so so make sure only this bit is changed.
    779   1.5       mrg 	 */
    780   1.5       mrg 	if (intrmapptr) {
    781   1.2       mrg 		u_int64_t imap;
    782   1.1       mrg 
    783  1.13       mrg 		imap = schizo_pbm_readintr(pbm, mapoff);
    784   1.5       mrg 		DPRINTF(SDB_INTR, ("; read intrmap = %016qx",
    785   1.5       mrg 			(unsigned long long)imap));
    786   1.2       mrg 		imap |= INTMAP_V;
    787   1.5       mrg 		DPRINTF(SDB_INTR, ("; addr of intrmapptr = %p", intrmapptr));
    788   1.5       mrg 		DPRINTF(SDB_INTR, ("; writing intrmap = %016qx\n",
    789   1.5       mrg 			(unsigned long long)imap));
    790  1.13       mrg 		schizo_pbm_writeintr(pbm, mapoff, imap);
    791  1.13       mrg 		imap = schizo_pbm_readintr(pbm, mapoff);
    792   1.5       mrg 		DPRINTF(SDB_INTR, ("; reread intrmap = %016qx",
    793   1.5       mrg 			(unsigned long long)imap));
    794   1.2       mrg 		ih->ih_number |= imap & INTMAP_INR;
    795   1.1       mrg 	}
    796   1.5       mrg  	if (intrclrptr) {
    797   1.5       mrg  		/* set state to IDLE */
    798  1.13       mrg 		schizo_pbm_writeintr(pbm, clroff, 0);
    799   1.5       mrg  	}
    800   1.1       mrg 
    801   1.1       mrg 	return (ih);
    802   1.1       mrg }
    803   1.1       mrg 
    804   1.2       mrg static void *
    805   1.2       mrg schizo_pci_intr_establish(pci_chipset_tag_t pc, pci_intr_handle_t ih, int level,
    806   1.2       mrg 	int (*func)(void *), void *arg)
    807   1.2       mrg {
    808   1.2       mrg 	void *cookie;
    809   1.2       mrg 	struct schizo_pbm *pbm = (struct schizo_pbm *)pc->cookie;
    810   1.2       mrg 
    811   1.9       mrg 	DPRINTF(SDB_INTR, ("%s: ih %lx; level %d", __func__, (u_long)ih, level));
    812   1.2       mrg 	cookie = bus_intr_establish(pbm->sp_memt, ih, level, func, arg);
    813   1.2       mrg 
    814   1.2       mrg 	DPRINTF(SDB_INTR, ("; returning handle %p\n", cookie));
    815   1.2       mrg 	return (cookie);
    816   1.2       mrg }
    817   1.2       mrg 
    818   1.2       mrg static int
    819   1.2       mrg schizo_pci_find_ino(struct pci_attach_args *pa, pci_intr_handle_t *ihp)
    820   1.2       mrg {
    821   1.2       mrg #if 0
    822   1.2       mrg 	struct schizo_pbm *pbm = pa->pa_pc->cookie;
    823   1.2       mrg 	struct schizo_softc *sc = pbm->sp_sc;
    824   1.2       mrg 	u_int bus;
    825   1.2       mrg 	u_int dev;
    826   1.2       mrg 	u_int pin;
    827   1.2       mrg #endif
    828   1.2       mrg 
    829   1.2       mrg 	DPRINTF(SDB_INTMAP, ("pci_find_ino: pa_tag: node %x, %d:%d:%d\n",
    830   1.2       mrg 			      PCITAG_NODE(pa->pa_tag), (int)PCITAG_BUS(pa->pa_tag),
    831   1.2       mrg 			      (int)PCITAG_DEV(pa->pa_tag),
    832   1.2       mrg 			      (int)PCITAG_FUN(pa->pa_tag)));
    833   1.2       mrg 	DPRINTF(SDB_INTMAP,
    834   1.2       mrg 		("pci_find_ino: intrswiz %d, intrpin %d, intrline %d, rawintrpin %d\n",
    835   1.2       mrg 		 pa->pa_intrswiz, pa->pa_intrpin, pa->pa_intrline, pa->pa_rawintrpin));
    836   1.2       mrg 	DPRINTF(SDB_INTMAP, ("pci_find_ino: pa_intrtag: node %x, %d:%d:%d\n",
    837   1.2       mrg 			      PCITAG_NODE(pa->pa_intrtag),
    838   1.2       mrg 			      (int)PCITAG_BUS(pa->pa_intrtag),
    839   1.2       mrg 			      (int)PCITAG_DEV(pa->pa_intrtag),
    840   1.2       mrg 			      (int)PCITAG_FUN(pa->pa_intrtag)));
    841   1.2       mrg 
    842   1.2       mrg #if 0
    843   1.2       mrg 	bus = (pp->pp_id == PSYCHO_PBM_B);
    844   1.2       mrg 	/*
    845   1.2       mrg 	 * If we are on a ppb, use the devno on the underlying bus when forming
    846   1.2       mrg 	 * the ivec.
    847   1.2       mrg 	 */
    848   1.2       mrg 	if (pa->pa_intrswiz != 0 && PCITAG_NODE(pa->pa_intrtag) != 0)
    849   1.2       mrg 		dev = PCITAG_DEV(pa->pa_intrtag);
    850   1.2       mrg 	else
    851   1.2       mrg 		dev = pa->pa_device;
    852   1.2       mrg 	dev--;
    853   1.2       mrg 
    854   1.2       mrg 	if (sc->sc_mode == PSYCHO_MODE_PSYCHO &&
    855   1.2       mrg 	    pp->pp_id == PSYCHO_PBM_B)
    856   1.2       mrg 		dev--;
    857   1.2       mrg 
    858   1.2       mrg 	pin = pa->pa_intrpin - 1;
    859   1.2       mrg 	DPRINTF(SDB_INTMAP, ("pci_find_ino: mode %d, pbm %d, dev %d, pin %d\n",
    860   1.2       mrg 	    sc->sc_mode, pp->pp_id, dev, pin));
    861   1.2       mrg 
    862   1.2       mrg 	*ihp = sc->sc_ign | ((bus << 4) & INTMAP_PCIBUS) |
    863   1.2       mrg 	    ((dev << 2) & INTMAP_PCISLOT) | (pin & INTMAP_PCIINT);
    864   1.2       mrg #endif
    865   1.2       mrg 
    866   1.2       mrg 	return (0);
    867   1.2       mrg }
    868