Home | History | Annotate | Line # | Download | only in sbus
isp_sbus.c revision 1.80
      1  1.80   mjacob /* $NetBSD: isp_sbus.c,v 1.80 2010/03/26 20:52:01 mjacob Exp $ */
      2  1.30   mjacob /*
      3  1.68   mjacob  * SBus specific probe and attach routines for Qlogic ISP SCSI adapters.
      4  1.30   mjacob  *
      5  1.68   mjacob  * Copyright (C) 1997, 1998, 1999 National Aeronautics & Space Administration
      6  1.68   mjacob  * All rights reserved.
      7   1.1      mrg  *
      8  1.68   mjacob  * Additional Copyright (C) 2000-2007 by Matthew Jacob
      9   1.1      mrg  * All rights reserved.
     10   1.1      mrg  *
     11   1.1      mrg  * Redistribution and use in source and binary forms, with or without
     12   1.1      mrg  * modification, are permitted provided that the following conditions
     13   1.1      mrg  * are met:
     14   1.1      mrg  * 1. Redistributions of source code must retain the above copyright
     15  1.68   mjacob  *    notice, this list of conditions and the following disclaimer.
     16   1.1      mrg  * 2. Redistributions in binary form must reproduce the above copyright
     17   1.1      mrg  *    notice, this list of conditions and the following disclaimer in the
     18   1.1      mrg  *    documentation and/or other materials provided with the distribution.
     19  1.68   mjacob  * 3. The name of the author may not be used to endorse or promote products
     20  1.68   mjacob  *    derived from this software without specific prior written permission
     21   1.1      mrg  *
     22  1.68   mjacob  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     23  1.68   mjacob  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     24  1.68   mjacob  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     25  1.68   mjacob  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     26  1.68   mjacob  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     27  1.68   mjacob  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     28  1.68   mjacob  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     29  1.68   mjacob  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     30  1.68   mjacob  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     31  1.68   mjacob  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     32   1.1      mrg  *
     33   1.1      mrg  */
     34  1.47    lukem 
     35  1.47    lukem #include <sys/cdefs.h>
     36  1.80   mjacob __KERNEL_RCSID(0, "$NetBSD: isp_sbus.c,v 1.80 2010/03/26 20:52:01 mjacob Exp $");
     37   1.1      mrg 
     38   1.1      mrg #include <sys/param.h>
     39   1.1      mrg #include <sys/systm.h>
     40   1.1      mrg #include <sys/device.h>
     41   1.1      mrg #include <sys/kernel.h>
     42   1.1      mrg #include <sys/malloc.h>
     43   1.1      mrg #include <sys/queue.h>
     44  1.48   mjacob #include <dev/ic/isp_netbsd.h>
     45  1.70       ad #include <sys/intr.h>
     46   1.1      mrg #include <machine/autoconf.h>
     47   1.1      mrg #include <dev/sbus/sbusvar.h>
     48  1.35   mjacob #include <sys/reboot.h>
     49   1.1      mrg 
     50  1.71   mjacob static void isp_sbus_reset0(ispsoftc_t *);
     51  1.71   mjacob static void isp_sbus_reset1(ispsoftc_t *);
     52  1.42   mjacob static int isp_sbus_intr(void *);
     53  1.45   mjacob static int
     54  1.71   mjacob isp_sbus_rd_isr(ispsoftc_t *, uint32_t *, uint16_t *, uint16_t *);
     55  1.71   mjacob static uint32_t isp_sbus_rd_reg(ispsoftc_t *, int);
     56  1.71   mjacob static void isp_sbus_wr_reg (ispsoftc_t *, int, uint32_t);
     57  1.71   mjacob static int isp_sbus_mbxdma(ispsoftc_t *);
     58  1.77   mjacob static int isp_sbus_dmasetup(ispsoftc_t *, XS_T *, void *);
     59  1.71   mjacob static void isp_sbus_dmateardown(ispsoftc_t *, XS_T *, uint32_t);
     60   1.1      mrg 
     61  1.68   mjacob #ifndef	ISP_DISABLE_FW
     62  1.68   mjacob #include <dev/microcode/isp/asm_sbus.h>
     63  1.68   mjacob #else
     64  1.17   mjacob #define	ISP_1000_RISC_CODE	NULL
     65  1.17   mjacob #endif
     66  1.17   mjacob 
     67  1.68   mjacob static const struct ispmdvec mdvec = {
     68  1.45   mjacob 	isp_sbus_rd_isr,
     69   1.1      mrg 	isp_sbus_rd_reg,
     70   1.1      mrg 	isp_sbus_wr_reg,
     71   1.1      mrg 	isp_sbus_mbxdma,
     72   1.1      mrg 	isp_sbus_dmasetup,
     73   1.1      mrg 	isp_sbus_dmateardown,
     74  1.68   mjacob 	isp_sbus_reset0,
     75  1.49   mjacob 	isp_sbus_reset1,
     76   1.1      mrg 	NULL,
     77  1.66   martin 	ISP_1000_RISC_CODE,
     78  1.66   martin 	0,
     79  1.66   martin 	0
     80   1.1      mrg };
     81   1.1      mrg 
     82   1.1      mrg struct isp_sbussoftc {
     83  1.71   mjacob 	ispsoftc_t	sbus_isp;
     84   1.1      mrg 	sdparam		sbus_dev;
     85  1.71   mjacob 	struct scsipi_channel sbus_chan;
     86   1.1      mrg 	bus_space_tag_t	sbus_bustag;
     87   1.6   mjacob 	bus_space_handle_t sbus_reg;
     88   1.1      mrg 	int		sbus_node;
     89   1.1      mrg 	int		sbus_pri;
     90   1.1      mrg 	struct ispmdvec	sbus_mdvec;
     91  1.14   mjacob 	bus_dmamap_t	*sbus_dmamap;
     92   1.8   mjacob 	int16_t		sbus_poff[_NREG_BLKS];
     93   1.1      mrg };
     94   1.1      mrg 
     95   1.1      mrg 
     96  1.75   cegger static int isp_match(device_t, cfdata_t, void *);
     97  1.75   cegger static void isp_sbus_attach(device_t, device_t, void *);
     98  1.78  tsutsui CFATTACH_DECL_NEW(isp_sbus, sizeof (struct isp_sbussoftc),
     99  1.58  thorpej     isp_match, isp_sbus_attach, NULL, NULL);
    100   1.1      mrg 
    101   1.1      mrg static int
    102  1.75   cegger isp_match(device_t parent, cfdata_t cf, void *aux)
    103   1.1      mrg {
    104   1.1      mrg 	int rv;
    105   1.1      mrg 	struct sbus_attach_args *sa = aux;
    106   1.1      mrg 
    107  1.54  thorpej 	rv = (strcmp(cf->cf_name, sa->sa_name) == 0 ||
    108   1.1      mrg 		strcmp("PTI,ptisp", sa->sa_name) == 0 ||
    109   1.1      mrg 		strcmp("ptisp", sa->sa_name) == 0 ||
    110   1.1      mrg 		strcmp("SUNW,isp", sa->sa_name) == 0 ||
    111   1.1      mrg 		strcmp("QLGC,isp", sa->sa_name) == 0);
    112  1.71   mjacob 
    113   1.1      mrg 	return (rv);
    114   1.1      mrg }
    115   1.1      mrg 
    116  1.20   mjacob 
    117   1.1      mrg static void
    118  1.75   cegger isp_sbus_attach(device_t parent, device_t self, void *aux)
    119   1.1      mrg {
    120  1.33   mjacob 	int freq, ispburst, sbusburst;
    121   1.1      mrg 	struct sbus_attach_args *sa = aux;
    122  1.78  tsutsui 	struct isp_sbussoftc *sbc = device_private(self);
    123  1.76  tsutsui 	struct sbus_softc *sbsc = device_private(parent);
    124  1.71   mjacob 	ispsoftc_t *isp = &sbc->sbus_isp;
    125   1.1      mrg 
    126  1.78  tsutsui 	isp->isp_osinfo.dev = self;
    127  1.78  tsutsui 
    128   1.1      mrg 	printf(" for %s\n", sa->sa_name);
    129   1.1      mrg 
    130  1.71   mjacob 	isp->isp_nchan = isp->isp_osinfo.adapter.adapt_nchannels = 1;
    131  1.71   mjacob 
    132   1.1      mrg 	sbc->sbus_bustag = sa->sa_bustag;
    133  1.16       pk 	if (sa->sa_nintr != 0)
    134  1.16       pk 		sbc->sbus_pri = sa->sa_pri;
    135   1.1      mrg 	sbc->sbus_mdvec = mdvec;
    136   1.1      mrg 
    137  1.51      eeh 	if (sa->sa_npromvaddrs) {
    138  1.51      eeh 		sbus_promaddr_to_handle(sa->sa_bustag,
    139  1.51      eeh 			sa->sa_promvaddrs[0], &sbc->sbus_reg);
    140   1.1      mrg 	} else {
    141  1.51      eeh 		if (sbus_bus_map(sa->sa_bustag,	sa->sa_slot, sa->sa_offset,
    142  1.51      eeh 			sa->sa_size, 0, &sbc->sbus_reg) != 0) {
    143  1.72   cegger 			aprint_error_dev(self, "cannot map registers\n");
    144   1.1      mrg 			return;
    145   1.1      mrg 		}
    146   1.1      mrg 	}
    147   1.1      mrg 	sbc->sbus_node = sa->sa_node;
    148   1.1      mrg 
    149  1.62       pk 	freq = prom_getpropint(sa->sa_node, "clock-frequency", 0);
    150   1.1      mrg 	if (freq) {
    151   1.1      mrg 		/*
    152   1.1      mrg 		 * Convert from HZ to MHz, rounding up.
    153   1.1      mrg 		 */
    154   1.1      mrg 		freq = (freq + 500000)/1000000;
    155   1.1      mrg 	}
    156   1.1      mrg 	sbc->sbus_mdvec.dv_clock = freq;
    157   1.5   mjacob 
    158   1.5   mjacob 	/*
    159  1.33   mjacob 	 * Now figure out what the proper burst sizes, etc., to use.
    160  1.33   mjacob 	 * Unfortunately, there is no ddi_dma_burstsizes here which
    161  1.33   mjacob 	 * walks up the tree finding the limiting burst size node (if
    162  1.33   mjacob 	 * any).
    163   1.5   mjacob 	 */
    164  1.76  tsutsui 	sbusburst = sbsc->sc_burst;
    165  1.33   mjacob 	if (sbusburst == 0)
    166  1.33   mjacob 		sbusburst = SBUS_BURST_32 - 1;
    167  1.62       pk 	ispburst = prom_getpropint(sa->sa_node, "burst-sizes", -1);
    168  1.33   mjacob 	if (ispburst == -1) {
    169  1.33   mjacob 		ispburst = sbusburst;
    170  1.33   mjacob 	}
    171  1.33   mjacob 	ispburst &= sbusburst;
    172  1.33   mjacob 	ispburst &= ~(1 << 7);
    173  1.33   mjacob 	ispburst &= ~(1 << 6);
    174  1.33   mjacob 	sbc->sbus_mdvec.dv_conf1 =  0;
    175  1.33   mjacob 	if (ispburst & (1 << 5)) {
    176  1.33   mjacob 		sbc->sbus_mdvec.dv_conf1 = BIU_SBUS_CONF1_FIFO_32;
    177  1.33   mjacob 	} else if (ispburst & (1 << 4)) {
    178  1.33   mjacob 		sbc->sbus_mdvec.dv_conf1 = BIU_SBUS_CONF1_FIFO_16;
    179  1.33   mjacob 	} else if (ispburst & (1 << 3)) {
    180  1.33   mjacob 		sbc->sbus_mdvec.dv_conf1 =
    181  1.33   mjacob 		    BIU_SBUS_CONF1_BURST8 | BIU_SBUS_CONF1_FIFO_8;
    182  1.33   mjacob 	}
    183  1.33   mjacob 	if (sbc->sbus_mdvec.dv_conf1) {
    184  1.33   mjacob 		sbc->sbus_mdvec.dv_conf1 |= BIU_BURST_ENABLE;
    185  1.33   mjacob 	}
    186   1.1      mrg 
    187   1.1      mrg 	isp->isp_mdvec = &sbc->sbus_mdvec;
    188   1.2   mjacob 	isp->isp_bustype = ISP_BT_SBUS;
    189   1.1      mrg 	isp->isp_type = ISP_HA_SCSI_UNKNOWN;
    190   1.1      mrg 	isp->isp_param = &sbc->sbus_dev;
    191  1.48   mjacob 	isp->isp_dmatag = sa->sa_dmatag;
    192  1.77   mjacob 	ISP_MEMZERO(isp->isp_param, sizeof (sdparam));
    193  1.71   mjacob 	isp->isp_osinfo.chan = &sbc->sbus_chan;
    194   1.1      mrg 
    195   1.8   mjacob 	sbc->sbus_poff[BIU_BLOCK >> _BLK_REG_SHFT] = BIU_REGS_OFF;
    196   1.8   mjacob 	sbc->sbus_poff[MBOX_BLOCK >> _BLK_REG_SHFT] = SBUS_MBOX_REGS_OFF;
    197   1.8   mjacob 	sbc->sbus_poff[SXP_BLOCK >> _BLK_REG_SHFT] = SBUS_SXP_REGS_OFF;
    198   1.8   mjacob 	sbc->sbus_poff[RISC_BLOCK >> _BLK_REG_SHFT] = SBUS_RISC_REGS_OFF;
    199   1.8   mjacob 	sbc->sbus_poff[DMA_BLOCK >> _BLK_REG_SHFT] = DMA_REGS_OFF;
    200   1.1      mrg 
    201  1.35   mjacob 	/* Establish interrupt channel */
    202  1.59       pk 	bus_intr_establish(sbc->sbus_bustag, sbc->sbus_pri, IPL_BIO,
    203  1.35   mjacob 	    isp_sbus_intr, sbc);
    204  1.35   mjacob 
    205  1.29   mjacob 	/*
    206  1.29   mjacob 	 * Set up logging levels.
    207  1.29   mjacob 	 */
    208  1.29   mjacob #ifdef	ISP_LOGDEFAULT
    209  1.29   mjacob 	isp->isp_dblev = ISP_LOGDEFAULT;
    210  1.29   mjacob #else
    211  1.35   mjacob 	isp->isp_dblev = ISP_LOGWARN|ISP_LOGERR;
    212  1.35   mjacob 	if (bootverbose)
    213  1.35   mjacob 		isp->isp_dblev |= ISP_LOGCONFIG|ISP_LOGINFO;
    214  1.29   mjacob #ifdef	SCSIDEBUG
    215  1.29   mjacob 	isp->isp_dblev |= ISP_LOGDEBUG1|ISP_LOGDEBUG2;
    216  1.29   mjacob #endif
    217  1.29   mjacob #ifdef	DEBUG
    218  1.35   mjacob 	isp->isp_dblev |= ISP_LOGDEBUG0;
    219  1.29   mjacob #endif
    220  1.29   mjacob #endif
    221  1.35   mjacob 
    222  1.65  thorpej 	isp->isp_confopts = device_cfdata(self)->cf_flags;
    223  1.71   mjacob 	SDPARAM(isp, 0)->role = ISP_DEFAULT_ROLES;
    224  1.35   mjacob 
    225  1.21   mjacob 	/*
    226  1.21   mjacob 	 * There's no tool on sparc to set NVRAM for ISPs, so ignore it.
    227  1.21   mjacob 	 */
    228  1.21   mjacob 	isp->isp_confopts |= ISP_CFG_NONVRAM;
    229  1.68   mjacob 
    230  1.68   mjacob 	/*
    231  1.68   mjacob 	 * Mark things if we're a PTI SBus adapter.
    232  1.68   mjacob 	 */
    233  1.68   mjacob 	if (strcmp("PTI,ptisp", sa->sa_name) == 0 ||
    234  1.68   mjacob 	    strcmp("ptisp", sa->sa_name) == 0) {
    235  1.71   mjacob 		SDPARAM(isp, 0)->isp_ptisp = 1;
    236  1.68   mjacob 	}
    237   1.1      mrg 	ISP_LOCK(isp);
    238  1.77   mjacob 	isp_reset(isp, 1);
    239   1.1      mrg 	if (isp->isp_state != ISP_RESETSTATE) {
    240   1.1      mrg 		ISP_UNLOCK(isp);
    241   1.1      mrg 		return;
    242   1.1      mrg 	}
    243  1.68   mjacob 	ISP_ENABLE_INTS(isp);
    244   1.1      mrg 	isp_init(isp);
    245   1.1      mrg 	if (isp->isp_state != ISP_INITSTATE) {
    246   1.1      mrg 		isp_uninit(isp);
    247   1.1      mrg 		ISP_UNLOCK(isp);
    248   1.1      mrg 		return;
    249   1.1      mrg 	}
    250   1.1      mrg 
    251   1.1      mrg 	/*
    252   1.1      mrg 	 * do generic attach.
    253   1.1      mrg 	 */
    254  1.35   mjacob 	ISP_UNLOCK(isp);
    255   1.1      mrg 	isp_attach(isp);
    256  1.49   mjacob }
    257  1.49   mjacob 
    258  1.49   mjacob 
    259  1.49   mjacob static void
    260  1.71   mjacob isp_sbus_reset0(ispsoftc_t *isp)
    261  1.68   mjacob {
    262  1.68   mjacob 	ISP_DISABLE_INTS(isp);
    263  1.68   mjacob }
    264  1.68   mjacob 
    265  1.68   mjacob static void
    266  1.71   mjacob isp_sbus_reset1(ispsoftc_t *isp)
    267  1.49   mjacob {
    268  1.68   mjacob 	ISP_ENABLE_INTS(isp);
    269  1.30   mjacob }
    270  1.30   mjacob 
    271  1.30   mjacob static int
    272  1.42   mjacob isp_sbus_intr(void *arg)
    273  1.30   mjacob {
    274  1.68   mjacob 	uint32_t isr;
    275  1.68   mjacob 	uint16_t sema, mbox;
    276  1.71   mjacob 	ispsoftc_t *isp = arg;
    277  1.45   mjacob 
    278  1.48   mjacob 	if (ISP_READ_ISR(isp, &isr, &sema, &mbox) == 0) {
    279  1.48   mjacob 		isp->isp_intbogus++;
    280  1.48   mjacob 		return (0);
    281  1.48   mjacob 	} else {
    282  1.48   mjacob 		struct isp_sbussoftc *sbc = arg;
    283  1.45   mjacob 		sbc->sbus_isp.isp_osinfo.onintstack = 1;
    284  1.45   mjacob 		isp_intr(isp, isr, sema, mbox);
    285  1.45   mjacob 		sbc->sbus_isp.isp_osinfo.onintstack = 0;
    286  1.45   mjacob 		return (1);
    287  1.45   mjacob 	}
    288  1.45   mjacob }
    289  1.45   mjacob 
    290  1.45   mjacob #define	IspVirt2Off(a, x)	\
    291  1.45   mjacob 	(((struct isp_sbussoftc *)a)->sbus_poff[((x) & _BLK_REG_MASK) >> \
    292  1.45   mjacob 	_BLK_REG_SHFT] + ((x) & 0xff))
    293  1.45   mjacob 
    294  1.45   mjacob #define	BXR2(sbc, off)		\
    295  1.45   mjacob 	bus_space_read_2(sbc->sbus_bustag, sbc->sbus_reg, off)
    296  1.45   mjacob 
    297  1.45   mjacob static int
    298  1.71   mjacob isp_sbus_rd_isr(ispsoftc_t *isp, uint32_t *isrp,
    299  1.68   mjacob     uint16_t *semap, uint16_t *mbp)
    300  1.45   mjacob {
    301  1.45   mjacob 	struct isp_sbussoftc *sbc = (struct isp_sbussoftc *) isp;
    302  1.68   mjacob 	uint32_t isr;
    303  1.68   mjacob 	uint16_t sema;
    304  1.45   mjacob 
    305  1.45   mjacob 	isr = BXR2(sbc, IspVirt2Off(isp, BIU_ISR));
    306  1.45   mjacob 	sema = BXR2(sbc, IspVirt2Off(isp, BIU_SEMA));
    307  1.45   mjacob 	isp_prt(isp, ISP_LOGDEBUG3, "ISR 0x%x SEMA 0x%x", isr, sema);
    308  1.45   mjacob 	isr &= INT_PENDING_MASK(isp);
    309  1.45   mjacob 	sema &= BIU_SEMA_LOCK;
    310  1.45   mjacob 	if (isr == 0 && sema == 0) {
    311  1.45   mjacob 		return (0);
    312  1.45   mjacob 	}
    313  1.45   mjacob 	*isrp = isr;
    314  1.45   mjacob 	if ((*semap = sema) != 0) {
    315  1.45   mjacob 		*mbp = BXR2(sbc, IspVirt2Off(isp, OUTMAILBOX0));
    316  1.45   mjacob 	}
    317  1.45   mjacob 	return (1);
    318   1.1      mrg }
    319   1.1      mrg 
    320  1.68   mjacob static uint32_t
    321  1.71   mjacob isp_sbus_rd_reg(ispsoftc_t *isp, int regoff)
    322   1.1      mrg {
    323   1.1      mrg 	struct isp_sbussoftc *sbc = (struct isp_sbussoftc *) isp;
    324   1.8   mjacob 	int offset = sbc->sbus_poff[(regoff & _BLK_REG_MASK) >> _BLK_REG_SHFT];
    325   1.8   mjacob 	offset += (regoff & 0xff);
    326   1.6   mjacob 	return (bus_space_read_2(sbc->sbus_bustag, sbc->sbus_reg, offset));
    327   1.1      mrg }
    328   1.1      mrg 
    329   1.1      mrg static void
    330  1.71   mjacob isp_sbus_wr_reg(ispsoftc_t *isp, int regoff, uint32_t val)
    331   1.1      mrg {
    332   1.1      mrg 	struct isp_sbussoftc *sbc = (struct isp_sbussoftc *) isp;
    333   1.8   mjacob 	int offset = sbc->sbus_poff[(regoff & _BLK_REG_MASK) >> _BLK_REG_SHFT];
    334   1.8   mjacob 	offset += (regoff & 0xff);
    335   1.6   mjacob 	bus_space_write_2(sbc->sbus_bustag, sbc->sbus_reg, offset, val);
    336   1.1      mrg }
    337   1.1      mrg 
    338   1.1      mrg static int
    339  1.71   mjacob isp_sbus_mbxdma(ispsoftc_t *isp)
    340   1.1      mrg {
    341   1.1      mrg 	struct isp_sbussoftc *sbc = (struct isp_sbussoftc *) isp;
    342  1.40   mjacob 	bus_dma_segment_t reqseg, rspseg;
    343  1.40   mjacob 	int reqrs, rsprs, i, progress;
    344  1.14   mjacob 	size_t n;
    345  1.12       pk 	bus_size_t len;
    346   1.1      mrg 
    347  1.14   mjacob 	if (isp->isp_rquest_dma)
    348  1.14   mjacob 		return (0);
    349   1.1      mrg 
    350  1.80   mjacob 	n = isp->isp_maxcmds * sizeof (isp_hdl_t);
    351  1.80   mjacob 	isp->isp_xflist = (isp_hdl_t *) malloc(n, M_DEVBUF, M_WAITOK);
    352  1.14   mjacob 	if (isp->isp_xflist == NULL) {
    353  1.29   mjacob 		isp_prt(isp, ISP_LOGERR, "cannot alloc xflist array");
    354  1.14   mjacob 		return (1);
    355  1.14   mjacob 	}
    356  1.77   mjacob 	ISP_MEMZERO(isp->isp_xflist, n);
    357  1.80   mjacob 	for (n = 0; n < isp->isp_maxcmds - 1; n++) {
    358  1.80   mjacob 		isp->isp_xflist[n].cmd = &isp->isp_xflist[n+1];
    359  1.80   mjacob 	}
    360  1.14   mjacob 	n = sizeof (bus_dmamap_t) * isp->isp_maxcmds;
    361  1.14   mjacob 	sbc->sbus_dmamap = (bus_dmamap_t *) malloc(n, M_DEVBUF, M_WAITOK);
    362  1.14   mjacob 	if (sbc->sbus_dmamap == NULL) {
    363  1.14   mjacob 		free(isp->isp_xflist, M_DEVBUF);
    364  1.29   mjacob 		isp->isp_xflist = NULL;
    365  1.29   mjacob 		isp_prt(isp, ISP_LOGERR, "cannot alloc dmamap array");
    366  1.29   mjacob 		return (1);
    367  1.29   mjacob 	}
    368  1.29   mjacob 	for (i = 0; i < isp->isp_maxcmds; i++) {
    369  1.29   mjacob 		/* Allocate a DMA handle */
    370  1.69   mjacob 		if (bus_dmamap_create(isp->isp_dmatag, MAXPHYS, 1, MAXPHYS,
    371  1.69   mjacob 		    1 << 24, BUS_DMA_NOWAIT, &sbc->sbus_dmamap[i]) != 0) {
    372  1.29   mjacob 			isp_prt(isp, ISP_LOGERR, "cmd DMA maps create error");
    373  1.29   mjacob 			break;
    374  1.29   mjacob 		}
    375  1.29   mjacob 	}
    376  1.29   mjacob 	if (i < isp->isp_maxcmds) {
    377  1.29   mjacob 		while (--i >= 0) {
    378  1.48   mjacob 			bus_dmamap_destroy(isp->isp_dmatag,
    379  1.48   mjacob 			    sbc->sbus_dmamap[i]);
    380  1.29   mjacob 		}
    381  1.29   mjacob 		free(isp->isp_xflist, M_DEVBUF);
    382  1.29   mjacob 		free(sbc->sbus_dmamap, M_DEVBUF);
    383  1.29   mjacob 		isp->isp_xflist = NULL;
    384  1.29   mjacob 		sbc->sbus_dmamap = NULL;
    385  1.14   mjacob 		return (1);
    386  1.14   mjacob 	}
    387  1.29   mjacob 
    388   1.1      mrg 	/*
    389  1.40   mjacob 	 * Allocate and map the request and response queues
    390   1.1      mrg 	 */
    391  1.40   mjacob 	progress = 0;
    392  1.29   mjacob 	len = ISP_QUEUE_SIZE(RQUEST_QUEUE_LEN(isp));
    393  1.48   mjacob 	if (bus_dmamem_alloc(isp->isp_dmatag, len, 0, 0, &reqseg, 1, &reqrs,
    394  1.40   mjacob 	    BUS_DMA_NOWAIT)) {
    395  1.24       pk 		goto dmafail;
    396  1.24       pk 	}
    397  1.40   mjacob 	progress++;
    398  1.48   mjacob 	if (bus_dmamem_map(isp->isp_dmatag, &reqseg, reqrs, len,
    399  1.68   mjacob 	    (void *)&isp->isp_rquest, BUS_DMA_NOWAIT|BUS_DMA_COHERENT)) {
    400  1.24       pk 		goto dmafail;
    401  1.24       pk 	}
    402  1.40   mjacob 	progress++;
    403  1.69   mjacob 	if (bus_dmamap_create(isp->isp_dmatag, len, 1, len, 1 << 24,
    404  1.69   mjacob 	    BUS_DMA_NOWAIT, &isp->isp_rqdmap) != 0) {
    405  1.43   mjacob 		goto dmafail;
    406  1.43   mjacob 	}
    407  1.43   mjacob 	progress++;
    408  1.48   mjacob 	if (bus_dmamap_load(isp->isp_dmatag, isp->isp_rqdmap,
    409  1.43   mjacob 	    isp->isp_rquest, len, NULL, BUS_DMA_NOWAIT) != 0) {
    410  1.24       pk 		goto dmafail;
    411  1.14   mjacob 	}
    412  1.40   mjacob 	progress++;
    413  1.48   mjacob 	isp->isp_rquest_dma = isp->isp_rqdmap->dm_segs[0].ds_addr;
    414   1.1      mrg 
    415  1.29   mjacob 	len = ISP_QUEUE_SIZE(RESULT_QUEUE_LEN(isp));
    416  1.48   mjacob 	if (bus_dmamem_alloc(isp->isp_dmatag, len, 0, 0, &rspseg, 1, &rsprs,
    417  1.40   mjacob 	    BUS_DMA_NOWAIT)) {
    418  1.24       pk 		goto dmafail;
    419  1.24       pk 	}
    420  1.40   mjacob 	progress++;
    421  1.48   mjacob 	if (bus_dmamem_map(isp->isp_dmatag, &rspseg, rsprs, len,
    422  1.68   mjacob 	    (void *)&isp->isp_result, BUS_DMA_NOWAIT|BUS_DMA_COHERENT)) {
    423  1.24       pk 		goto dmafail;
    424  1.24       pk 	}
    425  1.40   mjacob 	progress++;
    426  1.69   mjacob 	if (bus_dmamap_create(isp->isp_dmatag, len, 1, len, 1 << 24,
    427  1.69   mjacob 	    BUS_DMA_NOWAIT, &isp->isp_rsdmap) != 0) {
    428  1.43   mjacob 		goto dmafail;
    429  1.43   mjacob 	}
    430  1.43   mjacob 	progress++;
    431  1.48   mjacob 	if (bus_dmamap_load(isp->isp_dmatag, isp->isp_rsdmap,
    432  1.43   mjacob 	    isp->isp_result, len, NULL, BUS_DMA_NOWAIT) != 0) {
    433  1.24       pk 		goto dmafail;
    434  1.14   mjacob 	}
    435  1.48   mjacob 	isp->isp_result_dma = isp->isp_rsdmap->dm_segs[0].ds_addr;
    436  1.43   mjacob 
    437   1.1      mrg 	return (0);
    438  1.24       pk 
    439  1.24       pk dmafail:
    440  1.40   mjacob 	isp_prt(isp, ISP_LOGERR, "Mailbox DMA Setup Failure");
    441  1.40   mjacob 
    442  1.40   mjacob 	if (progress >= 8) {
    443  1.48   mjacob 		bus_dmamap_unload(isp->isp_dmatag, isp->isp_rsdmap);
    444  1.41  thorpej 	}
    445  1.41  thorpej 	if (progress >= 7) {
    446  1.48   mjacob 		bus_dmamap_destroy(isp->isp_dmatag, isp->isp_rsdmap);
    447  1.43   mjacob 	}
    448  1.43   mjacob 	if (progress >= 6) {
    449  1.48   mjacob 		bus_dmamem_unmap(isp->isp_dmatag,
    450  1.40   mjacob 		    isp->isp_result, ISP_QUEUE_SIZE(RESULT_QUEUE_LEN(isp)));
    451  1.40   mjacob 	}
    452  1.43   mjacob 	if (progress >= 5) {
    453  1.48   mjacob 		bus_dmamem_free(isp->isp_dmatag, &rspseg, rsprs);
    454  1.40   mjacob 	}
    455  1.40   mjacob 
    456  1.40   mjacob 	if (progress >= 4) {
    457  1.48   mjacob 		bus_dmamap_unload(isp->isp_dmatag, isp->isp_rqdmap);
    458  1.41  thorpej 	}
    459  1.41  thorpej 	if (progress >= 3) {
    460  1.48   mjacob 		bus_dmamap_destroy(isp->isp_dmatag, isp->isp_rqdmap);
    461  1.43   mjacob 	}
    462  1.43   mjacob 	if (progress >= 2) {
    463  1.48   mjacob 		bus_dmamem_unmap(isp->isp_dmatag,
    464  1.40   mjacob 		    isp->isp_rquest, ISP_QUEUE_SIZE(RQUEST_QUEUE_LEN(isp)));
    465  1.40   mjacob 	}
    466  1.43   mjacob 	if (progress >= 1) {
    467  1.48   mjacob 		bus_dmamem_free(isp->isp_dmatag, &reqseg, reqrs);
    468  1.40   mjacob 	}
    469  1.40   mjacob 
    470  1.29   mjacob 	for (i = 0; i < isp->isp_maxcmds; i++) {
    471  1.48   mjacob 		bus_dmamap_destroy(isp->isp_dmatag, sbc->sbus_dmamap[i]);
    472  1.29   mjacob 	}
    473  1.24       pk 	free(sbc->sbus_dmamap, M_DEVBUF);
    474  1.24       pk 	free(isp->isp_xflist, M_DEVBUF);
    475  1.29   mjacob 	isp->isp_xflist = NULL;
    476  1.29   mjacob 	sbc->sbus_dmamap = NULL;
    477  1.24       pk 	return (1);
    478   1.1      mrg }
    479   1.1      mrg 
    480   1.1      mrg /*
    481  1.14   mjacob  * Map a DMA request.
    482  1.14   mjacob  * We're guaranteed that rq->req_handle is a value from 1 to isp->isp_maxcmds.
    483   1.1      mrg  */
    484   1.1      mrg 
    485   1.1      mrg static int
    486  1.77   mjacob isp_sbus_dmasetup(struct ispsoftc *isp, struct scsipi_xfer *xs, void *arg)
    487   1.1      mrg {
    488  1.77   mjacob 	struct isp_sbussoftc *sbc = (struct isp_sbussoftc *)isp;
    489  1.77   mjacob 	ispreq_t *rq = arg;
    490  1.27   mjacob 	bus_dmamap_t dmap;
    491  1.77   mjacob 	bus_dma_segment_t *dm_segs;
    492  1.80   mjacob 	uint32_t nsegs, hidx;
    493  1.77   mjacob 	isp_ddir_t ddir;
    494   1.1      mrg 
    495  1.80   mjacob 	hidx = isp_handle_index(isp, rq->req_handle);
    496  1.80   mjacob 	if (hidx == ISP_BAD_HANDLE_INDEX) {
    497  1.80   mjacob 		XS_SETERR(xs, HBA_BOTCH);
    498  1.80   mjacob 		return (CMD_COMPLETE);
    499  1.80   mjacob 	}
    500  1.80   mjacob 	dmap = sbc->sbus_dmamap[hidx];
    501   1.1      mrg 	if (xs->datalen == 0) {
    502  1.77   mjacob 		ddir = ISP_NOXFR;
    503  1.77   mjacob 		nsegs = 0;
    504  1.77   mjacob 		dm_segs = NULL;
    505  1.77   mjacob 	 } else {
    506  1.77   mjacob 		int error;
    507  1.77   mjacob 		uint32_t flag, flg2;
    508  1.77   mjacob 
    509  1.77   mjacob 		if (xs->xs_control & XS_CTL_DATA_IN) {
    510  1.77   mjacob 			flg2 = BUS_DMASYNC_PREREAD;
    511  1.77   mjacob 			flag = BUS_DMA_READ;
    512  1.77   mjacob 			ddir = ISP_FROM_DEVICE;
    513  1.77   mjacob 		} else {
    514  1.77   mjacob 			flg2 = BUS_DMASYNC_PREWRITE;
    515  1.77   mjacob 			flag = BUS_DMA_WRITE;
    516  1.77   mjacob 			ddir = ISP_TO_DEVICE;
    517  1.77   mjacob 		}
    518  1.77   mjacob 		error = bus_dmamap_load(isp->isp_dmatag, dmap, xs->data, xs->datalen,
    519  1.77   mjacob 		    NULL, ((xs->xs_control & XS_CTL_NOSLEEP) ? BUS_DMA_NOWAIT : BUS_DMA_WAITOK) | BUS_DMA_STREAMING | flag);
    520  1.77   mjacob 		if (error) {
    521  1.77   mjacob 			isp_prt(isp, ISP_LOGWARN, "unable to load DMA (%d)", error);
    522  1.27   mjacob 			XS_SETERR(xs, HBA_BOTCH);
    523  1.77   mjacob 			if (error == EAGAIN || error == ENOMEM) {
    524  1.77   mjacob 				return (CMD_EAGAIN);
    525  1.77   mjacob 			} else {
    526  1.77   mjacob 				return (CMD_COMPLETE);
    527  1.77   mjacob 			}
    528  1.27   mjacob 		}
    529  1.77   mjacob 		dm_segs = dmap->dm_segs;
    530  1.77   mjacob 		nsegs = dmap->dm_nsegs;
    531  1.77   mjacob 		bus_dmamap_sync(isp->isp_dmatag, dmap, 0, dmap->dm_mapsize, flg2);
    532  1.22   mjacob 	}
    533  1.22   mjacob 
    534  1.77   mjacob 	if (isp_send_cmd(isp, rq, dm_segs, nsegs, xs->datalen, ddir) != CMD_QUEUED) {
    535  1.77   mjacob 		return (CMD_EAGAIN);
    536  1.48   mjacob 	} else {
    537  1.77   mjacob 		return (CMD_QUEUED);
    538  1.48   mjacob 	}
    539   1.1      mrg }
    540   1.1      mrg 
    541   1.1      mrg static void
    542  1.71   mjacob isp_sbus_dmateardown(ispsoftc_t *isp, XS_T *xs, uint32_t handle)
    543   1.1      mrg {
    544   1.1      mrg 	struct isp_sbussoftc *sbc = (struct isp_sbussoftc *) isp;
    545  1.27   mjacob 	bus_dmamap_t dmap;
    546  1.80   mjacob 	uint32_t hidx;
    547  1.27   mjacob 
    548  1.80   mjacob 	hidx = isp_handle_index(isp, handle);
    549  1.80   mjacob 	if (hidx == ISP_BAD_HANDLE_INDEX) {
    550  1.80   mjacob 		isp_xs_prt(isp, xs, ISP_LOGERR, "bad handle on teardown");
    551  1.80   mjacob 		return;
    552   1.1      mrg 	}
    553  1.80   mjacob 	dmap = sbc->sbus_dmamap[hidx];
    554  1.48   mjacob 	bus_dmamap_sync(isp->isp_dmatag, dmap, 0,
    555  1.14   mjacob 	    xs->datalen, (xs->xs_control & XS_CTL_DATA_IN)?
    556  1.14   mjacob 	    BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE);
    557  1.48   mjacob 	bus_dmamap_unload(isp->isp_dmatag, dmap);
    558   1.1      mrg }
    559