Home | History | Annotate | Line # | Download | only in dev
psycho.c revision 1.78
      1  1.78       wiz /*	$NetBSD: psycho.c,v 1.78 2006/02/25 02:28:57 wiz Exp $	*/
      2   1.1       mrg 
      3   1.1       mrg /*
      4  1.46       eeh  * Copyright (c) 2001, 2002 Eduardo E. Horvath
      5   1.3       mrg  * Copyright (c) 1999, 2000 Matthew R. Green
      6   1.1       mrg  * All rights reserved.
      7   1.1       mrg  *
      8   1.1       mrg  * Redistribution and use in source and binary forms, with or without
      9   1.1       mrg  * modification, are permitted provided that the following conditions
     10   1.1       mrg  * are met:
     11   1.1       mrg  * 1. Redistributions of source code must retain the above copyright
     12   1.1       mrg  *    notice, this list of conditions and the following disclaimer.
     13   1.1       mrg  * 2. Redistributions in binary form must reproduce the above copyright
     14   1.1       mrg  *    notice, this list of conditions and the following disclaimer in the
     15   1.1       mrg  *    documentation and/or other materials provided with the distribution.
     16   1.1       mrg  * 3. The name of the author may not be used to endorse or promote products
     17   1.1       mrg  *    derived from this software without specific prior written permission.
     18   1.1       mrg  *
     19   1.1       mrg  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     20   1.1       mrg  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     21   1.1       mrg  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     22   1.1       mrg  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     23   1.1       mrg  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
     24   1.1       mrg  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
     25   1.1       mrg  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
     26   1.1       mrg  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
     27   1.1       mrg  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     28   1.1       mrg  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     29   1.1       mrg  * SUCH DAMAGE.
     30   1.1       mrg  */
     31  1.64     lukem 
     32  1.64     lukem #include <sys/cdefs.h>
     33  1.78       wiz __KERNEL_RCSID(0, "$NetBSD: psycho.c,v 1.78 2006/02/25 02:28:57 wiz Exp $");
     34   1.1       mrg 
     35   1.7       mrg #include "opt_ddb.h"
     36   1.7       mrg 
     37   1.1       mrg /*
     38  1.34       eeh  * Support for `psycho' and `psycho+' UPA to PCI bridge and
     39  1.34       eeh  * UltraSPARC IIi and IIe `sabre' PCI controllers.
     40   1.1       mrg  */
     41   1.1       mrg 
     42   1.1       mrg #ifdef DEBUG
     43   1.7       mrg #define PDB_PROM	0x01
     44  1.34       eeh #define PDB_BUSMAP	0x02
     45  1.34       eeh #define PDB_INTR	0x04
     46   1.3       mrg int psycho_debug = 0x0;
     47   1.1       mrg #define DPRINTF(l, s)   do { if (psycho_debug & l) printf s; } while (0)
     48   1.1       mrg #else
     49   1.1       mrg #define DPRINTF(l, s)
     50   1.1       mrg #endif
     51   1.1       mrg 
     52   1.1       mrg #include <sys/param.h>
     53   1.7       mrg #include <sys/device.h>
     54   1.7       mrg #include <sys/errno.h>
     55   1.1       mrg #include <sys/extent.h>
     56   1.7       mrg #include <sys/malloc.h>
     57   1.7       mrg #include <sys/systm.h>
     58   1.1       mrg #include <sys/time.h>
     59  1.34       eeh #include <sys/reboot.h>
     60   1.1       mrg 
     61  1.58  nakayama #include <uvm/uvm.h>
     62  1.58  nakayama 
     63   1.1       mrg #define _SPARC_BUS_DMA_PRIVATE
     64   1.1       mrg #include <machine/bus.h>
     65   1.1       mrg #include <machine/autoconf.h>
     66  1.18       eeh #include <machine/psl.h>
     67   1.1       mrg 
     68   1.1       mrg #include <dev/pci/pcivar.h>
     69   1.1       mrg #include <dev/pci/pcireg.h>
     70  1.60    martin #include <dev/sysmon/sysmon_taskq.h>
     71   1.1       mrg 
     72   1.1       mrg #include <sparc64/dev/iommureg.h>
     73   1.1       mrg #include <sparc64/dev/iommuvar.h>
     74   1.1       mrg #include <sparc64/dev/psychoreg.h>
     75   1.1       mrg #include <sparc64/dev/psychovar.h>
     76   1.7       mrg #include <sparc64/sparc64/cache.h>
     77   1.1       mrg 
     78   1.8       mrg #include "ioconf.h"
     79   1.8       mrg 
     80  1.77       cdi static pci_chipset_tag_t psycho_alloc_chipset(struct psycho_pbm *, int,
     81  1.77       cdi 	pci_chipset_tag_t);
     82  1.77       cdi static struct extent *psycho_alloc_extent(struct psycho_pbm *, int, int,
     83  1.77       cdi 	const char *);
     84  1.77       cdi static void psycho_get_bus_range(int, int *);
     85  1.77       cdi static void psycho_get_ranges(int, struct psycho_ranges **, int *);
     86  1.77       cdi static void psycho_set_intr(struct psycho_softc *, int, void *, uint64_t *,
     87  1.77       cdi 	uint64_t *);
     88  1.34       eeh 
     89  1.34       eeh /* Interrupt handlers */
     90  1.77       cdi static int psycho_ue(void *);
     91  1.77       cdi static int psycho_ce(void *);
     92  1.77       cdi static int psycho_bus_a(void *);
     93  1.77       cdi static int psycho_bus_b(void *);
     94  1.77       cdi static int psycho_powerfail(void *);
     95  1.77       cdi static int psycho_wakeup(void *);
     96  1.34       eeh 
     97   1.1       mrg 
     98   1.1       mrg /* IOMMU support */
     99  1.77       cdi static void psycho_iommu_init(struct psycho_softc *, int);
    100   1.1       mrg 
    101   1.7       mrg /*
    102  1.61       wiz  * bus space and bus DMA support for UltraSPARC `psycho'.  note that most
    103  1.61       wiz  * of the bus DMA support is provided by the iommu dvma controller.
    104   1.7       mrg  */
    105  1.77       cdi static int get_childspace(int);
    106  1.77       cdi static struct psycho_ranges *get_psychorange(struct psycho_pbm *, int);
    107  1.58  nakayama 
    108  1.77       cdi static paddr_t psycho_bus_mmap(bus_space_tag_t, bus_addr_t, off_t, int, int);
    109  1.77       cdi static int _psycho_bus_map(bus_space_tag_t, bus_addr_t, bus_size_t, int,
    110  1.77       cdi 	vaddr_t, bus_space_handle_t *);
    111  1.77       cdi static void *psycho_intr_establish(bus_space_tag_t, int, int, int (*)(void *),
    112  1.77       cdi 	void *, void(*)(void));
    113  1.77       cdi 
    114  1.77       cdi static int psycho_dmamap_load(bus_dma_tag_t, bus_dmamap_t, void *, bus_size_t,
    115  1.77       cdi 	struct proc *, int);
    116  1.77       cdi static void psycho_dmamap_unload(bus_dma_tag_t, bus_dmamap_t);
    117  1.77       cdi static int psycho_dmamap_load_raw(bus_dma_tag_t, bus_dmamap_t,
    118  1.77       cdi 	bus_dma_segment_t *, int, bus_size_t, int);
    119  1.77       cdi static void psycho_dmamap_sync(bus_dma_tag_t, bus_dmamap_t, bus_addr_t,
    120  1.77       cdi 	bus_size_t, int);
    121  1.77       cdi int psycho_dmamem_alloc(bus_dma_tag_t, bus_size_t, bus_size_t, bus_size_t,
    122  1.77       cdi 	bus_dma_segment_t *, int, int *, int);
    123  1.77       cdi void psycho_dmamem_free(bus_dma_tag_t, bus_dma_segment_t *, int);
    124  1.77       cdi int psycho_dmamem_map(bus_dma_tag_t, bus_dma_segment_t *, int, size_t,
    125  1.77       cdi 	caddr_t *, int);
    126  1.77       cdi void psycho_dmamem_unmap(bus_dma_tag_t, caddr_t, size_t);
    127   1.7       mrg 
    128   1.7       mrg /* base pci_chipset */
    129   1.1       mrg extern struct sparc_pci_chipset _sparc_pci_chipset;
    130   1.1       mrg 
    131  1.60    martin /* power button handlers */
    132  1.60    martin static void psycho_register_power_button(struct psycho_softc *sc);
    133  1.60    martin static void psycho_power_button_pressed(void *arg);
    134  1.60    martin 
    135   1.1       mrg /*
    136   1.1       mrg  * autoconfiguration
    137   1.1       mrg  */
    138  1.77       cdi static	int	psycho_match(struct device *, struct cfdata *, void *);
    139  1.77       cdi static	void	psycho_attach(struct device *, struct device *, void *);
    140  1.77       cdi static	int	psycho_print(void *aux, const char *p);
    141   1.1       mrg 
    142  1.54   thorpej CFATTACH_DECL(psycho, sizeof(struct psycho_softc),
    143  1.55   thorpej     psycho_match, psycho_attach, NULL, NULL);
    144   1.1       mrg 
    145   1.1       mrg /*
    146  1.34       eeh  * "sabre" is the UltraSPARC IIi onboard UPA to PCI bridge.  It manages a
    147  1.34       eeh  * single PCI bus and does not have a streaming buffer.  It often has an APB
    148  1.34       eeh  * (advanced PCI bridge) connected to it, which was designed specifically for
    149  1.34       eeh  * the IIi.  The APB let's the IIi handle two independednt PCI buses, and
    150  1.34       eeh  * appears as two "simba"'s underneath the sabre.
    151  1.34       eeh  *
    152  1.34       eeh  * "psycho" and "psycho+" is a dual UPA to PCI bridge.  It sits on the UPA bus
    153  1.34       eeh  * and manages two PCI buses.  "psycho" has two 64-bit 33MHz buses, while
    154  1.34       eeh  * "psycho+" controls both a 64-bit 33Mhz and a 64-bit 66Mhz PCI bus.  You
    155  1.34       eeh  * will usually find a "psycho+" since I don't think the original "psycho"
    156  1.34       eeh  * ever shipped, and if it did it would be in the U30.
    157  1.34       eeh  *
    158  1.34       eeh  * Each "psycho" PCI bus appears as a separate OFW node, but since they are
    159  1.34       eeh  * both part of the same IC, they only have a single register space.  As such,
    160  1.34       eeh  * they need to be configured together, even though the autoconfiguration will
    161  1.34       eeh  * attach them separately.
    162  1.34       eeh  *
    163  1.34       eeh  * On UltraIIi machines, "sabre" itself usually takes pci0, with "simba" often
    164  1.34       eeh  * as pci1 and pci2, although they have been implemented with other PCI bus
    165  1.34       eeh  * numbers on some machines.
    166  1.34       eeh  *
    167  1.34       eeh  * On UltraII machines, there can be any number of "psycho+" ICs, each
    168  1.34       eeh  * providing two PCI buses.
    169  1.34       eeh  *
    170  1.34       eeh  *
    171  1.34       eeh  * XXXX The psycho/sabre node has an `interrupts' attribute.  They contain
    172  1.34       eeh  * the values of the following interrupts in this order:
    173   1.1       mrg  *
    174  1.34       eeh  * PCI Bus Error	(30)
    175  1.34       eeh  * DMA UE		(2e)
    176  1.34       eeh  * DMA CE		(2f)
    177  1.34       eeh  * Power Fail		(25)
    178  1.34       eeh  *
    179  1.34       eeh  * We really should attach handlers for each.
    180   1.1       mrg  *
    181   1.1       mrg  */
    182  1.35       eeh 
    183   1.1       mrg #define	ROM_PCI_NAME		"pci"
    184  1.35       eeh 
    185  1.35       eeh struct psycho_names {
    186  1.74  christos 	const char *p_name;
    187  1.35       eeh 	int p_type;
    188  1.35       eeh } psycho_names[] = {
    189  1.35       eeh 	{ "SUNW,psycho",        PSYCHO_MODE_PSYCHO      },
    190  1.35       eeh 	{ "pci108e,8000",       PSYCHO_MODE_PSYCHO      },
    191  1.35       eeh 	{ "SUNW,sabre",         PSYCHO_MODE_SABRE       },
    192  1.35       eeh 	{ "pci108e,a000",       PSYCHO_MODE_SABRE       },
    193  1.35       eeh 	{ "pci108e,a001",       PSYCHO_MODE_SABRE       },
    194  1.35       eeh 	{ NULL, 0 }
    195  1.35       eeh };
    196   1.1       mrg 
    197   1.1       mrg static	int
    198  1.77       cdi psycho_match(struct device *parent, struct cfdata *match, void *aux)
    199   1.1       mrg {
    200   1.1       mrg 	struct mainbus_attach_args *ma = aux;
    201  1.69        pk 	char *model = prom_getpropstring(ma->ma_node, "model");
    202  1.35       eeh 	int i;
    203   1.1       mrg 
    204   1.1       mrg 	/* match on a name of "pci" and a sabre or a psycho */
    205  1.35       eeh 	if (strcmp(ma->ma_name, ROM_PCI_NAME) == 0) {
    206  1.35       eeh 		for (i=0; psycho_names[i].p_name; i++)
    207  1.35       eeh 			if (strcmp(model, psycho_names[i].p_name) == 0)
    208  1.35       eeh 				return (1);
    209  1.35       eeh 
    210  1.69        pk 		model = prom_getpropstring(ma->ma_node, "compatible");
    211  1.35       eeh 		for (i=0; psycho_names[i].p_name; i++)
    212  1.35       eeh 			if (strcmp(model, psycho_names[i].p_name) == 0)
    213  1.35       eeh 				return (1);
    214  1.35       eeh 	}
    215   1.1       mrg 	return (0);
    216   1.1       mrg }
    217   1.1       mrg 
    218  1.68    petrov #ifdef DEBUG
    219  1.68    petrov static void psycho_dump_intmap(struct psycho_softc *sc);
    220  1.68    petrov static void
    221  1.68    petrov psycho_dump_intmap(struct psycho_softc *sc)
    222  1.68    petrov {
    223  1.77       cdi 	volatile uint64_t *intrmapptr = NULL;
    224  1.68    petrov 
    225  1.68    petrov 	printf("psycho_dump_intmap: OBIO\n");
    226  1.68    petrov 
    227  1.68    petrov 	for (intrmapptr = &sc->sc_regs->scsi_int_map;
    228  1.68    petrov 	     intrmapptr < &sc->sc_regs->ue_int_map;
    229  1.68    petrov 	     intrmapptr++)
    230  1.71  nakayama 		printf("%p: %llx\n", intrmapptr,
    231  1.71  nakayama 		    (unsigned long long)*intrmapptr);
    232  1.68    petrov 
    233  1.68    petrov 	printf("\tintmap:pci\n");
    234  1.68    petrov 	for (intrmapptr = &sc->sc_regs->pcia_slot0_int;
    235  1.68    petrov 	     intrmapptr <= &sc->sc_regs->pcib_slot3_int;
    236  1.68    petrov 	     intrmapptr++)
    237  1.71  nakayama 		printf("%p: %llx\n", intrmapptr,
    238  1.71  nakayama 		    (unsigned long long)*intrmapptr);
    239  1.68    petrov 
    240  1.68    petrov 	printf("\tintmap:ffb\n");
    241  1.68    petrov 	for (intrmapptr = &sc->sc_regs->ffb0_int_map;
    242  1.68    petrov 	     intrmapptr <= &sc->sc_regs->ffb1_int_map;
    243  1.68    petrov 	     intrmapptr++)
    244  1.71  nakayama 		printf("%p: %llx\n", intrmapptr,
    245  1.71  nakayama 		    (unsigned long long)*intrmapptr);
    246  1.68    petrov }
    247  1.68    petrov #endif
    248  1.68    petrov 
    249  1.34       eeh /*
    250  1.34       eeh  * SUNW,psycho initialisation ..
    251  1.34       eeh  *	- find the per-psycho registers
    252  1.34       eeh  *	- figure out the IGN.
    253  1.34       eeh  *	- find our partner psycho
    254  1.34       eeh  *	- configure ourselves
    255  1.34       eeh  *	- bus range, bus,
    256  1.34       eeh  *	- get interrupt-map and interrupt-map-mask
    257  1.34       eeh  *	- setup the chipsets.
    258  1.34       eeh  *	- if we're the first of the pair, initialise the IOMMU, otherwise
    259  1.34       eeh  *	  just copy it's tags and addresses.
    260  1.34       eeh  */
    261   1.1       mrg static	void
    262  1.77       cdi psycho_attach(struct device *parent, struct device *self, void *aux)
    263   1.1       mrg {
    264   1.1       mrg 	struct psycho_softc *sc = (struct psycho_softc *)self;
    265  1.34       eeh 	struct psycho_softc *osc = NULL;
    266  1.34       eeh 	struct psycho_pbm *pp;
    267  1.47   thorpej 	struct pcibus_attach_args pba;
    268   1.1       mrg 	struct mainbus_attach_args *ma = aux;
    269  1.34       eeh 	bus_space_handle_t bh;
    270  1.77       cdi 	uint64_t csr;
    271  1.35       eeh 	int psycho_br[2], n, i;
    272  1.45       eeh 	bus_space_handle_t pci_ctl;
    273  1.69        pk 	char *model = prom_getpropstring(ma->ma_node, "model");
    274   1.1       mrg 
    275   1.1       mrg 	printf("\n");
    276   1.1       mrg 
    277   1.1       mrg 	sc->sc_node = ma->ma_node;
    278   1.1       mrg 	sc->sc_bustag = ma->ma_bustag;
    279   1.1       mrg 	sc->sc_dmatag = ma->ma_dmatag;
    280   1.1       mrg 
    281   1.1       mrg 	/*
    282  1.45       eeh 	 * Identify the device.
    283   1.1       mrg 	 */
    284  1.35       eeh 	for (i=0; psycho_names[i].p_name; i++)
    285  1.35       eeh 		if (strcmp(model, psycho_names[i].p_name) == 0) {
    286  1.35       eeh 			sc->sc_mode = psycho_names[i].p_type;
    287  1.35       eeh 			goto found;
    288  1.35       eeh 		}
    289  1.35       eeh 
    290  1.69        pk 	model = prom_getpropstring(ma->ma_node, "compatible");
    291  1.35       eeh 	for (i=0; psycho_names[i].p_name; i++)
    292  1.35       eeh 		if (strcmp(model, psycho_names[i].p_name) == 0) {
    293  1.35       eeh 			sc->sc_mode = psycho_names[i].p_type;
    294  1.35       eeh 			goto found;
    295  1.35       eeh 		}
    296  1.34       eeh 
    297  1.35       eeh 	panic("unknown psycho model %s", model);
    298  1.35       eeh found:
    299   1.1       mrg 
    300   1.1       mrg 	/*
    301  1.22        pk 	 * The psycho gets three register banks:
    302  1.22        pk 	 * (0) per-PBM configuration and status registers
    303  1.22        pk 	 * (1) per-PBM PCI configuration space, containing only the
    304  1.22        pk 	 *     PBM 256-byte PCI header
    305  1.22        pk 	 * (2) the shared psycho configuration registers (struct psychoreg)
    306  1.22        pk 	 */
    307  1.34       eeh 
    308  1.34       eeh 	/* Register layouts are different.  stuupid. */
    309  1.34       eeh 	if (sc->sc_mode == PSYCHO_MODE_PSYCHO) {
    310  1.34       eeh 		sc->sc_basepaddr = (paddr_t)ma->ma_reg[2].ur_paddr;
    311  1.34       eeh 
    312  1.34       eeh 		if (ma->ma_naddress > 2) {
    313  1.45       eeh 			sparc_promaddr_to_handle(sc->sc_bustag,
    314  1.45       eeh 				ma->ma_address[2], &sc->sc_bh);
    315  1.45       eeh 			sparc_promaddr_to_handle(sc->sc_bustag,
    316  1.45       eeh 				ma->ma_address[0], &pci_ctl);
    317  1.45       eeh 
    318  1.34       eeh 			sc->sc_regs = (struct psychoreg *)
    319  1.45       eeh 				bus_space_vaddr(sc->sc_bustag, sc->sc_bh);
    320  1.34       eeh 		} else if (ma->ma_nreg > 2) {
    321  1.34       eeh 
    322  1.34       eeh 			/* We need to map this in ourselves. */
    323  1.44       eeh 			if (bus_space_map(sc->sc_bustag,
    324  1.34       eeh 				ma->ma_reg[2].ur_paddr,
    325  1.45       eeh 				ma->ma_reg[2].ur_len, BUS_SPACE_MAP_LINEAR,
    326  1.45       eeh 				&sc->sc_bh))
    327  1.34       eeh 				panic("psycho_attach: cannot map regs");
    328  1.45       eeh 			sc->sc_regs = (struct psychoreg *)
    329  1.45       eeh 				bus_space_vaddr(sc->sc_bustag, sc->sc_bh);
    330  1.34       eeh 
    331  1.44       eeh 			if (bus_space_map(sc->sc_bustag,
    332  1.34       eeh 				ma->ma_reg[0].ur_paddr,
    333  1.45       eeh 				ma->ma_reg[0].ur_len, BUS_SPACE_MAP_LINEAR,
    334  1.45       eeh 				&pci_ctl))
    335  1.34       eeh 				panic("psycho_attach: cannot map ctl");
    336  1.34       eeh 		} else
    337  1.34       eeh 			panic("psycho_attach: %d not enough registers",
    338  1.34       eeh 				ma->ma_nreg);
    339  1.68    petrov 
    340  1.34       eeh 	} else {
    341  1.34       eeh 		sc->sc_basepaddr = (paddr_t)ma->ma_reg[0].ur_paddr;
    342  1.34       eeh 
    343  1.34       eeh 		if (ma->ma_naddress) {
    344  1.45       eeh 			sparc_promaddr_to_handle(sc->sc_bustag,
    345  1.45       eeh 				ma->ma_address[0], &sc->sc_bh);
    346  1.34       eeh 			sc->sc_regs = (struct psychoreg *)
    347  1.45       eeh 				bus_space_vaddr(sc->sc_bustag, sc->sc_bh);
    348  1.45       eeh 			bus_space_subregion(sc->sc_bustag, sc->sc_bh,
    349  1.45       eeh 				offsetof(struct psychoreg,  psy_pcictl),
    350  1.45       eeh 				sizeof(struct pci_ctl), &pci_ctl);
    351  1.34       eeh 		} else if (ma->ma_nreg) {
    352  1.34       eeh 
    353  1.34       eeh 			/* We need to map this in ourselves. */
    354  1.44       eeh 			if (bus_space_map(sc->sc_bustag,
    355  1.34       eeh 				ma->ma_reg[0].ur_paddr,
    356  1.45       eeh 				ma->ma_reg[0].ur_len, BUS_SPACE_MAP_LINEAR,
    357  1.45       eeh 				&sc->sc_bh))
    358  1.34       eeh 				panic("psycho_attach: cannot map regs");
    359  1.45       eeh 			sc->sc_regs = (struct psychoreg *)
    360  1.45       eeh 				bus_space_vaddr(sc->sc_bustag, sc->sc_bh);
    361  1.45       eeh 
    362  1.45       eeh 			bus_space_subregion(sc->sc_bustag, sc->sc_bh,
    363  1.45       eeh 				offsetof(struct psychoreg,  psy_pcictl),
    364  1.45       eeh 				sizeof(struct pci_ctl), &pci_ctl);
    365  1.34       eeh 		} else
    366  1.34       eeh 			panic("psycho_attach: %d not enough registers",
    367  1.34       eeh 				ma->ma_nreg);
    368  1.34       eeh 	}
    369  1.23        pk 
    370  1.45       eeh 
    371  1.45       eeh 	csr = bus_space_read_8(sc->sc_bustag, sc->sc_bh,
    372  1.45       eeh 		offsetof(struct psychoreg, psy_csr));
    373  1.34       eeh 	sc->sc_ign = 0x7c0; /* APB IGN is always 0x7c */
    374  1.34       eeh 	if (sc->sc_mode == PSYCHO_MODE_PSYCHO)
    375  1.34       eeh 		sc->sc_ign = PSYCHO_GCSR_IGN(csr) << 6;
    376  1.24        pk 
    377  1.34       eeh 	printf("%s: impl %d, version %d: ign %x ",
    378  1.34       eeh 		model, PSYCHO_GCSR_IMPL(csr), PSYCHO_GCSR_VERS(csr),
    379  1.34       eeh 		sc->sc_ign);
    380  1.22        pk 	/*
    381  1.24        pk 	 * Match other psycho's that are already configured against
    382  1.24        pk 	 * the base physical address. This will be the same for a
    383  1.24        pk 	 * pair of devices that share register space.
    384   1.1       mrg 	 */
    385   1.3       mrg 	for (n = 0; n < psycho_cd.cd_ndevs; n++) {
    386   1.8       mrg 
    387  1.24        pk 		struct psycho_softc *asc =
    388  1.24        pk 			(struct psycho_softc *)psycho_cd.cd_devs[n];
    389   1.3       mrg 
    390  1.24        pk 		if (asc == NULL || asc == sc)
    391  1.24        pk 			/* This entry is not there or it is me */
    392  1.24        pk 			continue;
    393  1.23        pk 
    394  1.24        pk 		if (asc->sc_basepaddr != sc->sc_basepaddr)
    395  1.24        pk 			/* This is an unrelated psycho */
    396   1.3       mrg 			continue;
    397   1.3       mrg 
    398  1.24        pk 		/* Found partner */
    399  1.24        pk 		osc = asc;
    400   1.8       mrg 		break;
    401   1.8       mrg 	}
    402   1.8       mrg 
    403   1.3       mrg 
    404   1.3       mrg 	/* Oh, dear.  OK, lets get started */
    405   1.3       mrg 
    406  1.24        pk 	/*
    407  1.24        pk 	 * Setup the PCI control register
    408  1.24        pk 	 */
    409  1.45       eeh 	csr = bus_space_read_8(sc->sc_bustag, pci_ctl,
    410  1.45       eeh 		offsetof(struct pci_ctl, pci_csr));
    411   1.8       mrg 	csr |= PCICTL_MRLM |
    412   1.8       mrg 	       PCICTL_ARB_PARK |
    413   1.8       mrg 	       PCICTL_ERRINTEN |
    414   1.8       mrg 	       PCICTL_4ENABLE;
    415   1.8       mrg 	csr &= ~(PCICTL_SERR |
    416   1.8       mrg 		 PCICTL_CPU_PRIO |
    417   1.8       mrg 		 PCICTL_ARB_PRIO |
    418   1.8       mrg 		 PCICTL_RTRYWAIT);
    419  1.45       eeh 	bus_space_write_8(sc->sc_bustag, pci_ctl,
    420  1.45       eeh 		offsetof(struct pci_ctl, pci_csr), csr);
    421   1.8       mrg 
    422  1.24        pk 
    423  1.24        pk 	/*
    424  1.24        pk 	 * Allocate our psycho_pbm
    425  1.24        pk 	 */
    426  1.58  nakayama 	pp = sc->sc_psycho_this = malloc(sizeof *pp, M_DEVBUF,
    427  1.58  nakayama 					 M_NOWAIT | M_ZERO);
    428  1.22        pk 	if (pp == NULL)
    429   1.8       mrg 		panic("could not allocate psycho pbm");
    430   1.8       mrg 
    431  1.22        pk 	pp->pp_sc = sc;
    432   1.8       mrg 
    433   1.8       mrg 	/* grab the psycho ranges */
    434  1.22        pk 	psycho_get_ranges(sc->sc_node, &pp->pp_range, &pp->pp_nrange);
    435   1.8       mrg 
    436   1.8       mrg 	/* get the bus-range for the psycho */
    437   1.8       mrg 	psycho_get_bus_range(sc->sc_node, psycho_br);
    438   1.8       mrg 
    439  1.47   thorpej 	pba.pba_bus = psycho_br[0];
    440  1.48       eeh 	pba.pba_bridgetag = NULL;
    441  1.58  nakayama 	pp->pp_busmax = psycho_br[1];
    442   1.8       mrg 
    443   1.8       mrg 	printf("bus range %u to %u", psycho_br[0], psycho_br[1]);
    444  1.23        pk 	printf("; PCI bus %d", psycho_br[0]);
    445   1.8       mrg 
    446  1.45       eeh 	pp->pp_pcictl = pci_ctl;
    447   1.8       mrg 
    448   1.8       mrg 	/* allocate our tags */
    449   1.8       mrg 	pp->pp_memt = psycho_alloc_mem_tag(pp);
    450   1.8       mrg 	pp->pp_iot = psycho_alloc_io_tag(pp);
    451   1.8       mrg 	pp->pp_dmat = psycho_alloc_dma_tag(pp);
    452   1.8       mrg 	pp->pp_flags = (pp->pp_memt ? PCI_FLAGS_MEM_ENABLED : 0) |
    453   1.8       mrg 		       (pp->pp_iot ? PCI_FLAGS_IO_ENABLED : 0);
    454   1.8       mrg 
    455   1.8       mrg 	/* allocate a chipset for this */
    456   1.8       mrg 	pp->pp_pc = psycho_alloc_chipset(pp, sc->sc_node, &_sparc_pci_chipset);
    457   1.8       mrg 
    458   1.8       mrg 	/* setup the rest of the psycho pbm */
    459  1.47   thorpej 	pba.pba_pc = psycho_alloc_chipset(pp, sc->sc_node, pp->pp_pc);
    460   1.8       mrg 
    461  1.68    petrov 	switch((ma->ma_reg[0].ur_paddr) & 0xf000) {
    462  1.68    petrov 	case 0x2000:
    463  1.68    petrov 		pp->pp_id = PSYCHO_PBM_A;
    464  1.68    petrov 		break;
    465  1.68    petrov 	case 0x4000:
    466  1.68    petrov 		pp->pp_id = PSYCHO_PBM_B;
    467  1.68    petrov 		break;
    468  1.68    petrov 	}
    469  1.68    petrov 
    470   1.8       mrg 	printf("\n");
    471   1.8       mrg 
    472  1.58  nakayama 	/* allocate extents for free bus space */
    473  1.58  nakayama 	pp->pp_exmem = psycho_alloc_extent(pp, sc->sc_node, 0x02, "psycho mem");
    474  1.58  nakayama 	pp->pp_exio = psycho_alloc_extent(pp, sc->sc_node, 0x01, "psycho io");
    475  1.58  nakayama 
    476  1.68    petrov #ifdef DEBUG
    477  1.68    petrov 	if (psycho_debug & PDB_INTR)
    478  1.68    petrov 		psycho_dump_intmap(sc);
    479  1.68    petrov #endif
    480  1.68    petrov 
    481   1.8       mrg 	/*
    482  1.34       eeh 	 * And finally, if we're a sabre or the first of a pair of psycho's to
    483  1.24        pk 	 * arrive here, start up the IOMMU and get a config space tag.
    484   1.8       mrg 	 */
    485  1.24        pk 	if (osc == NULL) {
    486  1.40       eeh 		uint64_t timeo;
    487  1.34       eeh 
    488  1.34       eeh 		/*
    489  1.34       eeh 		 * Establish handlers for interesting interrupts....
    490  1.34       eeh 		 *
    491  1.34       eeh 		 * XXX We need to remember these and remove this to support
    492  1.34       eeh 		 * hotplug on the UPA/FHC bus.
    493  1.34       eeh 		 *
    494  1.34       eeh 		 * XXX Not all controllers have these, but installing them
    495  1.34       eeh 		 * is better than trying to sort through this mess.
    496  1.34       eeh 		 */
    497  1.34       eeh 		psycho_set_intr(sc, 15, psycho_ue,
    498  1.34       eeh 			&sc->sc_regs->ue_int_map,
    499  1.34       eeh 			&sc->sc_regs->ue_clr_int);
    500  1.34       eeh 		psycho_set_intr(sc, 1, psycho_ce,
    501  1.34       eeh 			&sc->sc_regs->ce_int_map,
    502  1.34       eeh 			&sc->sc_regs->ce_clr_int);
    503  1.34       eeh 		psycho_set_intr(sc, 15, psycho_bus_a,
    504  1.34       eeh 			&sc->sc_regs->pciaerr_int_map,
    505  1.34       eeh 			&sc->sc_regs->pciaerr_clr_int);
    506  1.34       eeh 		psycho_set_intr(sc, 15, psycho_powerfail,
    507  1.34       eeh 			&sc->sc_regs->power_int_map,
    508  1.34       eeh 			&sc->sc_regs->power_clr_int);
    509  1.68    petrov 		psycho_register_power_button(sc);
    510  1.65    petrov 		if (sc->sc_mode != PSYCHO_MODE_SABRE) {
    511  1.78       wiz 			/* sabre doesn't have these interrupts */
    512  1.65    petrov 			psycho_set_intr(sc, 15, psycho_bus_b,
    513  1.65    petrov 					&sc->sc_regs->pciberr_int_map,
    514  1.65    petrov 					&sc->sc_regs->pciberr_clr_int);
    515  1.65    petrov 			psycho_set_intr(sc, 1, psycho_wakeup,
    516  1.65    petrov 					&sc->sc_regs->pwrmgt_int_map,
    517  1.65    petrov 					&sc->sc_regs->pwrmgt_clr_int);
    518  1.65    petrov 		}
    519  1.40       eeh 
    520  1.40       eeh 		/*
    521  1.40       eeh 		 * Apparently a number of machines with psycho and psycho+
    522  1.40       eeh 		 * controllers have interrupt latency issues.  We'll try
    523  1.40       eeh 		 * setting the interrupt retry timeout to 0xff which gives us
    524  1.40       eeh 		 * a retry of 3-6 usec (which is what sysio is set to) for the
    525  1.40       eeh 		 * moment, which seems to help alleviate this problem.
    526  1.40       eeh 		 */
    527  1.45       eeh 		timeo = sc->sc_regs->intr_retry_timer;
    528  1.40       eeh 		if (timeo > 0xfff) {
    529  1.40       eeh #ifdef DEBUG
    530  1.40       eeh 			printf("decreasing interrupt retry timeout "
    531  1.40       eeh 				"from %lx to 0xff\n", (long)timeo);
    532  1.40       eeh #endif
    533  1.45       eeh 			sc->sc_regs->intr_retry_timer = 0xff;
    534  1.40       eeh 		}
    535  1.34       eeh 
    536  1.13       eeh 		/*
    537  1.58  nakayama 		 * Allocate bus node, this contains a prom node per bus.
    538  1.58  nakayama 		 */
    539  1.58  nakayama 		pp->pp_busnode = malloc(sizeof(*pp->pp_busnode), M_DEVBUF,
    540  1.58  nakayama 					M_NOWAIT | M_ZERO);
    541  1.58  nakayama 		if (pp->pp_busnode == NULL)
    542  1.58  nakayama 			panic("psycho_attach: malloc pp->pp_busnode");
    543  1.58  nakayama 
    544  1.58  nakayama 		/*
    545  1.24        pk 		 * Setup IOMMU and PCI configuration if we're the first
    546  1.24        pk 		 * of a pair of psycho's to arrive here.
    547  1.24        pk 		 *
    548  1.13       eeh 		 * We should calculate a TSB size based on amount of RAM
    549  1.34       eeh 		 * and number of bus controllers and number an type of
    550  1.34       eeh 		 * child devices.
    551  1.13       eeh 		 *
    552  1.13       eeh 		 * For the moment, 32KB should be more than enough.
    553  1.13       eeh 		 */
    554  1.39       eeh 		sc->sc_is = malloc(sizeof(struct iommu_state),
    555  1.39       eeh 			M_DEVBUF, M_NOWAIT);
    556  1.39       eeh 		if (sc->sc_is == NULL)
    557  1.39       eeh 			panic("psycho_attach: malloc iommu_state");
    558  1.39       eeh 
    559  1.50       eeh 		/* Point the strbuf_ctl at the iommu_state */
    560  1.50       eeh 		pp->pp_sb.sb_is = sc->sc_is;
    561  1.39       eeh 
    562  1.51       eeh 		sc->sc_is->is_sb[0] = sc->sc_is->is_sb[1] = NULL;
    563  1.69        pk 		if (prom_getproplen(sc->sc_node, "no-streaming-cache") < 0) {
    564  1.50       eeh 			struct strbuf_ctl *sb = &pp->pp_sb;
    565  1.50       eeh 			vaddr_t va = (vaddr_t)&pp->pp_flush[0x40];
    566  1.50       eeh 
    567  1.50       eeh 			/*
    568  1.50       eeh 			 * Initialize the strbuf_ctl.
    569  1.50       eeh 			 *
    570  1.50       eeh 			 * The flush sync buffer must be 64-byte aligned.
    571  1.50       eeh 			 */
    572  1.50       eeh 			sb->sb_flush = (void *)(va & ~0x3f);
    573  1.50       eeh 
    574  1.49       eeh 			bus_space_subregion(sc->sc_bustag, pci_ctl,
    575  1.45       eeh 				offsetof(struct pci_ctl, pci_strbuf),
    576  1.50       eeh 				sizeof (struct iommu_strbuf), &sb->sb_sb);
    577  1.50       eeh 
    578  1.50       eeh 			/* Point our iommu at the strbuf_ctl */
    579  1.50       eeh 			sc->sc_is->is_sb[0] = sb;
    580  1.45       eeh 		}
    581  1.39       eeh 
    582  1.13       eeh 		psycho_iommu_init(sc, 2);
    583   1.8       mrg 
    584   1.8       mrg 		sc->sc_configtag = psycho_alloc_config_tag(sc->sc_psycho_this);
    585  1.44       eeh 
    586  1.44       eeh 		/*
    587  1.44       eeh 		 * XXX This is a really ugly hack because PCI config space
    588  1.44       eeh 		 * is explicitly handled with unmapped accesses.
    589  1.44       eeh 		 */
    590  1.44       eeh 		i = sc->sc_bustag->type;
    591  1.44       eeh 		sc->sc_bustag->type = PCI_CONFIG_BUS_SPACE;
    592  1.44       eeh 		if (bus_space_map(sc->sc_bustag, sc->sc_basepaddr + 0x01000000,
    593  1.58  nakayama 			0x01000000, 0, &bh))
    594  1.23        pk 			panic("could not map psycho PCI configuration space");
    595  1.44       eeh 		sc->sc_bustag->type = i;
    596  1.45       eeh 		sc->sc_configaddr = bh;
    597   1.8       mrg 	} else {
    598  1.58  nakayama 		/* Share bus numbers with the pair of mine */
    599  1.58  nakayama 		pp->pp_busnode = osc->sc_psycho_this->pp_busnode;
    600  1.58  nakayama 
    601  1.24        pk 		/* Just copy IOMMU state, config tag and address */
    602  1.24        pk 		sc->sc_is = osc->sc_is;
    603   1.8       mrg 		sc->sc_configtag = osc->sc_configtag;
    604   1.8       mrg 		sc->sc_configaddr = osc->sc_configaddr;
    605  1.39       eeh 
    606  1.50       eeh 		/* Point the strbuf_ctl at the iommu_state */
    607  1.50       eeh 		pp->pp_sb.sb_is = sc->sc_is;
    608  1.50       eeh 
    609  1.69        pk 		if (prom_getproplen(sc->sc_node, "no-streaming-cache") < 0) {
    610  1.50       eeh 			struct strbuf_ctl *sb = &pp->pp_sb;
    611  1.50       eeh 			vaddr_t va = (vaddr_t)&pp->pp_flush[0x40];
    612  1.50       eeh 
    613  1.50       eeh 			/*
    614  1.50       eeh 			 * Initialize the strbuf_ctl.
    615  1.50       eeh 			 *
    616  1.50       eeh 			 * The flush sync buffer must be 64-byte aligned.
    617  1.50       eeh 			 */
    618  1.50       eeh 			sb->sb_flush = (void *)(va & ~0x3f);
    619  1.50       eeh 
    620  1.49       eeh 			bus_space_subregion(sc->sc_bustag, pci_ctl,
    621  1.45       eeh 				offsetof(struct pci_ctl, pci_strbuf),
    622  1.50       eeh 				sizeof (struct iommu_strbuf), &sb->sb_sb);
    623  1.50       eeh 
    624  1.50       eeh 			/* Point our iommu at the strbuf_ctl */
    625  1.50       eeh 			sc->sc_is->is_sb[1] = sb;
    626  1.45       eeh 		}
    627  1.39       eeh 		iommu_reset(sc->sc_is);
    628   1.8       mrg 	}
    629  1.34       eeh 
    630  1.34       eeh 	/*
    631  1.34       eeh 	 * attach the pci.. note we pass PCI A tags, etc., for the sabre here.
    632  1.34       eeh 	 */
    633  1.47   thorpej 	pba.pba_flags = sc->sc_psycho_this->pp_flags;
    634  1.47   thorpej 	pba.pba_dmat = sc->sc_psycho_this->pp_dmat;
    635  1.63      fvdl 	pba.pba_dmat64 = NULL;
    636  1.47   thorpej 	pba.pba_iot = sc->sc_psycho_this->pp_iot;
    637  1.47   thorpej 	pba.pba_memt = sc->sc_psycho_this->pp_memt;
    638  1.34       eeh 
    639  1.73  drochner 	config_found_ia(self, "pcibus", &pba, psycho_print);
    640  1.34       eeh }
    641  1.34       eeh 
    642  1.34       eeh static	int
    643  1.77       cdi psycho_print(void *aux, const char *p)
    644  1.34       eeh {
    645  1.34       eeh 
    646  1.34       eeh 	if (p == NULL)
    647  1.34       eeh 		return (UNCONF);
    648  1.34       eeh 	return (QUIET);
    649  1.34       eeh }
    650  1.34       eeh 
    651  1.34       eeh static void
    652  1.77       cdi psycho_set_intr(struct psycho_softc *sc, int ipl, void *handler,
    653  1.77       cdi 	uint64_t *mapper, uint64_t *clearer)
    654  1.34       eeh {
    655  1.34       eeh 	struct intrhand *ih;
    656  1.34       eeh 
    657  1.34       eeh 	ih = (struct intrhand *)malloc(sizeof(struct intrhand),
    658  1.34       eeh 		M_DEVBUF, M_NOWAIT);
    659  1.34       eeh 	ih->ih_arg = sc;
    660  1.34       eeh 	ih->ih_map = mapper;
    661  1.34       eeh 	ih->ih_clr = clearer;
    662  1.34       eeh 	ih->ih_fun = handler;
    663  1.34       eeh 	ih->ih_pil = (1<<ipl);
    664  1.34       eeh 	ih->ih_number = INTVEC(*(ih->ih_map));
    665  1.34       eeh 	intr_establish(ipl, ih);
    666  1.76    martin 	*(ih->ih_map) |= INTMAP_V|(CPU_UPAID << INTMAP_TID_SHIFT);
    667   1.1       mrg }
    668   1.1       mrg 
    669   1.1       mrg /*
    670  1.60    martin  * power button handlers
    671  1.60    martin  */
    672  1.60    martin static void
    673  1.60    martin psycho_register_power_button(struct psycho_softc *sc)
    674  1.60    martin {
    675  1.60    martin 	sysmon_task_queue_init();
    676  1.60    martin 
    677  1.60    martin 	sc->sc_powerpressed = 0;
    678  1.60    martin 	sc->sc_smcontext = malloc(sizeof(struct sysmon_pswitch), M_DEVBUF, 0);
    679  1.60    martin 	if (!sc->sc_smcontext) {
    680  1.60    martin 		printf("%s: could not allocate power button context\n",
    681  1.60    martin 		    sc->sc_dev.dv_xname);
    682  1.60    martin 		return;
    683  1.60    martin 	}
    684  1.60    martin 	memset(sc->sc_smcontext, 0, sizeof(struct sysmon_pswitch));
    685  1.60    martin 	sc->sc_smcontext->smpsw_name = sc->sc_dev.dv_xname;
    686  1.60    martin 	sc->sc_smcontext->smpsw_type = PSWITCH_TYPE_POWER;
    687  1.60    martin 	if (sysmon_pswitch_register(sc->sc_smcontext) != 0)
    688  1.60    martin 		printf("%s: unable to register power button with sysmon\n",
    689  1.60    martin 		    sc->sc_dev.dv_xname);
    690  1.60    martin }
    691  1.60    martin 
    692  1.60    martin static void
    693  1.60    martin psycho_power_button_pressed(void *arg)
    694  1.60    martin {
    695  1.60    martin 	struct psycho_softc *sc = arg;
    696  1.60    martin 
    697  1.60    martin 	sysmon_pswitch_event(sc->sc_smcontext, PSWITCH_EVENT_PRESSED);
    698  1.60    martin 	sc->sc_powerpressed = 0;
    699  1.60    martin }
    700  1.60    martin 
    701  1.60    martin /*
    702   1.1       mrg  * PCI bus support
    703   1.1       mrg  */
    704   1.1       mrg 
    705   1.1       mrg /*
    706   1.1       mrg  * allocate a PCI chipset tag and set it's cookie.
    707   1.1       mrg  */
    708   1.1       mrg static pci_chipset_tag_t
    709  1.77       cdi psycho_alloc_chipset(struct psycho_pbm *pp, int node, pci_chipset_tag_t pc)
    710   1.1       mrg {
    711   1.1       mrg 	pci_chipset_tag_t npc;
    712   1.1       mrg 
    713   1.1       mrg 	npc = malloc(sizeof *npc, M_DEVBUF, M_NOWAIT);
    714   1.1       mrg 	if (npc == NULL)
    715   1.1       mrg 		panic("could not allocate pci_chipset_tag_t");
    716   1.1       mrg 	memcpy(npc, pc, sizeof *pc);
    717   1.1       mrg 	npc->cookie = pp;
    718  1.34       eeh 	npc->rootnode = node;
    719   1.1       mrg 
    720   1.1       mrg 	return (npc);
    721   1.1       mrg }
    722   1.1       mrg 
    723   1.1       mrg /*
    724  1.58  nakayama  * create extent for free bus space, then allocate assigned regions.
    725  1.58  nakayama  */
    726  1.58  nakayama static struct extent *
    727  1.77       cdi psycho_alloc_extent(struct psycho_pbm *pp, int node, int ss, const char *name)
    728  1.58  nakayama {
    729  1.58  nakayama 	struct psycho_registers *pa = NULL;
    730  1.58  nakayama 	struct psycho_ranges *pr;
    731  1.58  nakayama 	struct extent *ex;
    732  1.58  nakayama 	bus_addr_t baddr, addr;
    733  1.58  nakayama 	bus_size_t bsize, size;
    734  1.58  nakayama 	int i, num;
    735  1.58  nakayama 
    736  1.58  nakayama 	/* get bus space size */
    737  1.58  nakayama 	pr = get_psychorange(pp, ss);
    738  1.58  nakayama 	if (pr == NULL) {
    739  1.58  nakayama 		printf("psycho_alloc_extent: get_psychorange failed\n");
    740  1.58  nakayama 		return NULL;
    741  1.58  nakayama 	}
    742  1.58  nakayama 	baddr = 0x00000000;
    743  1.58  nakayama 	bsize = BUS_ADDR(pr->size_hi, pr->size_lo);
    744  1.58  nakayama 
    745  1.58  nakayama 	/* get available lists */
    746  1.70    martin 	num = 0;
    747  1.69        pk 	if (prom_getprop(node, "available", sizeof(*pa), &num, &pa)) {
    748  1.69        pk 		printf("psycho_alloc_extent: prom_getprop failed\n");
    749  1.58  nakayama 		return NULL;
    750  1.58  nakayama 	}
    751  1.58  nakayama 
    752  1.58  nakayama 	/* create extent */
    753  1.58  nakayama 	ex = extent_create(name, baddr, bsize - baddr - 1, M_DEVBUF, 0, 0,
    754  1.58  nakayama 			   EX_NOWAIT);
    755  1.58  nakayama 	if (ex == NULL) {
    756  1.58  nakayama 		printf("psycho_alloc_extent: extent_create failed\n");
    757  1.58  nakayama 		goto ret;
    758  1.58  nakayama 	}
    759  1.58  nakayama 
    760  1.58  nakayama 	/* allocate assigned regions */
    761  1.58  nakayama 	for (i = 0; i < num; i++)
    762  1.58  nakayama 		if (((pa[i].phys_hi >> 24) & 0x03) == ss) {
    763  1.58  nakayama 			/* allocate bus space */
    764  1.58  nakayama 			addr = BUS_ADDR(pa[i].phys_mid, pa[i].phys_lo);
    765  1.58  nakayama 			size = BUS_ADDR(pa[i].size_hi, pa[i].size_lo);
    766  1.58  nakayama 			if (extent_alloc_region(ex, baddr, addr - baddr,
    767  1.58  nakayama 						EX_NOWAIT)) {
    768  1.58  nakayama 				printf("psycho_alloc_extent: "
    769  1.58  nakayama 				       "extent_alloc_region %" PRIx64 "-%"
    770  1.58  nakayama 				       PRIx64 " failed\n", baddr, addr);
    771  1.58  nakayama 				extent_destroy(ex);
    772  1.58  nakayama 				ex = NULL;
    773  1.58  nakayama 				goto ret;
    774  1.58  nakayama 			}
    775  1.58  nakayama 			baddr = addr + size;
    776  1.58  nakayama 		}
    777  1.58  nakayama 	/* allocate left region if available */
    778  1.58  nakayama 	if (baddr < bsize)
    779  1.58  nakayama 		if (extent_alloc_region(ex, baddr, bsize - baddr, EX_NOWAIT)) {
    780  1.58  nakayama 			printf("psycho_alloc_extent: extent_alloc_region %"
    781  1.58  nakayama 			       PRIx64 "-%" PRIx64 " failed\n", baddr, bsize);
    782  1.58  nakayama 			extent_destroy(ex);
    783  1.58  nakayama 			ex = NULL;
    784  1.58  nakayama 			goto ret;
    785  1.58  nakayama 		}
    786  1.58  nakayama 
    787  1.58  nakayama #ifdef DEBUG
    788  1.58  nakayama 	/* print extent */
    789  1.58  nakayama 	extent_print(ex);
    790  1.58  nakayama #endif
    791  1.58  nakayama 
    792  1.58  nakayama ret:
    793  1.58  nakayama 	/* return extent */
    794  1.58  nakayama 	free(pa, M_DEVBUF);
    795  1.58  nakayama 	return ex;
    796  1.58  nakayama }
    797  1.58  nakayama 
    798  1.58  nakayama /*
    799   1.1       mrg  * grovel the OBP for various psycho properties
    800   1.1       mrg  */
    801   1.1       mrg static void
    802  1.77       cdi psycho_get_bus_range(int node, int *brp)
    803   1.1       mrg {
    804  1.70    martin 	int n, error;
    805   1.1       mrg 
    806  1.72  nakayama 	n = 2;
    807  1.70    martin 	error = prom_getprop(node, "bus-range", sizeof(*brp), &n, &brp);
    808  1.70    martin 	if (error)
    809  1.70    martin 		panic("could not get psycho bus-range, error %d", error);
    810   1.1       mrg 	if (n != 2)
    811   1.1       mrg 		panic("broken psycho bus-range");
    812  1.68    petrov 	DPRINTF(PDB_PROM, ("psycho debug: got `bus-range' for node %08x: %u - %u\n",
    813  1.68    petrov 			   node, brp[0], brp[1]));
    814   1.1       mrg }
    815   1.1       mrg 
    816   1.1       mrg static void
    817  1.77       cdi psycho_get_ranges(int node, struct psycho_ranges **rp, int *np)
    818   1.1       mrg {
    819   1.1       mrg 
    820  1.69        pk 	if (prom_getprop(node, "ranges", sizeof(**rp), np, rp))
    821   1.1       mrg 		panic("could not get psycho ranges");
    822   1.1       mrg 	DPRINTF(PDB_PROM, ("psycho debug: got `ranges' for node %08x: %d entries\n", node, *np));
    823   1.1       mrg }
    824   1.1       mrg 
    825  1.34       eeh /*
    826  1.34       eeh  * Interrupt handlers.
    827  1.34       eeh  */
    828  1.34       eeh 
    829  1.34       eeh static int
    830  1.77       cdi psycho_ue(void *arg)
    831  1.34       eeh {
    832  1.34       eeh 	struct psycho_softc *sc = (struct psycho_softc *)arg;
    833  1.34       eeh 	struct psychoreg *regs = sc->sc_regs;
    834  1.36       eeh 	long long afsr = regs->psy_ue_afsr;
    835  1.36       eeh 	long long afar = regs->psy_ue_afar;
    836  1.59   thorpej 	long size = PAGE_SIZE<<(sc->sc_is->is_tsbsize);
    837  1.41       eeh 	struct iommu_state *is = sc->sc_is;
    838  1.36       eeh 	char bits[128];
    839  1.34       eeh 
    840  1.34       eeh 	/*
    841  1.34       eeh 	 * It's uncorrectable.  Dump the regs and panic.
    842  1.34       eeh 	 */
    843  1.46       eeh 	printf("%s: uncorrectable DMA error AFAR %llx pa %llx AFSR %llx:\n%s\n",
    844  1.36       eeh 		sc->sc_dev.dv_xname, afar,
    845  1.41       eeh 		(long long)iommu_extract(is, (vaddr_t)afar), afsr,
    846  1.36       eeh 		bitmask_snprintf(afsr, PSYCHO_UE_AFSR_BITS,
    847  1.36       eeh 			bits, sizeof(bits)));
    848  1.41       eeh 
    849  1.41       eeh 	/* Sometimes the AFAR points to an IOTSB entry */
    850  1.41       eeh 	if (afar >= is->is_ptsb && afar < is->is_ptsb + size) {
    851  1.42    martin 		printf("IOVA %llx IOTTE %llx\n",
    852  1.59   thorpej 			(long long)((afar - is->is_ptsb) * PAGE_SIZE + is->is_dvmabase),
    853  1.41       eeh 			(long long)ldxa(afar, ASI_PHYS_CACHED));
    854  1.41       eeh 	}
    855  1.43       chs #ifdef DDB
    856  1.41       eeh 	Debugger();
    857  1.43       chs #endif
    858  1.41       eeh 	regs->psy_ue_afar = 0;
    859  1.41       eeh 	regs->psy_ue_afsr = 0;
    860  1.34       eeh 	return (1);
    861  1.34       eeh }
    862  1.34       eeh static int
    863  1.77       cdi psycho_ce(void *arg)
    864   1.1       mrg {
    865  1.34       eeh 	struct psycho_softc *sc = (struct psycho_softc *)arg;
    866  1.34       eeh 	struct psychoreg *regs = sc->sc_regs;
    867  1.34       eeh 
    868  1.34       eeh 	/*
    869  1.34       eeh 	 * It's correctable.  Dump the regs and continue.
    870  1.34       eeh 	 */
    871   1.1       mrg 
    872  1.34       eeh 	printf("%s: correctable DMA error AFAR %llx AFSR %llx\n",
    873  1.34       eeh 		sc->sc_dev.dv_xname,
    874  1.34       eeh 		(long long)regs->psy_ce_afar, (long long)regs->psy_ce_afsr);
    875  1.34       eeh 	return (1);
    876   1.1       mrg }
    877  1.34       eeh static int
    878  1.77       cdi psycho_bus_a(void *arg)
    879  1.34       eeh {
    880  1.34       eeh 	struct psycho_softc *sc = (struct psycho_softc *)arg;
    881  1.34       eeh 	struct psychoreg *regs = sc->sc_regs;
    882  1.34       eeh 
    883  1.34       eeh 	/*
    884  1.34       eeh 	 * It's uncorrectable.  Dump the regs and panic.
    885  1.34       eeh 	 */
    886   1.1       mrg 
    887  1.52    provos 	panic("%s: PCI bus A error AFAR %llx AFSR %llx",
    888  1.34       eeh 		sc->sc_dev.dv_xname,
    889  1.35       eeh 		(long long)regs->psy_pcictl[0].pci_afar,
    890  1.35       eeh 		(long long)regs->psy_pcictl[0].pci_afsr);
    891  1.34       eeh 	return (1);
    892  1.34       eeh }
    893  1.34       eeh static int
    894  1.77       cdi psycho_bus_b(void *arg)
    895   1.1       mrg {
    896  1.34       eeh 	struct psycho_softc *sc = (struct psycho_softc *)arg;
    897  1.34       eeh 	struct psychoreg *regs = sc->sc_regs;
    898  1.34       eeh 
    899  1.34       eeh 	/*
    900  1.34       eeh 	 * It's uncorrectable.  Dump the regs and panic.
    901  1.34       eeh 	 */
    902   1.1       mrg 
    903  1.52    provos 	panic("%s: PCI bus B error AFAR %llx AFSR %llx",
    904  1.34       eeh 		sc->sc_dev.dv_xname,
    905  1.35       eeh 		(long long)regs->psy_pcictl[0].pci_afar,
    906  1.35       eeh 		(long long)regs->psy_pcictl[0].pci_afsr);
    907  1.34       eeh 	return (1);
    908   1.1       mrg }
    909  1.60    martin 
    910  1.34       eeh static int
    911  1.77       cdi psycho_powerfail(void *arg)
    912  1.34       eeh {
    913  1.60    martin 	struct psycho_softc *sc = (struct psycho_softc *)arg;
    914   1.1       mrg 
    915  1.34       eeh 	/*
    916  1.60    martin 	 * We lost power. Queue a callback with thread context to
    917  1.60    martin 	 * handle all the real work.
    918  1.34       eeh 	 */
    919  1.60    martin 	if (sc->sc_powerpressed == 0 && sc->sc_smcontext != NULL) {
    920  1.60    martin 		sc->sc_powerpressed = 1;
    921  1.60    martin 		sysmon_task_queue_sched(0, psycho_power_button_pressed, sc);
    922  1.60    martin 	}
    923  1.34       eeh 	return (1);
    924  1.34       eeh }
    925  1.60    martin 
    926  1.34       eeh static
    927  1.77       cdi int psycho_wakeup(void *arg)
    928   1.1       mrg {
    929  1.34       eeh 	struct psycho_softc *sc = (struct psycho_softc *)arg;
    930   1.1       mrg 
    931  1.34       eeh 	/*
    932  1.34       eeh 	 * Gee, we don't really have a framework to deal with this
    933  1.34       eeh 	 * properly.
    934  1.34       eeh 	 */
    935  1.34       eeh 	printf("%s: power management wakeup\n",	sc->sc_dev.dv_xname);
    936  1.34       eeh 	return (1);
    937   1.1       mrg }
    938   1.1       mrg 
    939  1.34       eeh 
    940  1.34       eeh 
    941   1.1       mrg /*
    942   1.1       mrg  * initialise the IOMMU..
    943   1.1       mrg  */
    944   1.1       mrg void
    945  1.77       cdi psycho_iommu_init(struct psycho_softc *sc, int tsbsize)
    946   1.1       mrg {
    947   1.1       mrg 	char *name;
    948  1.39       eeh 	struct iommu_state *is = sc->sc_is;
    949  1.77       cdi 	uint32_t iobase = -1;
    950  1.34       eeh 	int *vdma = NULL;
    951  1.34       eeh 	int nitem;
    952  1.24        pk 
    953   1.1       mrg 	/* punch in our copies */
    954  1.24        pk 	is->is_bustag = sc->sc_bustag;
    955  1.45       eeh 	bus_space_subregion(sc->sc_bustag, sc->sc_bh,
    956  1.45       eeh 		offsetof(struct psychoreg, psy_iommu),
    957  1.45       eeh 		sizeof (struct iommureg),
    958  1.45       eeh 		&is->is_iommu);
    959   1.1       mrg 
    960  1.34       eeh 	/*
    961  1.34       eeh 	 * Separate the men from the boys.  Get the `virtual-dma'
    962  1.34       eeh 	 * property for sabre and use that to make sure the damn
    963  1.34       eeh 	 * iommu works.
    964  1.34       eeh 	 *
    965  1.34       eeh 	 * We could query the `#virtual-dma-size-cells' and
    966  1.34       eeh 	 * `#virtual-dma-addr-cells' and DTRT, but I'm lazy.
    967  1.34       eeh 	 */
    968  1.70    martin 	nitem = 0;
    969  1.69        pk 	if (!prom_getprop(sc->sc_node, "virtual-dma", sizeof(vdma), &nitem,
    970  1.66       mrg 		&vdma)) {
    971  1.34       eeh 		/* Damn.  Gotta use these values. */
    972  1.34       eeh 		iobase = vdma[0];
    973  1.34       eeh #define	TSBCASE(x)	case 1<<((x)+23): tsbsize = (x); break
    974  1.34       eeh 		switch (vdma[1]) {
    975  1.34       eeh 			TSBCASE(1); TSBCASE(2); TSBCASE(3);
    976  1.34       eeh 			TSBCASE(4); TSBCASE(5); TSBCASE(6);
    977  1.34       eeh 		default:
    978  1.34       eeh 			printf("bogus tsb size %x, using 7\n", vdma[1]);
    979  1.34       eeh 			TSBCASE(7);
    980  1.34       eeh 		}
    981  1.34       eeh #undef TSBCASE
    982  1.34       eeh 	}
    983  1.34       eeh 
    984   1.1       mrg 	/* give us a nice name.. */
    985   1.1       mrg 	name = (char *)malloc(32, M_DEVBUF, M_NOWAIT);
    986   1.1       mrg 	if (name == 0)
    987   1.1       mrg 		panic("couldn't malloc iommu name");
    988   1.1       mrg 	snprintf(name, 32, "%s dvma", sc->sc_dev.dv_xname);
    989   1.1       mrg 
    990  1.34       eeh 	iommu_init(name, is, tsbsize, iobase);
    991   1.7       mrg }
    992   1.7       mrg 
    993   1.7       mrg /*
    994  1.61       wiz  * below here is bus space and bus DMA support
    995   1.7       mrg  */
    996   1.7       mrg bus_space_tag_t
    997  1.77       cdi psycho_alloc_bus_tag(struct psycho_pbm *pp, int type)
    998   1.7       mrg {
    999   1.7       mrg 	struct psycho_softc *sc = pp->pp_sc;
   1000   1.7       mrg 	bus_space_tag_t bt;
   1001   1.7       mrg 
   1002   1.7       mrg 	bt = (bus_space_tag_t)
   1003   1.7       mrg 		malloc(sizeof(struct sparc_bus_space_tag), M_DEVBUF, M_NOWAIT);
   1004   1.7       mrg 	if (bt == NULL)
   1005   1.7       mrg 		panic("could not allocate psycho bus tag");
   1006   1.7       mrg 
   1007  1.67    martin 	memset(bt, 0, sizeof *bt);
   1008   1.7       mrg 	bt->cookie = pp;
   1009   1.7       mrg 	bt->parent = sc->sc_bustag;
   1010   1.7       mrg 	bt->type = type;
   1011   1.7       mrg 	bt->sparc_bus_map = _psycho_bus_map;
   1012   1.7       mrg 	bt->sparc_bus_mmap = psycho_bus_mmap;
   1013   1.7       mrg 	bt->sparc_intr_establish = psycho_intr_establish;
   1014   1.7       mrg 	return (bt);
   1015   1.7       mrg }
   1016   1.7       mrg 
   1017   1.7       mrg bus_dma_tag_t
   1018  1.77       cdi psycho_alloc_dma_tag(struct psycho_pbm *pp)
   1019   1.7       mrg {
   1020   1.7       mrg 	struct psycho_softc *sc = pp->pp_sc;
   1021   1.7       mrg 	bus_dma_tag_t dt, pdt = sc->sc_dmatag;
   1022   1.7       mrg 
   1023   1.7       mrg 	dt = (bus_dma_tag_t)
   1024   1.7       mrg 		malloc(sizeof(struct sparc_bus_dma_tag), M_DEVBUF, M_NOWAIT);
   1025   1.7       mrg 	if (dt == NULL)
   1026  1.61       wiz 		panic("could not allocate psycho DMA tag");
   1027   1.7       mrg 
   1028  1.67    martin 	memset(dt, 0, sizeof *dt);
   1029   1.7       mrg 	dt->_cookie = pp;
   1030   1.7       mrg 	dt->_parent = pdt;
   1031   1.7       mrg #define PCOPY(x)	dt->x = pdt->x
   1032   1.7       mrg 	PCOPY(_dmamap_create);
   1033   1.7       mrg 	PCOPY(_dmamap_destroy);
   1034   1.7       mrg 	dt->_dmamap_load = psycho_dmamap_load;
   1035   1.7       mrg 	PCOPY(_dmamap_load_mbuf);
   1036   1.7       mrg 	PCOPY(_dmamap_load_uio);
   1037   1.9       eeh 	dt->_dmamap_load_raw = psycho_dmamap_load_raw;
   1038   1.7       mrg 	dt->_dmamap_unload = psycho_dmamap_unload;
   1039   1.7       mrg 	dt->_dmamap_sync = psycho_dmamap_sync;
   1040   1.7       mrg 	dt->_dmamem_alloc = psycho_dmamem_alloc;
   1041   1.7       mrg 	dt->_dmamem_free = psycho_dmamem_free;
   1042   1.7       mrg 	dt->_dmamem_map = psycho_dmamem_map;
   1043   1.7       mrg 	dt->_dmamem_unmap = psycho_dmamem_unmap;
   1044   1.7       mrg 	PCOPY(_dmamem_mmap);
   1045   1.7       mrg #undef	PCOPY
   1046   1.7       mrg 	return (dt);
   1047   1.7       mrg }
   1048   1.7       mrg 
   1049   1.7       mrg /*
   1050   1.7       mrg  * bus space support.  <sparc64/dev/psychoreg.h> has a discussion about
   1051   1.7       mrg  * PCI physical addresses.
   1052   1.7       mrg  */
   1053   1.7       mrg 
   1054   1.7       mrg static int
   1055  1.77       cdi get_childspace(int type)
   1056   1.7       mrg {
   1057   1.7       mrg 	int ss;
   1058   1.7       mrg 
   1059   1.7       mrg 	switch (type) {
   1060   1.7       mrg 	case PCI_CONFIG_BUS_SPACE:
   1061   1.7       mrg 		ss = 0x00;
   1062   1.7       mrg 		break;
   1063   1.7       mrg 	case PCI_IO_BUS_SPACE:
   1064   1.7       mrg 		ss = 0x01;
   1065   1.7       mrg 		break;
   1066   1.7       mrg 	case PCI_MEMORY_BUS_SPACE:
   1067   1.7       mrg 		ss = 0x02;
   1068   1.7       mrg 		break;
   1069   1.7       mrg #if 0
   1070   1.7       mrg 	/* we don't do 64 bit memory space */
   1071   1.7       mrg 	case PCI_MEMORY64_BUS_SPACE:
   1072   1.7       mrg 		ss = 0x03;
   1073   1.7       mrg 		break;
   1074   1.7       mrg #endif
   1075   1.7       mrg 	default:
   1076   1.7       mrg 		panic("get_childspace: unknown bus type");
   1077   1.7       mrg 	}
   1078   1.7       mrg 
   1079   1.7       mrg 	return (ss);
   1080   1.7       mrg }
   1081   1.7       mrg 
   1082  1.58  nakayama static struct psycho_ranges *
   1083  1.77       cdi get_psychorange(struct psycho_pbm *pp, int ss)
   1084  1.58  nakayama {
   1085  1.58  nakayama 	int i;
   1086  1.58  nakayama 
   1087  1.58  nakayama 	for (i = 0; i < pp->pp_nrange; i++) {
   1088  1.58  nakayama 		if (((pp->pp_range[i].cspace >> 24) & 0x03) == ss)
   1089  1.58  nakayama 			return (&pp->pp_range[i]);
   1090  1.58  nakayama 	}
   1091  1.58  nakayama 	/* not found */
   1092  1.58  nakayama 	return (NULL);
   1093  1.58  nakayama }
   1094  1.58  nakayama 
   1095   1.7       mrg static int
   1096  1.77       cdi _psycho_bus_map(bus_space_tag_t t, bus_addr_t offset, bus_size_t size,
   1097  1.77       cdi 	int flags, vaddr_t unused, bus_space_handle_t *hp)
   1098   1.7       mrg {
   1099   1.7       mrg 	struct psycho_pbm *pp = t->cookie;
   1100   1.7       mrg 	struct psycho_softc *sc = pp->pp_sc;
   1101  1.58  nakayama 	struct psycho_ranges *pr;
   1102  1.58  nakayama 	bus_addr_t paddr;
   1103  1.58  nakayama 	int ss;
   1104   1.7       mrg 
   1105  1.44       eeh 	DPRINTF(PDB_BUSMAP,
   1106  1.44       eeh 		("_psycho_bus_map: type %d off %qx sz %qx flags %d",
   1107  1.44       eeh 			t->type, (unsigned long long)offset,
   1108  1.44       eeh 			(unsigned long long)size, flags));
   1109   1.7       mrg 
   1110   1.7       mrg 	ss = get_childspace(t->type);
   1111   1.7       mrg 	DPRINTF(PDB_BUSMAP, (" cspace %d", ss));
   1112   1.7       mrg 
   1113  1.58  nakayama 	pr = get_psychorange(pp, ss);
   1114  1.58  nakayama 	if (pr != NULL) {
   1115  1.58  nakayama 		paddr = BUS_ADDR(pr->phys_hi, pr->phys_lo + offset);
   1116  1.58  nakayama 		DPRINTF(PDB_BUSMAP, ("\n_psycho_bus_map: mapping paddr "
   1117  1.58  nakayama 				     "space %lx offset %lx paddr %qx\n",
   1118  1.27      fvdl 			       (long)ss, (long)offset,
   1119  1.27      fvdl 			       (unsigned long long)paddr));
   1120  1.44       eeh 		return ((*sc->sc_bustag->sparc_bus_map)(t, paddr, size,
   1121  1.44       eeh 			flags, 0, hp));
   1122   1.7       mrg 	}
   1123   1.7       mrg 	DPRINTF(PDB_BUSMAP, (" FAILED\n"));
   1124   1.7       mrg 	return (EINVAL);
   1125   1.7       mrg }
   1126   1.7       mrg 
   1127  1.37       eeh static paddr_t
   1128  1.77       cdi psycho_bus_mmap(bus_space_tag_t t, bus_addr_t paddr, off_t off, int prot,
   1129  1.77       cdi 	int flags)
   1130   1.7       mrg {
   1131   1.7       mrg 	bus_addr_t offset = paddr;
   1132   1.7       mrg 	struct psycho_pbm *pp = t->cookie;
   1133   1.7       mrg 	struct psycho_softc *sc = pp->pp_sc;
   1134  1.58  nakayama 	struct psycho_ranges *pr;
   1135  1.58  nakayama 	int ss;
   1136   1.7       mrg 
   1137   1.7       mrg 	ss = get_childspace(t->type);
   1138   1.7       mrg 
   1139  1.37       eeh 	DPRINTF(PDB_BUSMAP, ("_psycho_bus_mmap: prot %x flags %d pa %qx\n",
   1140  1.37       eeh 		prot, flags, (unsigned long long)paddr));
   1141   1.7       mrg 
   1142  1.58  nakayama 	pr = get_psychorange(pp, ss);
   1143  1.58  nakayama 	if (pr != NULL) {
   1144  1.58  nakayama 		paddr = BUS_ADDR(pr->phys_hi, pr->phys_lo + offset);
   1145  1.37       eeh 		DPRINTF(PDB_BUSMAP, ("\n_psycho_bus_mmap: mapping paddr "
   1146  1.58  nakayama 				     "space %lx offset %lx paddr %qx\n",
   1147  1.27      fvdl 			       (long)ss, (long)offset,
   1148  1.27      fvdl 			       (unsigned long long)paddr));
   1149  1.37       eeh 		return (bus_space_mmap(sc->sc_bustag, paddr, off,
   1150  1.37       eeh 				       prot, flags));
   1151   1.7       mrg 	}
   1152   1.7       mrg 
   1153  1.58  nakayama 	return (-1);
   1154  1.58  nakayama }
   1155  1.58  nakayama 
   1156  1.58  nakayama /*
   1157  1.58  nakayama  * Get a PCI offset address from bus_space_handle_t.
   1158  1.58  nakayama  */
   1159  1.58  nakayama bus_addr_t
   1160  1.77       cdi psycho_bus_offset(bus_space_tag_t t, bus_space_handle_t *hp)
   1161  1.58  nakayama {
   1162  1.58  nakayama 	struct psycho_pbm *pp = t->cookie;
   1163  1.58  nakayama 	struct psycho_ranges *pr;
   1164  1.58  nakayama 	bus_addr_t addr, offset;
   1165  1.58  nakayama 	vaddr_t va;
   1166  1.58  nakayama 	int ss;
   1167  1.58  nakayama 
   1168  1.58  nakayama 	addr = hp->_ptr;
   1169  1.58  nakayama 	ss = get_childspace(t->type);
   1170  1.58  nakayama 	DPRINTF(PDB_BUSMAP, ("psycho_bus_offset: type %d addr %" PRIx64
   1171  1.58  nakayama 			     " cspace %d", t->type, addr, ss));
   1172  1.58  nakayama 
   1173  1.58  nakayama 	pr = get_psychorange(pp, ss);
   1174  1.58  nakayama 	if (pr != NULL) {
   1175  1.58  nakayama 		if (!PHYS_ASI(hp->_asi)) {
   1176  1.58  nakayama 			va = trunc_page((vaddr_t)addr);
   1177  1.58  nakayama 			if (pmap_extract(pmap_kernel(), va, &addr) == FALSE) {
   1178  1.58  nakayama 				DPRINTF(PDB_BUSMAP,
   1179  1.58  nakayama 					("\n pmap_extract FAILED\n"));
   1180  1.58  nakayama 				return (-1);
   1181  1.58  nakayama 			}
   1182  1.58  nakayama 			addr += hp->_ptr & PGOFSET;
   1183  1.58  nakayama 		}
   1184  1.58  nakayama 		offset = BUS_ADDR_PADDR(addr) - pr->phys_lo;
   1185  1.58  nakayama 		DPRINTF(PDB_BUSMAP, ("\npsycho_bus_offset: paddr %" PRIx64
   1186  1.58  nakayama 				     " offset %" PRIx64 "\n", addr, offset));
   1187  1.58  nakayama 		return (offset);
   1188  1.58  nakayama 	}
   1189  1.58  nakayama 	DPRINTF(PDB_BUSMAP, ("\n FAILED\n"));
   1190   1.7       mrg 	return (-1);
   1191   1.7       mrg }
   1192   1.7       mrg 
   1193   1.7       mrg 
   1194   1.7       mrg /*
   1195   1.7       mrg  * install an interrupt handler for a PCI device
   1196   1.7       mrg  */
   1197   1.7       mrg void *
   1198  1.77       cdi psycho_intr_establish(bus_space_tag_t t, int ihandle, int level,
   1199  1.77       cdi 	int (*handler)(void *), void *arg, void (*fastvec)(void) /* ignored */)
   1200   1.7       mrg {
   1201   1.7       mrg 	struct psycho_pbm *pp = t->cookie;
   1202   1.7       mrg 	struct psycho_softc *sc = pp->pp_sc;
   1203   1.7       mrg 	struct intrhand *ih;
   1204  1.77       cdi 	volatile uint64_t *intrmapptr = NULL, *intrclrptr = NULL;
   1205  1.74  christos 	int64_t imap = 0;
   1206   1.7       mrg 	int ino;
   1207  1.34       eeh 	long vec = INTVEC(ihandle);
   1208   1.7       mrg 
   1209   1.7       mrg 	ih = (struct intrhand *)
   1210   1.7       mrg 		malloc(sizeof(struct intrhand), M_DEVBUF, M_NOWAIT);
   1211   1.7       mrg 	if (ih == NULL)
   1212   1.7       mrg 		return (NULL);
   1213   1.7       mrg 
   1214  1.34       eeh 	/*
   1215  1.34       eeh 	 * Hunt through all the interrupt mapping regs to look for our
   1216  1.34       eeh 	 * interrupt vector.
   1217  1.34       eeh 	 *
   1218  1.34       eeh 	 * XXX We only compare INOs rather than IGNs since the firmware may
   1219  1.34       eeh 	 * not provide the IGN and the IGN is constant for all device on that
   1220  1.34       eeh 	 * PCI controller.  This could cause problems for the FFB/external
   1221  1.34       eeh 	 * interrupt which has a full vector that can be set arbitrarily.
   1222  1.34       eeh 	 */
   1223  1.34       eeh 
   1224  1.31       mrg 	DPRINTF(PDB_INTR, ("\npsycho_intr_establish: ihandle %x vec %lx", ihandle, vec));
   1225   1.7       mrg 	ino = INTINO(vec);
   1226   1.7       mrg 	DPRINTF(PDB_INTR, (" ino %x", ino));
   1227  1.34       eeh 
   1228  1.34       eeh 	/* If the device didn't ask for an IPL, use the one encoded. */
   1229  1.34       eeh 	if (level == IPL_NONE) level = INTLEV(vec);
   1230  1.34       eeh 	/* If it still has no level, print a warning and assign IPL 2 */
   1231  1.34       eeh 	if (level == IPL_NONE) {
   1232  1.34       eeh 		printf("ERROR: no IPL, setting IPL 2.\n");
   1233  1.34       eeh 		level = 2;
   1234  1.34       eeh 	}
   1235  1.34       eeh 
   1236  1.56        pk 	DPRINTF(PDB_INTR, ("\npsycho: intr %lx: %p\nHunting for IRQ...\n",
   1237  1.56        pk 	    (long)ino, intrlev[ino]));
   1238   1.7       mrg 
   1239  1.56        pk 	/* Hunt thru obio first */
   1240  1.56        pk 	for (intrmapptr = &sc->sc_regs->scsi_int_map,
   1241  1.56        pk 		     intrclrptr = &sc->sc_regs->scsi_clr_int;
   1242  1.65    petrov 	     intrmapptr < &sc->sc_regs->ue_int_map;
   1243  1.56        pk 	     intrmapptr++, intrclrptr++) {
   1244  1.56        pk 		if (INTINO(*intrmapptr) == ino)
   1245  1.56        pk 			goto found;
   1246  1.56        pk 	}
   1247   1.7       mrg 
   1248  1.56        pk 	/* Now do PCI interrupts */
   1249  1.56        pk 	for (intrmapptr = &sc->sc_regs->pcia_slot0_int,
   1250  1.56        pk 		     intrclrptr = &sc->sc_regs->pcia0_clr_int[0];
   1251  1.56        pk 	     intrmapptr <= &sc->sc_regs->pcib_slot3_int;
   1252  1.56        pk 	     intrmapptr++, intrclrptr += 4) {
   1253  1.68    petrov 		if (sc->sc_mode == PSYCHO_MODE_PSYCHO &&
   1254  1.68    petrov 		    (intrmapptr == &sc->sc_regs->pcia_slot2_int ||
   1255  1.68    petrov 		     intrmapptr == &sc->sc_regs->pcia_slot3_int))
   1256  1.68    petrov 			continue;
   1257  1.56        pk 		if (((*intrmapptr ^ vec) & 0x3c) == 0) {
   1258  1.56        pk 			intrclrptr += vec & 0x3;
   1259  1.56        pk 			goto found;
   1260  1.34       eeh 		}
   1261  1.56        pk 	}
   1262   1.7       mrg 
   1263  1.56        pk 	/* Finally check the two FFB slots */
   1264  1.56        pk 	intrclrptr = NULL; /* XXX? */
   1265  1.56        pk 	for (intrmapptr = &sc->sc_regs->ffb0_int_map;
   1266  1.56        pk 	     intrmapptr <= &sc->sc_regs->ffb1_int_map;
   1267  1.56        pk 	     intrmapptr++) {
   1268  1.56        pk 		if (INTVEC(*intrmapptr) == ino)
   1269  1.56        pk 			goto found;
   1270  1.56        pk 	}
   1271  1.51       eeh 
   1272  1.56        pk 	printf("Cannot find interrupt vector %lx\n", vec);
   1273  1.56        pk 	return (NULL);
   1274  1.51       eeh 
   1275  1.56        pk found:
   1276  1.56        pk 	/* Register the map and clear intr registers */
   1277  1.56        pk 	ih->ih_map = intrmapptr;
   1278  1.56        pk 	ih->ih_clr = intrclrptr;
   1279   1.7       mrg 
   1280   1.7       mrg 	ih->ih_fun = handler;
   1281   1.7       mrg 	ih->ih_arg = arg;
   1282  1.34       eeh 	ih->ih_pil = level;
   1283  1.24        pk 	ih->ih_number = ino | sc->sc_ign;
   1284  1.19        pk 
   1285  1.19        pk 	DPRINTF(PDB_INTR, (
   1286  1.19        pk 	    "; installing handler %p arg %p with ino %u pil %u\n",
   1287  1.19        pk 	    handler, arg, (u_int)ino, (u_int)ih->ih_pil));
   1288  1.19        pk 
   1289   1.7       mrg 	intr_establish(ih->ih_pil, ih);
   1290  1.34       eeh 
   1291  1.34       eeh 	/*
   1292  1.34       eeh 	 * Enable the interrupt now we have the handler installed.
   1293  1.34       eeh 	 * Read the current value as we can't change it besides the
   1294  1.34       eeh 	 * valid bit so so make sure only this bit is changed.
   1295  1.34       eeh 	 *
   1296  1.34       eeh 	 * XXXX --- we really should use bus_space for this.
   1297  1.34       eeh 	 */
   1298  1.34       eeh 	if (intrmapptr) {
   1299  1.74  christos 		imap = *intrmapptr;
   1300  1.34       eeh 		DPRINTF(PDB_INTR, ("; read intrmap = %016qx",
   1301  1.74  christos 			(unsigned long long)imap));
   1302  1.34       eeh 
   1303  1.34       eeh 		/* Enable the interrupt */
   1304  1.76    martin 		imap |= INTMAP_V|(CPU_UPAID << INTMAP_TID_SHIFT);
   1305  1.34       eeh 		DPRINTF(PDB_INTR, ("; addr of intrmapptr = %p", intrmapptr));
   1306  1.34       eeh 		DPRINTF(PDB_INTR, ("; writing intrmap = %016qx\n",
   1307  1.74  christos 			(unsigned long long)imap));
   1308  1.74  christos 		*intrmapptr = imap;
   1309  1.34       eeh 		DPRINTF(PDB_INTR, ("; reread intrmap = %016qx",
   1310  1.74  christos 			(unsigned long long)(imap = *intrmapptr)));
   1311  1.34       eeh 	}
   1312   1.7       mrg 	return (ih);
   1313   1.7       mrg }
   1314   1.7       mrg 
   1315   1.7       mrg /*
   1316   1.7       mrg  * hooks into the iommu dvma calls.
   1317   1.7       mrg  */
   1318   1.7       mrg int
   1319  1.77       cdi psycho_dmamap_load(bus_dma_tag_t t, bus_dmamap_t map, void *buf,
   1320  1.77       cdi 	bus_size_t buflen, struct proc *p, int flags)
   1321   1.7       mrg {
   1322   1.7       mrg 	struct psycho_pbm *pp = (struct psycho_pbm *)t->_cookie;
   1323   1.7       mrg 
   1324  1.50       eeh 	return (iommu_dvmamap_load(t, &pp->pp_sb, map, buf, buflen, p, flags));
   1325   1.7       mrg }
   1326   1.7       mrg 
   1327   1.7       mrg void
   1328  1.77       cdi psycho_dmamap_unload(bus_dma_tag_t t, bus_dmamap_t map)
   1329   1.7       mrg {
   1330   1.7       mrg 	struct psycho_pbm *pp = (struct psycho_pbm *)t->_cookie;
   1331   1.7       mrg 
   1332  1.50       eeh 	iommu_dvmamap_unload(t, &pp->pp_sb, map);
   1333   1.9       eeh }
   1334   1.9       eeh 
   1335   1.9       eeh int
   1336  1.77       cdi psycho_dmamap_load_raw(bus_dma_tag_t t, bus_dmamap_t map,
   1337  1.77       cdi 	bus_dma_segment_t *segs, int nsegs, bus_size_t size, int flags)
   1338   1.9       eeh {
   1339   1.9       eeh 	struct psycho_pbm *pp = (struct psycho_pbm *)t->_cookie;
   1340   1.9       eeh 
   1341  1.50       eeh 	return (iommu_dvmamap_load_raw(t, &pp->pp_sb, map, segs, nsegs, flags, size));
   1342   1.7       mrg }
   1343   1.7       mrg 
   1344   1.7       mrg void
   1345  1.77       cdi psycho_dmamap_sync(bus_dma_tag_t t, bus_dmamap_t map, bus_addr_t offset,
   1346  1.77       cdi 	bus_size_t len, int ops)
   1347   1.7       mrg {
   1348   1.7       mrg 	struct psycho_pbm *pp = (struct psycho_pbm *)t->_cookie;
   1349   1.7       mrg 
   1350  1.13       eeh 	if (ops & (BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE)) {
   1351  1.13       eeh 		/* Flush the CPU then the IOMMU */
   1352  1.13       eeh 		bus_dmamap_sync(t->_parent, map, offset, len, ops);
   1353  1.50       eeh 		iommu_dvmamap_sync(t, &pp->pp_sb, map, offset, len, ops);
   1354  1.13       eeh 	}
   1355  1.13       eeh 	if (ops & (BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE)) {
   1356  1.13       eeh 		/* Flush the IOMMU then the CPU */
   1357  1.50       eeh 		iommu_dvmamap_sync(t, &pp->pp_sb, map, offset, len, ops);
   1358  1.13       eeh 		bus_dmamap_sync(t->_parent, map, offset, len, ops);
   1359  1.13       eeh 	}
   1360  1.13       eeh 
   1361   1.7       mrg }
   1362   1.7       mrg 
   1363   1.7       mrg int
   1364  1.77       cdi psycho_dmamem_alloc(bus_dma_tag_t t, bus_size_t size, bus_size_t alignment,
   1365  1.77       cdi 	bus_size_t boundary, bus_dma_segment_t *segs, int nsegs, int *rsegs,
   1366  1.77       cdi 	int flags)
   1367   1.7       mrg {
   1368   1.7       mrg 	struct psycho_pbm *pp = (struct psycho_pbm *)t->_cookie;
   1369   1.7       mrg 
   1370  1.50       eeh 	return (iommu_dvmamem_alloc(t, &pp->pp_sb, size, alignment, boundary,
   1371   1.7       mrg 	    segs, nsegs, rsegs, flags));
   1372   1.7       mrg }
   1373   1.7       mrg 
   1374   1.7       mrg void
   1375  1.77       cdi psycho_dmamem_free(bus_dma_tag_t t, bus_dma_segment_t *segs, int nsegs)
   1376   1.7       mrg {
   1377   1.7       mrg 	struct psycho_pbm *pp = (struct psycho_pbm *)t->_cookie;
   1378   1.7       mrg 
   1379  1.50       eeh 	iommu_dvmamem_free(t, &pp->pp_sb, segs, nsegs);
   1380   1.7       mrg }
   1381   1.7       mrg 
   1382   1.7       mrg int
   1383  1.77       cdi psycho_dmamem_map(bus_dma_tag_t t, bus_dma_segment_t *segs, int nsegs,
   1384  1.77       cdi 	size_t size, caddr_t *kvap, int flags)
   1385   1.7       mrg {
   1386   1.7       mrg 	struct psycho_pbm *pp = (struct psycho_pbm *)t->_cookie;
   1387   1.7       mrg 
   1388  1.50       eeh 	return (iommu_dvmamem_map(t, &pp->pp_sb, segs, nsegs, size, kvap, flags));
   1389   1.7       mrg }
   1390   1.7       mrg 
   1391   1.7       mrg void
   1392  1.77       cdi psycho_dmamem_unmap(bus_dma_tag_t t, caddr_t kva, size_t size)
   1393   1.7       mrg {
   1394   1.7       mrg 	struct psycho_pbm *pp = (struct psycho_pbm *)t->_cookie;
   1395   1.7       mrg 
   1396  1.50       eeh 	iommu_dvmamem_unmap(t, &pp->pp_sb, kva, size);
   1397   1.1       mrg }
   1398