559 lines
15 KiB
C
559 lines
15 KiB
C
/* $NetBSD: isp_sbus.c,v 1.80 2010/03/26 20:52:01 mjacob Exp $ */
|
|
/*
|
|
* SBus specific probe and attach routines for Qlogic ISP SCSI adapters.
|
|
*
|
|
* Copyright (C) 1997, 1998, 1999 National Aeronautics & Space Administration
|
|
* All rights reserved.
|
|
*
|
|
* Additional Copyright (C) 2000-2007 by Matthew Jacob
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* 3. The name of the author may not be used to endorse or promote products
|
|
* derived from this software without specific prior written permission
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__KERNEL_RCSID(0, "$NetBSD: isp_sbus.c,v 1.80 2010/03/26 20:52:01 mjacob Exp $");
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/device.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/queue.h>
|
|
#include <dev/ic/isp_netbsd.h>
|
|
#include <sys/intr.h>
|
|
#include <machine/autoconf.h>
|
|
#include <dev/sbus/sbusvar.h>
|
|
#include <sys/reboot.h>
|
|
|
|
static void isp_sbus_reset0(ispsoftc_t *);
|
|
static void isp_sbus_reset1(ispsoftc_t *);
|
|
static int isp_sbus_intr(void *);
|
|
static int
|
|
isp_sbus_rd_isr(ispsoftc_t *, uint32_t *, uint16_t *, uint16_t *);
|
|
static uint32_t isp_sbus_rd_reg(ispsoftc_t *, int);
|
|
static void isp_sbus_wr_reg (ispsoftc_t *, int, uint32_t);
|
|
static int isp_sbus_mbxdma(ispsoftc_t *);
|
|
static int isp_sbus_dmasetup(ispsoftc_t *, XS_T *, void *);
|
|
static void isp_sbus_dmateardown(ispsoftc_t *, XS_T *, uint32_t);
|
|
|
|
#ifndef ISP_DISABLE_FW
|
|
#include <dev/microcode/isp/asm_sbus.h>
|
|
#else
|
|
#define ISP_1000_RISC_CODE NULL
|
|
#endif
|
|
|
|
static const struct ispmdvec mdvec = {
|
|
isp_sbus_rd_isr,
|
|
isp_sbus_rd_reg,
|
|
isp_sbus_wr_reg,
|
|
isp_sbus_mbxdma,
|
|
isp_sbus_dmasetup,
|
|
isp_sbus_dmateardown,
|
|
isp_sbus_reset0,
|
|
isp_sbus_reset1,
|
|
NULL,
|
|
ISP_1000_RISC_CODE,
|
|
0,
|
|
0
|
|
};
|
|
|
|
struct isp_sbussoftc {
|
|
ispsoftc_t sbus_isp;
|
|
sdparam sbus_dev;
|
|
struct scsipi_channel sbus_chan;
|
|
bus_space_tag_t sbus_bustag;
|
|
bus_space_handle_t sbus_reg;
|
|
int sbus_node;
|
|
int sbus_pri;
|
|
struct ispmdvec sbus_mdvec;
|
|
bus_dmamap_t *sbus_dmamap;
|
|
int16_t sbus_poff[_NREG_BLKS];
|
|
};
|
|
|
|
|
|
static int isp_match(device_t, cfdata_t, void *);
|
|
static void isp_sbus_attach(device_t, device_t, void *);
|
|
CFATTACH_DECL_NEW(isp_sbus, sizeof (struct isp_sbussoftc),
|
|
isp_match, isp_sbus_attach, NULL, NULL);
|
|
|
|
static int
|
|
isp_match(device_t parent, cfdata_t cf, void *aux)
|
|
{
|
|
int rv;
|
|
struct sbus_attach_args *sa = aux;
|
|
|
|
rv = (strcmp(cf->cf_name, sa->sa_name) == 0 ||
|
|
strcmp("PTI,ptisp", sa->sa_name) == 0 ||
|
|
strcmp("ptisp", sa->sa_name) == 0 ||
|
|
strcmp("SUNW,isp", sa->sa_name) == 0 ||
|
|
strcmp("QLGC,isp", sa->sa_name) == 0);
|
|
|
|
return (rv);
|
|
}
|
|
|
|
|
|
static void
|
|
isp_sbus_attach(device_t parent, device_t self, void *aux)
|
|
{
|
|
int freq, ispburst, sbusburst;
|
|
struct sbus_attach_args *sa = aux;
|
|
struct isp_sbussoftc *sbc = device_private(self);
|
|
struct sbus_softc *sbsc = device_private(parent);
|
|
ispsoftc_t *isp = &sbc->sbus_isp;
|
|
|
|
isp->isp_osinfo.dev = self;
|
|
|
|
printf(" for %s\n", sa->sa_name);
|
|
|
|
isp->isp_nchan = isp->isp_osinfo.adapter.adapt_nchannels = 1;
|
|
|
|
sbc->sbus_bustag = sa->sa_bustag;
|
|
if (sa->sa_nintr != 0)
|
|
sbc->sbus_pri = sa->sa_pri;
|
|
sbc->sbus_mdvec = mdvec;
|
|
|
|
if (sa->sa_npromvaddrs) {
|
|
sbus_promaddr_to_handle(sa->sa_bustag,
|
|
sa->sa_promvaddrs[0], &sbc->sbus_reg);
|
|
} else {
|
|
if (sbus_bus_map(sa->sa_bustag, sa->sa_slot, sa->sa_offset,
|
|
sa->sa_size, 0, &sbc->sbus_reg) != 0) {
|
|
aprint_error_dev(self, "cannot map registers\n");
|
|
return;
|
|
}
|
|
}
|
|
sbc->sbus_node = sa->sa_node;
|
|
|
|
freq = prom_getpropint(sa->sa_node, "clock-frequency", 0);
|
|
if (freq) {
|
|
/*
|
|
* Convert from HZ to MHz, rounding up.
|
|
*/
|
|
freq = (freq + 500000)/1000000;
|
|
}
|
|
sbc->sbus_mdvec.dv_clock = freq;
|
|
|
|
/*
|
|
* Now figure out what the proper burst sizes, etc., to use.
|
|
* Unfortunately, there is no ddi_dma_burstsizes here which
|
|
* walks up the tree finding the limiting burst size node (if
|
|
* any).
|
|
*/
|
|
sbusburst = sbsc->sc_burst;
|
|
if (sbusburst == 0)
|
|
sbusburst = SBUS_BURST_32 - 1;
|
|
ispburst = prom_getpropint(sa->sa_node, "burst-sizes", -1);
|
|
if (ispburst == -1) {
|
|
ispburst = sbusburst;
|
|
}
|
|
ispburst &= sbusburst;
|
|
ispburst &= ~(1 << 7);
|
|
ispburst &= ~(1 << 6);
|
|
sbc->sbus_mdvec.dv_conf1 = 0;
|
|
if (ispburst & (1 << 5)) {
|
|
sbc->sbus_mdvec.dv_conf1 = BIU_SBUS_CONF1_FIFO_32;
|
|
} else if (ispburst & (1 << 4)) {
|
|
sbc->sbus_mdvec.dv_conf1 = BIU_SBUS_CONF1_FIFO_16;
|
|
} else if (ispburst & (1 << 3)) {
|
|
sbc->sbus_mdvec.dv_conf1 =
|
|
BIU_SBUS_CONF1_BURST8 | BIU_SBUS_CONF1_FIFO_8;
|
|
}
|
|
if (sbc->sbus_mdvec.dv_conf1) {
|
|
sbc->sbus_mdvec.dv_conf1 |= BIU_BURST_ENABLE;
|
|
}
|
|
|
|
isp->isp_mdvec = &sbc->sbus_mdvec;
|
|
isp->isp_bustype = ISP_BT_SBUS;
|
|
isp->isp_type = ISP_HA_SCSI_UNKNOWN;
|
|
isp->isp_param = &sbc->sbus_dev;
|
|
isp->isp_dmatag = sa->sa_dmatag;
|
|
ISP_MEMZERO(isp->isp_param, sizeof (sdparam));
|
|
isp->isp_osinfo.chan = &sbc->sbus_chan;
|
|
|
|
sbc->sbus_poff[BIU_BLOCK >> _BLK_REG_SHFT] = BIU_REGS_OFF;
|
|
sbc->sbus_poff[MBOX_BLOCK >> _BLK_REG_SHFT] = SBUS_MBOX_REGS_OFF;
|
|
sbc->sbus_poff[SXP_BLOCK >> _BLK_REG_SHFT] = SBUS_SXP_REGS_OFF;
|
|
sbc->sbus_poff[RISC_BLOCK >> _BLK_REG_SHFT] = SBUS_RISC_REGS_OFF;
|
|
sbc->sbus_poff[DMA_BLOCK >> _BLK_REG_SHFT] = DMA_REGS_OFF;
|
|
|
|
/* Establish interrupt channel */
|
|
bus_intr_establish(sbc->sbus_bustag, sbc->sbus_pri, IPL_BIO,
|
|
isp_sbus_intr, sbc);
|
|
|
|
/*
|
|
* Set up logging levels.
|
|
*/
|
|
#ifdef ISP_LOGDEFAULT
|
|
isp->isp_dblev = ISP_LOGDEFAULT;
|
|
#else
|
|
isp->isp_dblev = ISP_LOGWARN|ISP_LOGERR;
|
|
if (bootverbose)
|
|
isp->isp_dblev |= ISP_LOGCONFIG|ISP_LOGINFO;
|
|
#ifdef SCSIDEBUG
|
|
isp->isp_dblev |= ISP_LOGDEBUG1|ISP_LOGDEBUG2;
|
|
#endif
|
|
#ifdef DEBUG
|
|
isp->isp_dblev |= ISP_LOGDEBUG0;
|
|
#endif
|
|
#endif
|
|
|
|
isp->isp_confopts = device_cfdata(self)->cf_flags;
|
|
SDPARAM(isp, 0)->role = ISP_DEFAULT_ROLES;
|
|
|
|
/*
|
|
* There's no tool on sparc to set NVRAM for ISPs, so ignore it.
|
|
*/
|
|
isp->isp_confopts |= ISP_CFG_NONVRAM;
|
|
|
|
/*
|
|
* Mark things if we're a PTI SBus adapter.
|
|
*/
|
|
if (strcmp("PTI,ptisp", sa->sa_name) == 0 ||
|
|
strcmp("ptisp", sa->sa_name) == 0) {
|
|
SDPARAM(isp, 0)->isp_ptisp = 1;
|
|
}
|
|
ISP_LOCK(isp);
|
|
isp_reset(isp, 1);
|
|
if (isp->isp_state != ISP_RESETSTATE) {
|
|
ISP_UNLOCK(isp);
|
|
return;
|
|
}
|
|
ISP_ENABLE_INTS(isp);
|
|
isp_init(isp);
|
|
if (isp->isp_state != ISP_INITSTATE) {
|
|
isp_uninit(isp);
|
|
ISP_UNLOCK(isp);
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* do generic attach.
|
|
*/
|
|
ISP_UNLOCK(isp);
|
|
isp_attach(isp);
|
|
}
|
|
|
|
|
|
static void
|
|
isp_sbus_reset0(ispsoftc_t *isp)
|
|
{
|
|
ISP_DISABLE_INTS(isp);
|
|
}
|
|
|
|
static void
|
|
isp_sbus_reset1(ispsoftc_t *isp)
|
|
{
|
|
ISP_ENABLE_INTS(isp);
|
|
}
|
|
|
|
static int
|
|
isp_sbus_intr(void *arg)
|
|
{
|
|
uint32_t isr;
|
|
uint16_t sema, mbox;
|
|
ispsoftc_t *isp = arg;
|
|
|
|
if (ISP_READ_ISR(isp, &isr, &sema, &mbox) == 0) {
|
|
isp->isp_intbogus++;
|
|
return (0);
|
|
} else {
|
|
struct isp_sbussoftc *sbc = arg;
|
|
sbc->sbus_isp.isp_osinfo.onintstack = 1;
|
|
isp_intr(isp, isr, sema, mbox);
|
|
sbc->sbus_isp.isp_osinfo.onintstack = 0;
|
|
return (1);
|
|
}
|
|
}
|
|
|
|
#define IspVirt2Off(a, x) \
|
|
(((struct isp_sbussoftc *)a)->sbus_poff[((x) & _BLK_REG_MASK) >> \
|
|
_BLK_REG_SHFT] + ((x) & 0xff))
|
|
|
|
#define BXR2(sbc, off) \
|
|
bus_space_read_2(sbc->sbus_bustag, sbc->sbus_reg, off)
|
|
|
|
static int
|
|
isp_sbus_rd_isr(ispsoftc_t *isp, uint32_t *isrp,
|
|
uint16_t *semap, uint16_t *mbp)
|
|
{
|
|
struct isp_sbussoftc *sbc = (struct isp_sbussoftc *) isp;
|
|
uint32_t isr;
|
|
uint16_t sema;
|
|
|
|
isr = BXR2(sbc, IspVirt2Off(isp, BIU_ISR));
|
|
sema = BXR2(sbc, IspVirt2Off(isp, BIU_SEMA));
|
|
isp_prt(isp, ISP_LOGDEBUG3, "ISR 0x%x SEMA 0x%x", isr, sema);
|
|
isr &= INT_PENDING_MASK(isp);
|
|
sema &= BIU_SEMA_LOCK;
|
|
if (isr == 0 && sema == 0) {
|
|
return (0);
|
|
}
|
|
*isrp = isr;
|
|
if ((*semap = sema) != 0) {
|
|
*mbp = BXR2(sbc, IspVirt2Off(isp, OUTMAILBOX0));
|
|
}
|
|
return (1);
|
|
}
|
|
|
|
static uint32_t
|
|
isp_sbus_rd_reg(ispsoftc_t *isp, int regoff)
|
|
{
|
|
struct isp_sbussoftc *sbc = (struct isp_sbussoftc *) isp;
|
|
int offset = sbc->sbus_poff[(regoff & _BLK_REG_MASK) >> _BLK_REG_SHFT];
|
|
offset += (regoff & 0xff);
|
|
return (bus_space_read_2(sbc->sbus_bustag, sbc->sbus_reg, offset));
|
|
}
|
|
|
|
static void
|
|
isp_sbus_wr_reg(ispsoftc_t *isp, int regoff, uint32_t val)
|
|
{
|
|
struct isp_sbussoftc *sbc = (struct isp_sbussoftc *) isp;
|
|
int offset = sbc->sbus_poff[(regoff & _BLK_REG_MASK) >> _BLK_REG_SHFT];
|
|
offset += (regoff & 0xff);
|
|
bus_space_write_2(sbc->sbus_bustag, sbc->sbus_reg, offset, val);
|
|
}
|
|
|
|
static int
|
|
isp_sbus_mbxdma(ispsoftc_t *isp)
|
|
{
|
|
struct isp_sbussoftc *sbc = (struct isp_sbussoftc *) isp;
|
|
bus_dma_segment_t reqseg, rspseg;
|
|
int reqrs, rsprs, i, progress;
|
|
size_t n;
|
|
bus_size_t len;
|
|
|
|
if (isp->isp_rquest_dma)
|
|
return (0);
|
|
|
|
n = isp->isp_maxcmds * sizeof (isp_hdl_t);
|
|
isp->isp_xflist = (isp_hdl_t *) malloc(n, M_DEVBUF, M_WAITOK);
|
|
if (isp->isp_xflist == NULL) {
|
|
isp_prt(isp, ISP_LOGERR, "cannot alloc xflist array");
|
|
return (1);
|
|
}
|
|
ISP_MEMZERO(isp->isp_xflist, n);
|
|
for (n = 0; n < isp->isp_maxcmds - 1; n++) {
|
|
isp->isp_xflist[n].cmd = &isp->isp_xflist[n+1];
|
|
}
|
|
n = sizeof (bus_dmamap_t) * isp->isp_maxcmds;
|
|
sbc->sbus_dmamap = (bus_dmamap_t *) malloc(n, M_DEVBUF, M_WAITOK);
|
|
if (sbc->sbus_dmamap == NULL) {
|
|
free(isp->isp_xflist, M_DEVBUF);
|
|
isp->isp_xflist = NULL;
|
|
isp_prt(isp, ISP_LOGERR, "cannot alloc dmamap array");
|
|
return (1);
|
|
}
|
|
for (i = 0; i < isp->isp_maxcmds; i++) {
|
|
/* Allocate a DMA handle */
|
|
if (bus_dmamap_create(isp->isp_dmatag, MAXPHYS, 1, MAXPHYS,
|
|
1 << 24, BUS_DMA_NOWAIT, &sbc->sbus_dmamap[i]) != 0) {
|
|
isp_prt(isp, ISP_LOGERR, "cmd DMA maps create error");
|
|
break;
|
|
}
|
|
}
|
|
if (i < isp->isp_maxcmds) {
|
|
while (--i >= 0) {
|
|
bus_dmamap_destroy(isp->isp_dmatag,
|
|
sbc->sbus_dmamap[i]);
|
|
}
|
|
free(isp->isp_xflist, M_DEVBUF);
|
|
free(sbc->sbus_dmamap, M_DEVBUF);
|
|
isp->isp_xflist = NULL;
|
|
sbc->sbus_dmamap = NULL;
|
|
return (1);
|
|
}
|
|
|
|
/*
|
|
* Allocate and map the request and response queues
|
|
*/
|
|
progress = 0;
|
|
len = ISP_QUEUE_SIZE(RQUEST_QUEUE_LEN(isp));
|
|
if (bus_dmamem_alloc(isp->isp_dmatag, len, 0, 0, &reqseg, 1, &reqrs,
|
|
BUS_DMA_NOWAIT)) {
|
|
goto dmafail;
|
|
}
|
|
progress++;
|
|
if (bus_dmamem_map(isp->isp_dmatag, &reqseg, reqrs, len,
|
|
(void *)&isp->isp_rquest, BUS_DMA_NOWAIT|BUS_DMA_COHERENT)) {
|
|
goto dmafail;
|
|
}
|
|
progress++;
|
|
if (bus_dmamap_create(isp->isp_dmatag, len, 1, len, 1 << 24,
|
|
BUS_DMA_NOWAIT, &isp->isp_rqdmap) != 0) {
|
|
goto dmafail;
|
|
}
|
|
progress++;
|
|
if (bus_dmamap_load(isp->isp_dmatag, isp->isp_rqdmap,
|
|
isp->isp_rquest, len, NULL, BUS_DMA_NOWAIT) != 0) {
|
|
goto dmafail;
|
|
}
|
|
progress++;
|
|
isp->isp_rquest_dma = isp->isp_rqdmap->dm_segs[0].ds_addr;
|
|
|
|
len = ISP_QUEUE_SIZE(RESULT_QUEUE_LEN(isp));
|
|
if (bus_dmamem_alloc(isp->isp_dmatag, len, 0, 0, &rspseg, 1, &rsprs,
|
|
BUS_DMA_NOWAIT)) {
|
|
goto dmafail;
|
|
}
|
|
progress++;
|
|
if (bus_dmamem_map(isp->isp_dmatag, &rspseg, rsprs, len,
|
|
(void *)&isp->isp_result, BUS_DMA_NOWAIT|BUS_DMA_COHERENT)) {
|
|
goto dmafail;
|
|
}
|
|
progress++;
|
|
if (bus_dmamap_create(isp->isp_dmatag, len, 1, len, 1 << 24,
|
|
BUS_DMA_NOWAIT, &isp->isp_rsdmap) != 0) {
|
|
goto dmafail;
|
|
}
|
|
progress++;
|
|
if (bus_dmamap_load(isp->isp_dmatag, isp->isp_rsdmap,
|
|
isp->isp_result, len, NULL, BUS_DMA_NOWAIT) != 0) {
|
|
goto dmafail;
|
|
}
|
|
isp->isp_result_dma = isp->isp_rsdmap->dm_segs[0].ds_addr;
|
|
|
|
return (0);
|
|
|
|
dmafail:
|
|
isp_prt(isp, ISP_LOGERR, "Mailbox DMA Setup Failure");
|
|
|
|
if (progress >= 8) {
|
|
bus_dmamap_unload(isp->isp_dmatag, isp->isp_rsdmap);
|
|
}
|
|
if (progress >= 7) {
|
|
bus_dmamap_destroy(isp->isp_dmatag, isp->isp_rsdmap);
|
|
}
|
|
if (progress >= 6) {
|
|
bus_dmamem_unmap(isp->isp_dmatag,
|
|
isp->isp_result, ISP_QUEUE_SIZE(RESULT_QUEUE_LEN(isp)));
|
|
}
|
|
if (progress >= 5) {
|
|
bus_dmamem_free(isp->isp_dmatag, &rspseg, rsprs);
|
|
}
|
|
|
|
if (progress >= 4) {
|
|
bus_dmamap_unload(isp->isp_dmatag, isp->isp_rqdmap);
|
|
}
|
|
if (progress >= 3) {
|
|
bus_dmamap_destroy(isp->isp_dmatag, isp->isp_rqdmap);
|
|
}
|
|
if (progress >= 2) {
|
|
bus_dmamem_unmap(isp->isp_dmatag,
|
|
isp->isp_rquest, ISP_QUEUE_SIZE(RQUEST_QUEUE_LEN(isp)));
|
|
}
|
|
if (progress >= 1) {
|
|
bus_dmamem_free(isp->isp_dmatag, &reqseg, reqrs);
|
|
}
|
|
|
|
for (i = 0; i < isp->isp_maxcmds; i++) {
|
|
bus_dmamap_destroy(isp->isp_dmatag, sbc->sbus_dmamap[i]);
|
|
}
|
|
free(sbc->sbus_dmamap, M_DEVBUF);
|
|
free(isp->isp_xflist, M_DEVBUF);
|
|
isp->isp_xflist = NULL;
|
|
sbc->sbus_dmamap = NULL;
|
|
return (1);
|
|
}
|
|
|
|
/*
|
|
* Map a DMA request.
|
|
* We're guaranteed that rq->req_handle is a value from 1 to isp->isp_maxcmds.
|
|
*/
|
|
|
|
static int
|
|
isp_sbus_dmasetup(struct ispsoftc *isp, struct scsipi_xfer *xs, void *arg)
|
|
{
|
|
struct isp_sbussoftc *sbc = (struct isp_sbussoftc *)isp;
|
|
ispreq_t *rq = arg;
|
|
bus_dmamap_t dmap;
|
|
bus_dma_segment_t *dm_segs;
|
|
uint32_t nsegs, hidx;
|
|
isp_ddir_t ddir;
|
|
|
|
hidx = isp_handle_index(isp, rq->req_handle);
|
|
if (hidx == ISP_BAD_HANDLE_INDEX) {
|
|
XS_SETERR(xs, HBA_BOTCH);
|
|
return (CMD_COMPLETE);
|
|
}
|
|
dmap = sbc->sbus_dmamap[hidx];
|
|
if (xs->datalen == 0) {
|
|
ddir = ISP_NOXFR;
|
|
nsegs = 0;
|
|
dm_segs = NULL;
|
|
} else {
|
|
int error;
|
|
uint32_t flag, flg2;
|
|
|
|
if (xs->xs_control & XS_CTL_DATA_IN) {
|
|
flg2 = BUS_DMASYNC_PREREAD;
|
|
flag = BUS_DMA_READ;
|
|
ddir = ISP_FROM_DEVICE;
|
|
} else {
|
|
flg2 = BUS_DMASYNC_PREWRITE;
|
|
flag = BUS_DMA_WRITE;
|
|
ddir = ISP_TO_DEVICE;
|
|
}
|
|
error = bus_dmamap_load(isp->isp_dmatag, dmap, xs->data, xs->datalen,
|
|
NULL, ((xs->xs_control & XS_CTL_NOSLEEP) ? BUS_DMA_NOWAIT : BUS_DMA_WAITOK) | BUS_DMA_STREAMING | flag);
|
|
if (error) {
|
|
isp_prt(isp, ISP_LOGWARN, "unable to load DMA (%d)", error);
|
|
XS_SETERR(xs, HBA_BOTCH);
|
|
if (error == EAGAIN || error == ENOMEM) {
|
|
return (CMD_EAGAIN);
|
|
} else {
|
|
return (CMD_COMPLETE);
|
|
}
|
|
}
|
|
dm_segs = dmap->dm_segs;
|
|
nsegs = dmap->dm_nsegs;
|
|
bus_dmamap_sync(isp->isp_dmatag, dmap, 0, dmap->dm_mapsize, flg2);
|
|
}
|
|
|
|
if (isp_send_cmd(isp, rq, dm_segs, nsegs, xs->datalen, ddir) != CMD_QUEUED) {
|
|
return (CMD_EAGAIN);
|
|
} else {
|
|
return (CMD_QUEUED);
|
|
}
|
|
}
|
|
|
|
static void
|
|
isp_sbus_dmateardown(ispsoftc_t *isp, XS_T *xs, uint32_t handle)
|
|
{
|
|
struct isp_sbussoftc *sbc = (struct isp_sbussoftc *) isp;
|
|
bus_dmamap_t dmap;
|
|
uint32_t hidx;
|
|
|
|
hidx = isp_handle_index(isp, handle);
|
|
if (hidx == ISP_BAD_HANDLE_INDEX) {
|
|
isp_xs_prt(isp, xs, ISP_LOGERR, "bad handle on teardown");
|
|
return;
|
|
}
|
|
dmap = sbc->sbus_dmamap[hidx];
|
|
bus_dmamap_sync(isp->isp_dmatag, dmap, 0,
|
|
xs->datalen, (xs->xs_control & XS_CTL_DATA_IN)?
|
|
BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE);
|
|
bus_dmamap_unload(isp->isp_dmatag, dmap);
|
|
}
|