#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/errno.h>
#include <sys/ioctl.h>
#include <sys/device.h>
#include <sys/malloc.h>
#include <sys/buf.h>
#include <machine/bus.h>
#include <machine/intr.h>
#include <scsi/scsi_all.h>
#include <scsi/scsiconf.h>
#include <dev/ic/adv.h>
#include <dev/ic/advlib.h>
static int adv_alloc_ccbs(ASC_SOFTC *);
static int adv_create_ccbs(ASC_SOFTC *, ADV_CCB *, int);
void adv_ccb_free(void *, void *);
static void adv_reset_ccb(ADV_CCB *);
static int adv_init_ccb(ASC_SOFTC *, ADV_CCB *);
void *adv_ccb_alloc(void *);
static void adv_queue_ccb(ASC_SOFTC *, ADV_CCB *);
static void adv_start_ccbs(ASC_SOFTC *);
static u_int8_t *adv_alloc_overrunbuf(char *dvname, bus_dma_tag_t);
static void adv_scsi_cmd(struct scsi_xfer *);
static void adv_narrow_isr_callback(ASC_SOFTC *, ASC_QDONE_INFO *);
static int adv_poll(ASC_SOFTC *, struct scsi_xfer *, int);
static void adv_timeout(void *);
static void adv_watchdog(void *);
struct cfdriver adv_cd = {
NULL, "adv", DV_DULL
};
const struct scsi_adapter adv_switch = {
adv_scsi_cmd, NULL, NULL, NULL, NULL
};
#define ADV_ABORT_TIMEOUT 2000
#define ADV_WATCH_TIMEOUT 1000
static int
adv_alloc_ccbs(ASC_SOFTC *sc)
{
bus_dma_segment_t seg;
int error, rseg;
if ((error = bus_dmamem_alloc(sc->sc_dmat, sizeof(struct adv_control),
NBPG, 0, &seg, 1, &rseg,
BUS_DMA_NOWAIT | BUS_DMA_ZERO)) != 0) {
printf("%s: unable to allocate control structures,"
" error = %d\n", sc->sc_dev.dv_xname, error);
return (error);
}
if ((error = bus_dmamem_map(sc->sc_dmat, &seg, rseg,
sizeof(struct adv_control), (caddr_t *) & sc->sc_control,
BUS_DMA_NOWAIT | BUS_DMA_COHERENT)) != 0) {
printf("%s: unable to map control structures, error = %d\n",
sc->sc_dev.dv_xname, error);
return (error);
}
if ((error = bus_dmamap_create(sc->sc_dmat, sizeof(struct adv_control),
1, sizeof(struct adv_control), 0, BUS_DMA_NOWAIT,
&sc->sc_dmamap_control)) != 0) {
printf("%s: unable to create control DMA map, error = %d\n",
sc->sc_dev.dv_xname, error);
return (error);
}
if ((error = bus_dmamap_load(sc->sc_dmat, sc->sc_dmamap_control,
sc->sc_control, sizeof(struct adv_control), NULL,
BUS_DMA_NOWAIT)) != 0) {
printf("%s: unable to load control DMA map, error = %d\n",
sc->sc_dev.dv_xname, error);
return (error);
}
return (0);
}
static int
adv_create_ccbs(ASC_SOFTC *sc, ADV_CCB *ccbstore, int count)
{
ADV_CCB *ccb;
int i, error;
for (i = 0; i < count; i++) {
ccb = &ccbstore[i];
if ((error = adv_init_ccb(sc, ccb)) != 0) {
printf("%s: unable to initialize ccb, error = %d\n",
sc->sc_dev.dv_xname, error);
return (i);
}
TAILQ_INSERT_TAIL(&sc->sc_free_ccb, ccb, chain);
}
return (i);
}
void
adv_ccb_free(void *xsc, void *xccb)
{
ASC_SOFTC *sc = xsc;
ADV_CCB *ccb = xccb;
adv_reset_ccb(ccb);
mtx_enter(&sc->sc_ccb_mtx);
TAILQ_INSERT_HEAD(&sc->sc_free_ccb, ccb, chain);
mtx_leave(&sc->sc_ccb_mtx);
}
static void
adv_reset_ccb(ADV_CCB *ccb)
{
ccb->flags = 0;
}
static int
adv_init_ccb(ASC_SOFTC *sc, ADV_CCB *ccb)
{
int error;
error = bus_dmamap_create(sc->sc_dmat,
(ASC_MAX_SG_LIST - 1) * PAGE_SIZE,
ASC_MAX_SG_LIST, (ASC_MAX_SG_LIST - 1) * PAGE_SIZE,
0, BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW, &ccb->dmamap_xfer);
if (error) {
printf("%s: unable to create DMA map, error = %d\n",
sc->sc_dev.dv_xname, error);
return (error);
}
adv_reset_ccb(ccb);
return (0);
}
void *
adv_ccb_alloc(void *xsc)
{
ASC_SOFTC *sc = xsc;
ADV_CCB *ccb;
mtx_enter(&sc->sc_ccb_mtx);
ccb = TAILQ_FIRST(&sc->sc_free_ccb);
if (ccb) {
TAILQ_REMOVE(&sc->sc_free_ccb, ccb, chain);
ccb->flags |= CCB_ALLOC;
}
mtx_leave(&sc->sc_ccb_mtx);
return (ccb);
}
static void
adv_queue_ccb(ASC_SOFTC *sc, ADV_CCB *ccb)
{
timeout_set(&ccb->xs->stimeout, adv_timeout, ccb);
TAILQ_INSERT_TAIL(&sc->sc_waiting_ccb, ccb, chain);
adv_start_ccbs(sc);
}
static void
adv_start_ccbs(ASC_SOFTC *sc)
{
ADV_CCB *ccb;
struct scsi_xfer *xs;
while ((ccb = TAILQ_FIRST(&sc->sc_waiting_ccb)) != NULL) {
xs = ccb->xs;
if (ccb->flags & CCB_WATCHDOG)
timeout_del(&xs->stimeout);
if (AscExeScsiQueue(sc, &ccb->scsiq) == ASC_BUSY) {
ccb->flags |= CCB_WATCHDOG;
timeout_set(&xs->stimeout, adv_watchdog, ccb);
timeout_add_msec(&xs->stimeout, ADV_WATCH_TIMEOUT);
break;
}
TAILQ_REMOVE(&sc->sc_waiting_ccb, ccb, chain);
if ((ccb->xs->flags & SCSI_POLL) == 0) {
timeout_set(&xs->stimeout, adv_timeout, ccb);
timeout_add_msec(&xs->stimeout, ccb->timeout);
}
}
}
u_int8_t *
adv_alloc_overrunbuf(char *dvname, bus_dma_tag_t dmat)
{
static u_int8_t *overrunbuf = NULL;
bus_dmamap_t ovrbuf_dmamap;
bus_dma_segment_t seg;
int rseg, error;
if (overrunbuf)
return (overrunbuf);
if ((error = bus_dmamem_alloc(dmat, ASC_OVERRUN_BSIZE,
NBPG, 0, &seg, 1, &rseg, BUS_DMA_NOWAIT)) != 0) {
printf("%s: unable to allocate overrun buffer, error = %d\n",
dvname, error);
return (0);
}
if ((error = bus_dmamem_map(dmat, &seg, rseg, ASC_OVERRUN_BSIZE,
(caddr_t *) & overrunbuf, BUS_DMA_NOWAIT | BUS_DMA_COHERENT)) != 0) {
printf("%s: unable to map overrun buffer, error = %d\n",
dvname, error);
bus_dmamem_free(dmat, &seg, 1);
return (0);
}
if ((error = bus_dmamap_create(dmat, ASC_OVERRUN_BSIZE, 1,
ASC_OVERRUN_BSIZE, 0, BUS_DMA_NOWAIT, &ovrbuf_dmamap)) != 0) {
printf("%s: unable to create overrun buffer DMA map,"
" error = %d\n", dvname, error);
bus_dmamem_unmap(dmat, overrunbuf, ASC_OVERRUN_BSIZE);
bus_dmamem_free(dmat, &seg, 1);
return (0);
}
if ((error = bus_dmamap_load(dmat, ovrbuf_dmamap, overrunbuf,
ASC_OVERRUN_BSIZE, NULL, BUS_DMA_NOWAIT)) != 0) {
printf("%s: unable to load overrun buffer DMA map,"
" error = %d\n", dvname, error);
bus_dmamap_destroy(dmat, ovrbuf_dmamap);
bus_dmamem_unmap(dmat, overrunbuf, ASC_OVERRUN_BSIZE);
bus_dmamem_free(dmat, &seg, 1);
return (0);
}
return (overrunbuf);
}
int
adv_init(ASC_SOFTC *sc)
{
int warn;
if (!AscFindSignature(sc->sc_iot, sc->sc_ioh))
panic("adv_init: adv_find_signature failed");
AscInitASC_SOFTC(sc);
warn = AscInitFromEEP(sc);
if (warn) {
printf("%s -get: ", sc->sc_dev.dv_xname);
switch (warn) {
case -1:
printf("Chip is not halted\n");
break;
case -2:
printf("Couldn't get MicroCode Start"
" address\n");
break;
case ASC_WARN_IO_PORT_ROTATE:
printf("I/O port address modified\n");
break;
case ASC_WARN_AUTO_CONFIG:
printf("I/O port increment switch enabled\n");
break;
case ASC_WARN_EEPROM_CHKSUM:
printf("EEPROM checksum error\n");
break;
case ASC_WARN_IRQ_MODIFIED:
printf("IRQ modified\n");
break;
case ASC_WARN_CMD_QNG_CONFLICT:
printf("tag queuing enabled w/o disconnects\n");
break;
default:
printf("unknown warning %d\n", warn);
}
}
if (sc->scsi_reset_wait > ASC_MAX_SCSI_RESET_WAIT)
sc->scsi_reset_wait = ASC_MAX_SCSI_RESET_WAIT;
warn = AscInitFromASC_SOFTC(sc);
if (warn) {
printf("%s -set: ", sc->sc_dev.dv_xname);
switch (warn) {
case ASC_WARN_CMD_QNG_CONFLICT:
printf("tag queuing enabled w/o disconnects\n");
break;
case ASC_WARN_AUTO_CONFIG:
printf("I/O port increment switch enabled\n");
break;
default:
printf("unknown warning %d\n", warn);
}
}
sc->isr_callback = (ulong) adv_narrow_isr_callback;
if (!(sc->overrun_buf = adv_alloc_overrunbuf(sc->sc_dev.dv_xname,
sc->sc_dmat))) {
return (1);
}
return (0);
}
void
adv_attach(ASC_SOFTC *sc)
{
struct scsibus_attach_args saa;
int i, error;
switch (AscInitDriver(sc)) {
case 0:
break;
case 1:
panic("%s: bad signature", sc->sc_dev.dv_xname);
break;
case 2:
panic("%s: unable to load MicroCode",
sc->sc_dev.dv_xname);
break;
case 3:
panic("%s: unable to initialize MicroCode",
sc->sc_dev.dv_xname);
break;
default:
panic("%s: unable to initialize board RISC chip",
sc->sc_dev.dv_xname);
}
TAILQ_INIT(&sc->sc_free_ccb);
TAILQ_INIT(&sc->sc_waiting_ccb);
mtx_init(&sc->sc_ccb_mtx, IPL_BIO);
scsi_iopool_init(&sc->sc_iopool, sc, adv_ccb_alloc, adv_ccb_free);
error = adv_alloc_ccbs(sc);
if (error)
return;
i = adv_create_ccbs(sc, sc->sc_control->ccbs, ADV_MAX_CCB);
if (i == 0) {
printf("%s: unable to create control blocks\n",
sc->sc_dev.dv_xname);
return; ;
} else if (i != ADV_MAX_CCB) {
printf("%s: WARNING: only %d of %d control blocks created\n",
sc->sc_dev.dv_xname, i, ADV_MAX_CCB);
}
saa.saa_adapter_softc = sc;
saa.saa_adapter_target = sc->chip_scsi_id;
saa.saa_adapter = &adv_switch;
saa.saa_adapter_buswidth = 7;
saa.saa_luns = 8;
saa.saa_openings = 4;
saa.saa_pool = &sc->sc_iopool;
saa.saa_wwpn = saa.saa_wwnn = 0;
saa.saa_quirks = saa.saa_flags = 0;
config_found(&sc->sc_dev, &saa, scsiprint);
}
static void
adv_scsi_cmd(struct scsi_xfer *xs)
{
struct scsi_link *sc_link = xs->sc_link;
ASC_SOFTC *sc = sc_link->bus->sb_adapter_softc;
bus_dma_tag_t dmat = sc->sc_dmat;
ADV_CCB *ccb;
int flags, error, nsegs;
flags = xs->flags;
ccb = xs->io;
ccb->xs = xs;
ccb->timeout = xs->timeout;
memset(&ccb->scsiq, 0, sizeof(ASC_SCSI_Q));
ccb->scsiq.q2.ccb_ptr = (ulong) ccb;
ccb->scsiq.cdbptr = (u_int8_t *)&xs->cmd;
ccb->scsiq.q2.cdb_len = xs->cmdlen;
ccb->scsiq.q1.target_id = ASC_TID_TO_TARGET_ID(sc_link->target);
ccb->scsiq.q1.target_lun = sc_link->lun;
ccb->scsiq.q2.target_ix = ASC_TIDLUN_TO_IX(sc_link->target,
sc_link->lun);
ccb->scsiq.q1.sense_addr = sc->sc_dmamap_control->dm_segs[0].ds_addr +
ADV_CCB_OFF(ccb) + offsetof(struct adv_ccb, scsi_sense);
ccb->scsiq.q1.sense_len = sizeof(struct scsi_sense_data);
sc->reqcnt[sc_link->target]++;
if ((sc->reqcnt[sc_link->target] > 0) &&
(sc->reqcnt[sc_link->target] % 255) == 0) {
ccb->scsiq.q2.tag_code = M2_QTAG_MSG_ORDERED;
} else {
ccb->scsiq.q2.tag_code = M2_QTAG_MSG_SIMPLE;
}
if (xs->datalen) {
error = bus_dmamap_load(dmat,
ccb->dmamap_xfer, xs->data, xs->datalen, NULL,
(flags & SCSI_NOSLEEP) ? BUS_DMA_NOWAIT : BUS_DMA_WAITOK);
if (error) {
if (error == EFBIG) {
printf("%s: adv_scsi_cmd, more than %d dma"
" segments\n",
sc->sc_dev.dv_xname, ASC_MAX_SG_LIST);
} else {
printf("%s: adv_scsi_cmd, error %d loading"
" dma map\n",
sc->sc_dev.dv_xname, error);
}
xs->error = XS_DRIVER_STUFFUP;
scsi_done(xs);
return;
}
bus_dmamap_sync(dmat, ccb->dmamap_xfer,
0, ccb->dmamap_xfer->dm_mapsize,
((flags & SCSI_DATA_IN) ? BUS_DMASYNC_PREREAD :
BUS_DMASYNC_PREWRITE));
memset(&ccb->sghead, 0, sizeof(ASC_SG_HEAD));
for (nsegs = 0; nsegs < ccb->dmamap_xfer->dm_nsegs; nsegs++) {
ccb->sghead.sg_list[nsegs].addr =
ccb->dmamap_xfer->dm_segs[nsegs].ds_addr;
ccb->sghead.sg_list[nsegs].bytes =
ccb->dmamap_xfer->dm_segs[nsegs].ds_len;
}
ccb->sghead.entry_cnt = ccb->scsiq.q1.sg_queue_cnt =
ccb->dmamap_xfer->dm_nsegs;
ccb->scsiq.q1.cntl |= ASC_QC_SG_HEAD;
ccb->scsiq.sg_head = &ccb->sghead;
ccb->scsiq.q1.data_addr = 0;
ccb->scsiq.q1.data_cnt = 0;
} else {
ccb->scsiq.q1.data_addr = 0;
ccb->scsiq.q1.data_cnt = 0;
}
#ifdef ASC_DEBUG
printf("id = %d, lun = %d, cmd = %d, ccb = 0x%lX \n",
sc_link->target,
sc_link->lun, xs->cmd.opcode,
(unsigned long)ccb);
#endif
if ((flags & SCSI_POLL) == 0)
return;
if (adv_poll(sc, xs, ccb->timeout)) {
adv_timeout(ccb);
if (adv_poll(sc, xs, ccb->timeout))
adv_timeout(ccb);
}
}
int
adv_intr(void *arg)
{
ASC_SOFTC *sc = arg;
#ifdef ASC_DEBUG
int int_pend = FALSE;
if(ASC_IS_INT_PENDING(sc->sc_iot, sc->sc_ioh))
{
int_pend = TRUE;
printf("ISR - ");
}
#endif
AscISR(sc);
#ifdef ASC_DEBUG
if(int_pend)
printf("\n");
#endif
return (1);
}
static int
adv_poll(ASC_SOFTC *sc, struct scsi_xfer *xs, int count)
{
int s;
while (count) {
s = splbio();
adv_intr(sc);
splx(s);
if (xs->flags & ITSDONE)
return (0);
delay(1000);
count--;
}
return (1);
}
static void
adv_timeout(void *arg)
{
ADV_CCB *ccb = arg;
struct scsi_xfer *xs = ccb->xs;
struct scsi_link *sc_link = xs->sc_link;
ASC_SOFTC *sc = sc_link->bus->sb_adapter_softc;
int s;
sc_print_addr(sc_link);
printf("timed out");
s = splbio();
if (ccb->flags & CCB_ABORT) {
printf(" AGAIN. Resetting Bus\n");
if (AscResetBus(sc) == ASC_ERROR) {
ccb->timeout = sc->scsi_reset_wait;
adv_queue_ccb(sc, ccb);
}
} else {
printf("\n");
AscAbortCCB(sc, (u_int32_t) ccb);
ccb->xs->error = XS_TIMEOUT;
ccb->timeout = ADV_ABORT_TIMEOUT;
ccb->flags |= CCB_ABORT;
adv_queue_ccb(sc, ccb);
}
splx(s);
}
static void
adv_watchdog(void *arg)
{
ADV_CCB *ccb = arg;
struct scsi_xfer *xs = ccb->xs;
struct scsi_link *sc_link = xs->sc_link;
ASC_SOFTC *sc = sc_link->bus->sb_adapter_softc;
int s;
s = splbio();
ccb->flags &= ~CCB_WATCHDOG;
adv_start_ccbs(sc);
splx(s);
}
static void
adv_narrow_isr_callback(ASC_SOFTC *sc, ASC_QDONE_INFO *qdonep)
{
bus_dma_tag_t dmat = sc->sc_dmat;
ADV_CCB *ccb = (ADV_CCB *) qdonep->d2.ccb_ptr;
struct scsi_xfer *xs = ccb->xs;
struct scsi_sense_data *s1, *s2;
#ifdef ASC_DEBUG
printf(" - ccb=0x%lx, id=%d, lun=%d, cmd=%d, ",
(unsigned long)ccb,
xs->sc_link->target,
xs->sc_link->lun, xs->cmd.opcode);
#endif
timeout_del(&xs->stimeout);
if (xs->datalen) {
bus_dmamap_sync(dmat, ccb->dmamap_xfer,
0, ccb->dmamap_xfer->dm_mapsize,
((xs->flags & SCSI_DATA_IN) ? BUS_DMASYNC_POSTREAD :
BUS_DMASYNC_POSTWRITE));
bus_dmamap_unload(dmat, ccb->dmamap_xfer);
}
if ((ccb->flags & CCB_ALLOC) == 0) {
panic("%s: exiting ccb not allocated!", sc->sc_dev.dv_xname);
return;
}
#ifdef ASC_DEBUG
printf("d_s=%d, h_s=%d", qdonep->d3.done_stat, qdonep->d3.host_stat);
#endif
switch (qdonep->d3.done_stat) {
case ASC_QD_NO_ERROR:
switch (qdonep->d3.host_stat) {
case ASC_QHSTA_NO_ERROR:
xs->error = XS_NOERROR;
xs->resid = 0;
break;
default:
xs->error = XS_DRIVER_STUFFUP;
break;
}
if ((xs->cmd.opcode == SCSICMD_Inquiry) &&
(xs->sc_link->lun == 0) &&
(xs->datalen - qdonep->remain_bytes) >= 8) {
AscInquiryHandling(sc,
xs->sc_link->target & 0x7,
(ASC_SCSI_INQUIRY *) xs->data);
}
break;
case ASC_QD_WITH_ERROR:
switch (qdonep->d3.host_stat) {
case ASC_QHSTA_NO_ERROR:
if (qdonep->d3.scsi_stat == SS_CHK_CONDITION) {
s1 = &ccb->scsi_sense;
s2 = &xs->sense;
*s2 = *s1;
xs->error = XS_SENSE;
} else {
xs->error = XS_DRIVER_STUFFUP;
}
break;
default:
xs->error = XS_DRIVER_STUFFUP;
break;
}
break;
case ASC_QD_ABORTED_BY_HOST:
default:
xs->error = XS_DRIVER_STUFFUP;
break;
}
scsi_done(xs);
}