NetBSD/sys/arch/mac68k/scsi/sg.c

759 lines
15 KiB
C
Raw Normal View History

/*
* Contributed by HD Associates (hd@world.std.com).
* Copyright (c) 1992, 1993 HD Associates
*
* Berkeley style copyright. I've just snarfed it out of stdio.h:
*
* 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. All advertising materials mentioning features or use of this software
* must display the following acknowledgement:
* This product includes software developed by the University of
* California, Berkeley and its contributors.
* 4. Neither the name of the University nor the names of its contributors
* may be used to endorse or promote products derived from this software
* without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``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 REGENTS OR CONTRIBUTORS 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/types.h>
#include <sys/errno.h>
#include <sys/param.h>
#include <sys/malloc.h>
#include <sys/buf.h>
#include <sys/proc.h>
#include <scsi/scsi_all.h>
#include <scsi/scsiconf.h>
#include <scsi/scsi_generic.h>
#include "sg.h"
#include <sys/sgio.h>
#define SGOUTSTANDING 2
#define SG_RETRIES 2
#define SPLSG splbio
/* Use one of the implementation defined spare bits
* to indicate the escape op:
*/
#define DSRQ_ESCAPE DSRQ_CTRL1
struct sg
{
int flags;
struct scsi_switch *sc_sw;
int ctlr;
long int ad_info; /* info about the adapter */
int cmdscount; /* cmds allowed outstanding by the board */
struct scsi_xfer *free_xfer;
int free_xfer_wait;
};
/* This is used to associate a struct dsreq and a struct buf.
*/
typedef struct dsbuf
{
dsreq_t *dsreq;
struct buf buf;
/* I think this is a portable way to get back to the base of
* the enclosing structure:
*/
# define DSBUF_P(BP) ((dsbuf_t *)((caddr_t)(BP) - (caddr_t)&((dsbuf_t *)0)->buf))
int magic;
# define DSBUF_MAGIC 0xDBFACDBF
} dsbuf_t;
#if NSG > 4
/* The host adapter unit is encoded in the upper 2 bits of the minor number
* (the SGI flag bits).
*/
#error "NSG can't be > 4 unless the method of encoding the board unit changes"
#endif
struct sg *sgs[NSG];
#define SG(DEV) sgs[G_SCSI_UNIT(DEV)]
struct sg *sg_new(int lun)
{
struct sg *sg = (struct sg *)malloc(sizeof(*sg),M_TEMP, M_NOWAIT);
if (sg == 0)
return 0;
bzero(sg, sizeof(struct sg));
return sg;
}
int sg_attach(ctlr, scsi_addr, scsi_switch)
int ctlr,scsi_addr;
struct scsi_switch *scsi_switch;
{
struct sg *sg;
int i;
struct scsi_xfer *scsi_xfer;
static int next_sg_unit = 0;
int unit = next_sg_unit++;
if (unit >= NSG)
{
printf("Too many generic SCSIs (%d > %d); reconfigure the kernel.\n",
unit+1, NSG);
if (NSG == 4)
printf(
"You have hit the max of 4. You will have to change the driver.\n");
return 0;
}
if ((sg = sg_new(0)) == 0)
return 0;
sgs[unit] = sg;
sg->sc_sw = scsi_switch;
sg->ctlr = ctlr;
/* This is a bit confusing. It looks like Julian calls back into the
* adapter to find out how many outstanding transactions it can
* handle. How does he handle a tape/disk combo?
*/
if (sg->sc_sw->adapter_info)
{
sg->ad_info = ( (*(sg->sc_sw->adapter_info))(unit));
sg->cmdscount = sg->ad_info & AD_INF_MAX_CMDS;
if(sg->cmdscount > SGOUTSTANDING)
sg->cmdscount = SGOUTSTANDING;
}
else
{
sg->ad_info = 1;
sg->cmdscount = 1;
}
i = sg->cmdscount;
scsi_xfer = (struct scsi_xfer *)malloc(sizeof(struct scsi_xfer) *
i, M_TEMP, M_NOWAIT);
if (scsi_xfer == 0)
{
printf("scsi_generic: Can't malloc.\n");
return 0;
}
while (i--)
{
scsi_xfer->next = sg->free_xfer;
sg->free_xfer = scsi_xfer;
scsi_xfer++;
}
#ifndef EMBEDDED
if (unit == 0)
printf(" /dev/gs%d (instance 0) generic SCSI via controller %d\n",
scsi_addr, sg->ctlr);
else
printf(" /dev/gs%d-%d generic SCSI via controller %d\n",
unit, scsi_addr, sg->ctlr);
#endif
return 1;
}
/* It is trivial to add support for processor target devices
* here - enable target mode on open and disable on close
* if a flag bit is set in the minor number
*/
int sgopen(dev_t dev)
{
if (SG(dev) == 0)
return ENXIO;
return 0;
}
int sgclose(dev_t dev)
{
return 0;
}
/* Free a scsi_xfer, wake processes waiting for it
*/
void sg_free_xs(dev_t dev, struct scsi_xfer *xs, int flags)
{
int s;
struct sg *sg = SG(dev);
if(flags & SCSI_NOMASK)
{
if (sg->free_xfer_wait)
{
printf("sg_free_xs: doing a wakeup from NOMASK mode!\n");
wakeup((caddr_t)&sg->free_xfer);
}
xs->next = sg->free_xfer;
sg->free_xfer = xs;
}
else
{
s = SPLSG();
if (sg->free_xfer_wait)
wakeup((caddr_t)&sg->free_xfer);
xs->next = sg->free_xfer;
sg->free_xfer = xs;
splx(s);
}
}
/* Get ownership of a scsi_xfer
* If need be, sleep on it, until it comes free
*/
struct scsi_xfer *sg_get_xs(dev_t dev, int flags)
{
struct scsi_xfer *xs;
int s;
struct sg *sg = SG(dev);
if(flags & (SCSI_NOSLEEP | SCSI_NOMASK))
{
if (xs = sg->free_xfer)
{
sg->free_xfer = xs->next;
xs->flags = 0;
}
}
else
{
s = SPLSG();
while (!(xs = sg->free_xfer))
{
sg->free_xfer_wait++; /* someone waiting! */
sleep((caddr_t)&sg->free_xfer, PRIBIO+1);
sg->free_xfer_wait--;
}
sg->free_xfer = xs->next;
splx(s);
xs->flags = 0;
}
return xs;
}
/* We let the user interpret his own sense in the
* generic scsi world
*/
int sg_interpret_sense(dev_t dev, struct scsi_xfer *xs, int *flag_p)
{
return 0;
}
/* ITSDONE is really used for things that are marked one
* in the interrupt. I'll leave the logic in in case I want
* to move done processing (and therefore have a start queue)
* back into the interrupt.
* BUG: No start queue.
*/
int sg_done(dev_t dev,
struct scsi_xfer *xs)
{
xs->flags |= ITSDONE;
wakeup(xs);
return 0;
}
int sg_submit_cmd(dev_t dev, struct scsi_xfer *xs, dsreq_t *dsreq)
{
int retval;
struct sg *sg = SG(dev);
retry:
xs->error = XS_NOERROR;
xs->bp = 0; /* This bp doesn't seem to be used except to
* disable sleeping in the host adapter code.
* "st" does set it up, though.
*/
retval = (*(sg->sc_sw->scsi_cmd))(xs);
switch(retval)
{
case SUCCESSFULLY_QUEUED:
while(!(xs->flags & ITSDONE))
sleep(xs,PRIBIO+1);
/* Fall through... */
case HAD_ERROR:
if (dsreq)
dsreq->ds_status = xs->status;
switch(xs->error)
{
case XS_NOERROR:
if (dsreq)
dsreq->ds_datasent = dsreq->ds_datalen - xs->resid;
retval = 0;
break;
case XS_SENSE:
retval = (sg_interpret_sense(dev ,xs, (int *)0));
if (dsreq)
{
dsreq->ds_sensesent = sizeof(xs->sense);
dsreq->ds_ret = DSRT_SENSE;
}
retval = 0;
break;
case XS_DRIVER_STUFFUP:
if (dsreq)
dsreq->ds_ret = DSRT_HOST;
printf("sg%d: host adapter code inconsistency\n" ,G_SCSI_UNIT(dev));
retval = EIO;
break;
case XS_TIMEOUT:
if (dsreq)
dsreq->ds_ret = DSRT_TIMEOUT;
retval = ETIMEDOUT;
break;
case XS_BUSY:
if(xs->retries-- )
{
xs->flags &= ~ITSDONE;
goto retry;
}
retval = EBUSY;
break;
default:
printf("sg%d: unknown error category from host adapter code\n"
,G_SCSI_UNIT(dev));
retval = EIO;
break;
}
break;
case COMPLETE:
if (dsreq)
dsreq->ds_datasent = dsreq->ds_datalen - xs->resid;
retval = 0;
break;
case TRY_AGAIN_LATER:
if(xs->retries-- )
{
xs->flags &= ~ITSDONE;
goto retry;
}
retval = EBUSY;
break;
case ESCAPE_NOT_SUPPORTED:
retval = ENOSYS; /* "Function not implemented" */
break;
default:
printf("sg%d: illegal return from host adapter code\n",
G_SCSI_UNIT(dev));
retval = EIO;
break;
}
return retval;
}
/* sg_escape: Do a generic SCSI escape
*/
int sg_escape(dev_t dev, int op_code, u_char *b, int nb)
{
int retval;
struct scsi_generic scsi_generic;
int flags = SCSI_ESCAPE;
struct scsi_xfer *xs;
struct sg *sg = SG(dev);
xs = sg_get_xs(dev, flags);
if (xs == 0)
{
printf("sg_target%d: controller busy"
" (this should never happen)\n",G_SCSI_UNIT(dev));
return EBUSY;
}
scsi_generic.opcode = op_code;
bcopy(b, scsi_generic.bytes, nb);
/* Fill out the scsi_xfer structure
*/
xs->flags = (flags|INUSE);
xs->adapter = sg->ctlr;
xs->cmd = &scsi_generic;
xs->targ = G_SCSI_ID(dev);
xs->lu = G_SCSI_LUN(dev);
xs->retries = SG_RETRIES;
xs->timeout = 100;
xs->when_done = (flags & SCSI_NOMASK)
?(int (*)())0
:(int (*)())sg_done;
xs->done_arg = dev;
xs->done_arg2 = (int)xs;
xs->status = 0;
retval = sg_submit_cmd(dev, xs, 0);
bcopy(scsi_generic.bytes, b, nb);
sg_free_xs(dev,xs,flags);
return retval;
}
/* sg_target: Turn on / off target mode
*/
int sg_target(dev_t dev, int enable)
{
u_char b0 = enable;
return sg_escape(dev, SCSI_OP_TARGET, &b0, 1);
}
#ifdef EMBEDDED
/* This should REALLY be a select call!
* This is used in a stand alone system without an O/S. I didn't
* have the time to add select, which the system was missing,
* so I added this stuff to poll for the async arrival of
* connections for target mode.
*/
int sg_poll(dev_t dev, int *send, int *recv)
{
scsi_op_poll_t s;
int ret;
ret = sg_escape(dev, SCSI_OP_POLL, (u_char *)&s, sizeof(s));
if (ret == 0)
{
*send = s.send;
*recv = s.recv;
}
return ret;
}
#endif /* EMBEDDED */
int sg_scsi_cmd(dev_t dev,
dsreq_t *dsreq,
struct scsi_generic *scsi_cmd,
u_char *d_addr,
long d_count,
struct scsi_sense_data *scsi_sense)
{
int retval;
int flags = 0;
struct scsi_xfer *xs;
struct sg *sg = SG(dev);
if (sg->sc_sw == 0)
return ENODEV;
dsreq->ds_status = 0;
dsreq->ds_sensesent = 0;
if (dsreq->ds_flags & DSRQ_READ)
flags |= SCSI_DATA_IN;
if (dsreq->ds_flags & DSRQ_WRITE)
flags |= SCSI_DATA_OUT;
if (dsreq->ds_flags & DSRQ_TARGET)
flags |= SCSI_TARGET;
if (dsreq->ds_flags & DSRQ_ESCAPE)
flags |= SCSI_ESCAPE;
#ifdef SCSI_PHYSADDR
if (dsreq->ds_flags & DSRQ_PHYSADDR)
flags |= SCSI_PHYSADDR;
#endif
xs = sg_get_xs(dev, flags);
if (xs == 0)
{
printf("sg_scsi_cmd%d: controller busy"
" (this should never happen)\n",G_SCSI_UNIT(dev));
return EBUSY;
}
/* Fill out the scsi_xfer structure
*/
xs->flags |= (flags|INUSE);
xs->adapter = sg->ctlr;
xs->targ = G_SCSI_ID(dev);
xs->lu = G_SCSI_LUN(dev);
xs->retries = SG_RETRIES;
xs->timeout = dsreq->ds_time;
xs->cmd = scsi_cmd;
xs->cmdlen = dsreq->ds_cmdlen;
xs->data = d_addr;
xs->datalen = d_count;
xs->resid = d_count;
xs->when_done = (flags & SCSI_NOMASK)
?(int (*)())0
:(int (*)())sg_done;
xs->done_arg = dev;
xs->done_arg2 = (int)xs;
xs->req_sense_length = (dsreq->ds_senselen < sizeof(struct scsi_sense_data))
? dsreq->ds_senselen
: sizeof(struct scsi_sense_data);
xs->status = 0;
retval = sg_submit_cmd(dev, xs, dsreq);
if (dsreq->ds_ret == DSRT_SENSE)
bcopy(&(xs->sense), scsi_sense, sizeof(xs->sense));
sg_free_xs(dev,xs,flags);
return retval;
}
void sgerr(struct buf *bp, int err)
{
bp->b_error = err;
bp->b_flags |= B_ERROR;
iodone(bp);
}
/* strategy function
*
* Should I reorganize this so it returns to physio instead
* of sleeping in sg_scsi_cmd? Is there any advantage, other
* than avoiding the probable duplicate wakeup in iodone?
*
* Don't create a block device entry point for this
* driver without making some fixes:
* you have to be able to go from the bp to the dsreq somehow.
*/
void sgstrategy(struct buf *bp)
{
int err;
struct scsi_generic scsi_generic;
struct scsi_sense_data scsi_sense;
int lun = G_SCSI_LUN(bp->b_dev);
dsbuf_t *dsbuf = DSBUF_P(bp);
dsreq_t *dsreq;
if (dsbuf->magic != DSBUF_MAGIC)
{
printf("sgstrategy: struct buf not magic.\n");
sgerr(bp, EFAULT);
return;
}
dsreq = dsbuf->dsreq;
/* We're in trouble if physio tried to break up the
* transfer:
*/
if (bp->b_bcount != dsreq->ds_datalen)
{
printf("sgstrategy unit%d: Transfer broken up.\n",
G_SCSI_UNIT(bp->b_dev));
sgerr(bp, EIO);
return;
}
dsreq->ds_ret = DSRT_OK;
/* Reject 0 length timeouts.
*/
if (dsreq->ds_time == 0)
{
sgerr(bp, EINVAL);
return;
}
if (dsreq->ds_cmdlen > sizeof(struct scsi_generic))
{
sgerr(bp, EFAULT);
return;
}
copyin(dsreq->ds_cmdbuf, (char *)&scsi_generic, dsreq->ds_cmdlen);
/* Use device unit for the LUN. Using the one the user provided
* would be a huge security problem.
*/
if ((dsreq->ds_flags & DSRQ_ESCAPE) == 0)
scsi_generic.bytes[0] = (scsi_generic.bytes[0] & 0x1F) | (lun << 5);
err = sg_scsi_cmd(bp->b_dev, dsreq,
&scsi_generic,
(u_char *)bp->b_un.b_addr,
bp->b_bcount,
&scsi_sense);
if (dsreq->ds_sensesent)
{
if (dsreq->ds_sensesent > dsreq->ds_senselen)
dsreq->ds_sensesent = dsreq->ds_senselen;
copyout(&scsi_sense, dsreq->ds_sensebuf, dsreq->ds_sensesent);
}
if (err)
{
if (dsreq->ds_ret == DSRT_OK)
dsreq->ds_ret = DSRT_DEVSCSI;
sgerr(bp, err);
return;
}
/* This is a fake. It would be nice to know if the
* command was sent or not instead of pretending it was if
* we get this far. That would involve adding "sent" members
* to the xs so it could be set up down in the host adapter code.
*/
dsreq->ds_cmdsent = dsreq->ds_cmdlen;
if (dsreq->ds_ret == 0)
dsreq->ds_ret = DSRT_OK;
iodone(bp); /* Shouldn't this iodone be done in the interrupt?
*/
return;
}
void sgminphys(struct buf *bp)
{
}
int sgioctl(dev_t dev, int cmd, caddr_t addr, int f)
{
int ret = 0;
int phys;
switch(cmd)
{
case DS_ENTER:
{
dsreq_t *dsreq = (dsreq_t *)addr;
int rwflag = (dsreq->ds_flags & DSRQ_READ) ? B_READ : B_WRITE;
struct dsbuf dsbuf;
struct buf *bp = &dsbuf.buf;
bzero(&dsbuf, sizeof(dsbuf));
dsbuf.dsreq = dsreq;
dsbuf.magic = DSBUF_MAGIC;
#ifdef SCSI_PHYSADDR /* Physical memory addressing option */
phys = (dsreq->ds_flags & DSRQ_PHYSADDR);
#else
phys = 0;
#endif
if (phys)
{
bp->b_un.b_addr = dsreq->ds_databuf;
bp->b_bcount = dsreq->ds_datalen;
bp->b_dev = dev;
bp->b_flags = rwflag;
sgstrategy(bp);
ret = bp->b_error;
}
else if (dsreq->ds_datalen)
{
struct uio uio;
struct iovec iovec;
iovec.iov_base = dsreq->ds_databuf;
iovec.iov_len = dsreq->ds_datalen;
uio.uio_offset = 0;
uio.uio_resid = dsreq->ds_datalen;
uio.uio_segflg = UIO_USERSPACE;
uio.uio_procp = curproc;
uio.uio_rw = (rwflag == B_READ) ? UIO_READ : UIO_WRITE;
uio.uio_iov = &iovec;
uio.uio_iovcnt = 1;
/* if ((ret = rawio(dev, &uio, bp)) == 0)
ret = bp->b_error; */
}
else
{
bp->b_un.b_addr = 0;
bp->b_bcount = 0;
bp->b_dev = dev;
bp->b_flags = 0;
sgstrategy(bp);
ret = bp->b_error;
}
}
break;
case DS_TARGET:
ret = sg_target(dev, *(int *)addr);
break;
default:
ret = ENOTTY;
break;
}
return ret;
}