#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: sw.c,v 1.26 2023/01/23 22:16:44 andvar Exp $");
#include "opt_ddb.h"
#include <sys/types.h>
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/kmem.h>
#include <sys/errno.h>
#include <sys/device.h>
#include <sys/buf.h>
#include <sys/bus.h>
#include <machine/intr.h>
#include <machine/autoconf.h>
#include <dev/scsipi/scsi_all.h>
#include <dev/scsipi/scsipi_all.h>
#include <dev/scsipi/scsipi_debug.h>
#include <dev/scsipi/scsiconf.h>
#ifndef DDB
#define Debugger()
#endif
#ifndef DEBUG
#define DEBUG XXX
#endif
#define COUNT_SW_LEFTOVERS XXX
#include <dev/ic/ncr5380reg.h>
#include <dev/ic/ncr5380var.h>
#include <sparc/dev/swreg.h>
#define MIN_DMA_LEN 128
#define MAX_DMA_LEN 0xE000
#ifdef DEBUG
int sw_debug = 0;
#endif
struct sw_dma_handle {
int dh_flags;
#define SIDH_BUSY 0x01
#define SIDH_OUT 0x02
u_char *dh_addr;
int dh_maplen;
long dh_startingpa;
bus_dmamap_t dh_dmamap;
#define dh_dvma dh_dmamap->dm_segs[0].ds_addr
};
struct sw_softc {
struct ncr5380_softc ncr_sc;
bus_space_tag_t sc_bustag;
bus_dma_tag_t sc_dmatag;
struct sw_dma_handle *sc_dma;
int sc_xlen;
int sc_options;
};
#define SW_ENABLE_DMA 0x01
#define SW_DMA_INTR 0x02
#define SW_DO_RESELECT 0x04
#define SW_OPTIONS_MASK (SW_ENABLE_DMA|SW_DMA_INTR|SW_DO_RESELECT)
#define SW_OPTIONS_BITS "\10\3RESELECT\2DMA_INTR\1DMA"
int sw_options = SW_ENABLE_DMA;
static int sw_match(device_t, cfdata_t, void *);
static void sw_attach(device_t, device_t, void *);
static int sw_intr(void *);
static void sw_reset_adapter(struct ncr5380_softc *);
static void sw_minphys(struct buf *);
void sw_dma_alloc(struct ncr5380_softc *);
void sw_dma_free(struct ncr5380_softc *);
void sw_dma_poll(struct ncr5380_softc *);
void sw_dma_setup(struct ncr5380_softc *);
void sw_dma_start(struct ncr5380_softc *);
void sw_dma_eop(struct ncr5380_softc *);
void sw_dma_stop(struct ncr5380_softc *);
void sw_intr_on(struct ncr5380_softc *);
void sw_intr_off(struct ncr5380_softc *);
#define SWREG_READ(sc, index) \
bus_space_read_4((sc)->sc_regt, (sc)->sc_regh, index)
#define SWREG_WRITE(sc, index, v) \
bus_space_write_4((sc)->sc_regt, (sc)->sc_regh, index, v)
CFATTACH_DECL_NEW(sw, sizeof(struct sw_softc),
sw_match, sw_attach, NULL, NULL);
static int
sw_match(device_t parent, cfdata_t cf, void *aux)
{
union obio_attach_args *uoba = aux;
struct obio4_attach_args *oba;
if (cpuinfo.cpu_type != CPUTYP_4_100)
return (0);
if (uoba->uoba_isobio4 == 0)
return (0);
oba = &uoba->uoba_oba4;
return (bus_space_probe(oba->oba_bustag, oba->oba_paddr,
1,
1,
0,
NULL, NULL));
}
static void
sw_attach(device_t parent, device_t self, void *aux)
{
struct sw_softc *sc = device_private(self);
struct ncr5380_softc *ncr_sc = &sc->ncr_sc;
union obio_attach_args *uoba = aux;
struct obio4_attach_args *oba = &uoba->uoba_oba4;
bus_space_handle_t bh;
char bits[64];
int i;
ncr_sc->sc_dev = self;
sc->sc_dmatag = oba->oba_dmatag;
if (bus_space_map(oba->oba_bustag, oba->oba_paddr,
SWREG_BANK_SZ,
BUS_SPACE_MAP_LINEAR,
&bh) != 0) {
aprint_error(": cannot map registers\n");
return;
}
ncr_sc->sc_regt = oba->oba_bustag;
ncr_sc->sc_regh = bh;
sc->sc_options = sw_options;
ncr_sc->sc_dma_setup = sw_dma_setup;
ncr_sc->sc_dma_start = sw_dma_start;
ncr_sc->sc_dma_eop = sw_dma_stop;
ncr_sc->sc_dma_stop = sw_dma_stop;
ncr_sc->sc_intr_on = sw_intr_on;
ncr_sc->sc_intr_off = sw_intr_off;
if (oba->oba_pri == -1)
oba->oba_pri = 3;
(void)bus_intr_establish(oba->oba_bustag, oba->oba_pri, IPL_BIO,
sw_intr, sc);
aprint_normal(" pri %d\n", oba->oba_pri);
if ((device_cfdata(self)->cf_flags & SW_OPTIONS_MASK) != 0)
sc->sc_options =
device_cfdata(self)->cf_flags & SW_OPTIONS_MASK;
ncr_sc->sci_r0 = 0;
ncr_sc->sci_r1 = 1;
ncr_sc->sci_r2 = 2;
ncr_sc->sci_r3 = 3;
ncr_sc->sci_r4 = 4;
ncr_sc->sci_r5 = 5;
ncr_sc->sci_r6 = 6;
ncr_sc->sci_r7 = 7;
ncr_sc->sc_rev = NCR_VARIANT_NCR5380;
ncr_sc->sc_pio_out = ncr5380_pio_out;
ncr_sc->sc_pio_in = ncr5380_pio_in;
ncr_sc->sc_dma_alloc = sw_dma_alloc;
ncr_sc->sc_dma_free = sw_dma_free;
ncr_sc->sc_dma_poll = sw_dma_poll;
ncr_sc->sc_flags = 0;
if ((sc->sc_options & SW_DO_RESELECT) == 0)
ncr_sc->sc_no_disconnect = 0xFF;
if ((sc->sc_options & SW_DMA_INTR) == 0)
ncr_sc->sc_flags |= NCR5380_FORCE_POLLING;
ncr_sc->sc_min_dma_len = MIN_DMA_LEN;
i = SCI_OPENINGS * sizeof(struct sw_dma_handle);
sc->sc_dma = kmem_alloc(i, KM_SLEEP);
for (i = 0; i < SCI_OPENINGS; i++) {
sc->sc_dma[i].dh_flags = 0;
if (bus_dmamap_create(
sc->sc_dmatag,
MAXPHYS,
1,
MAXPHYS,
0,
BUS_DMA_NOWAIT,
&sc->sc_dma[i].dh_dmamap) != 0) {
aprint_error_dev(self, "DMA buffer map create error\n");
return;
}
}
if (sc->sc_options) {
snprintb(bits, sizeof(bits),
SW_OPTIONS_BITS, sc->sc_options);
aprint_normal_dev(self, "options=%s\n", bits);
}
ncr_sc->sc_channel.chan_id = 7;
ncr_sc->sc_adapter.adapt_minphys = sw_minphys;
sw_reset_adapter(ncr_sc);
ncr5380_attach(ncr_sc);
}
static void
sw_minphys(struct buf *bp)
{
if (bp->b_bcount > MAX_DMA_LEN) {
#ifdef DEBUG
if (sw_debug) {
printf("sw_minphys len = 0x%x.\n", MAX_DMA_LEN);
Debugger();
}
#endif
bp->b_bcount = MAX_DMA_LEN;
}
minphys(bp);
}
#define CSR_WANT (SW_CSR_SBC_IP | SW_CSR_DMA_IP | \
SW_CSR_DMA_CONFLICT | SW_CSR_DMA_BUS_ERR )
static int
sw_intr(void *arg)
{
struct sw_softc *sc = arg;
struct ncr5380_softc *ncr_sc = &sc->ncr_sc;
int dma_error, claimed;
u_short csr;
claimed = 0;
dma_error = 0;
csr = SWREG_READ(ncr_sc, SWREG_CSR);
NCR_TRACE("sw_intr: csr=0x%x\n", csr);
if (csr & SW_CSR_DMA_CONFLICT) {
dma_error |= SW_CSR_DMA_CONFLICT;
printf("%s: DMA conflict\n", __func__);
}
if (csr & SW_CSR_DMA_BUS_ERR) {
dma_error |= SW_CSR_DMA_BUS_ERR;
printf("%s: DMA bus error\n", __func__);
}
if (dma_error) {
if (sc->ncr_sc.sc_state & NCR_DOINGDMA)
sc->ncr_sc.sc_state |= NCR_ABORTING;
csr |= SW_CSR_DMA_IP;
}
if (csr & (SW_CSR_SBC_IP | SW_CSR_DMA_IP)) {
claimed = ncr5380_intr(&sc->ncr_sc);
#ifdef DEBUG
if (!claimed) {
printf("%s: spurious from SBC\n", __func__);
if (sw_debug & 4) {
Debugger();
}
}
#endif
}
return claimed;
}
static void
sw_reset_adapter(struct ncr5380_softc *ncr_sc)
{
#ifdef DEBUG
if (sw_debug) {
printf("%s\n", __func__);
}
#endif
SWREG_WRITE(ncr_sc, SWREG_CSR, 0);
delay(10);
SWREG_WRITE(ncr_sc, SWREG_CSR, SW_CSR_SCSI_RES);
SWREG_WRITE(ncr_sc, SWREG_DMA_ADDR, 0);
SWREG_WRITE(ncr_sc, SWREG_DMA_CNT, 0);
delay(10);
SWREG_WRITE(ncr_sc, SWREG_CSR, SW_CSR_SCSI_RES | SW_CSR_INTR_EN);
SCI_CLR_INTR(ncr_sc);
}
void
sw_dma_alloc(struct ncr5380_softc *ncr_sc)
{
struct sw_softc *sc = (struct sw_softc *)ncr_sc;
struct sci_req *sr = ncr_sc->sc_current;
struct scsipi_xfer *xs = sr->sr_xs;
struct sw_dma_handle *dh;
int i, xlen;
u_long addr;
#ifdef DIAGNOSTIC
if (sr->sr_dma_hand != NULL)
panic("%s: already have DMA handle", __func__);
#endif
#if 1
if ((sc->sc_options & SW_ENABLE_DMA) == 0)
return;
#endif
addr = (u_long)ncr_sc->sc_dataptr;
xlen = ncr_sc->sc_datalen;
if ((addr & 1) || (xlen & 1)) {
printf("%s: misaligned.\n", __func__);
return;
}
if (xlen < MIN_DMA_LEN)
panic("%s: xlen=0x%x", __func__, xlen);
for (i = 0; i < SCI_OPENINGS; i++) {
if ((sc->sc_dma[i].dh_flags & SIDH_BUSY) == 0)
goto found;
}
panic("sw: no free DMA handles.");
found:
dh = &sc->sc_dma[i];
dh->dh_flags = SIDH_BUSY;
dh->dh_addr = (u_char *)addr;
dh->dh_maplen = xlen;
if ((xs->xs_control & XS_CTL_DATA_OUT) != 0)
dh->dh_flags |= SIDH_OUT;
if (bus_dmamap_load(sc->sc_dmatag, dh->dh_dmamap,
(void *)addr, xlen, NULL, BUS_DMA_NOWAIT) != 0) {
printf("%s: can't remap 0x%lx/0x%x, doing PIO\n",
__func__, addr, dh->dh_maplen);
dh->dh_flags = 0;
return;
}
bus_dmamap_sync(sc->sc_dmatag, dh->dh_dmamap, addr, xlen,
(dh->dh_flags & SIDH_OUT)
? BUS_DMASYNC_PREWRITE
: BUS_DMASYNC_PREREAD);
sr->sr_dma_hand = dh;
}
void
sw_dma_free(struct ncr5380_softc *ncr_sc)
{
struct sw_softc *sc = (struct sw_softc *)ncr_sc;
struct sci_req *sr = ncr_sc->sc_current;
struct sw_dma_handle *dh = sr->sr_dma_hand;
#ifdef DIAGNOSTIC
if (dh == NULL)
panic("%s: no DMA handle", __func__);
#endif
if (ncr_sc->sc_state & NCR_DOINGDMA)
panic("%s: free while in progress", __func__);
if (dh->dh_flags & SIDH_BUSY) {
bus_dmamap_sync(sc->sc_dmatag, dh->dh_dmamap,
dh->dh_dvma, dh->dh_maplen,
(dh->dh_flags & SIDH_OUT)
? BUS_DMASYNC_POSTWRITE
: BUS_DMASYNC_POSTREAD);
bus_dmamap_unload(sc->sc_dmatag, dh->dh_dmamap);
dh->dh_flags = 0;
}
sr->sr_dma_hand = NULL;
}
void
sw_dma_poll(struct ncr5380_softc *ncr_sc)
{
struct sci_req *sr = ncr_sc->sc_current;
int tmo, csr_mask, csr;
if (ncr_sc->sc_state & NCR_ABORTING)
return;
csr_mask = SW_CSR_SBC_IP | SW_CSR_DMA_IP |
SW_CSR_DMA_CONFLICT | SW_CSR_DMA_BUS_ERR;
tmo = 50000;
for (;;) {
csr = SWREG_READ(ncr_sc, SWREG_CSR);
if (csr & csr_mask)
break;
if (--tmo <= 0) {
printf("%s: DMA timeout (while polling)\n",
device_xname(ncr_sc->sc_dev));
sr->sr_flags |= SR_OVERDUE;
break;
}
delay(100);
}
#ifdef DEBUG
if (sw_debug) {
printf("%s: done, csr=0x%x\n", __func__, csr);
}
#endif
}
void
sw_intr_on(struct ncr5380_softc *ncr_sc)
{
uint32_t csr;
sw_dma_setup(ncr_sc);
csr = SWREG_READ(ncr_sc, SWREG_CSR);
csr |= SW_CSR_DMA_EN;
SWREG_WRITE(ncr_sc, SWREG_CSR, csr);
}
void
sw_intr_off(struct ncr5380_softc *ncr_sc)
{
uint32_t csr;
csr = SWREG_READ(ncr_sc, SWREG_CSR);
csr &= ~SW_CSR_DMA_EN;
SWREG_WRITE(ncr_sc, SWREG_CSR, csr);
}
void
sw_dma_setup(struct ncr5380_softc *ncr_sc)
{
uint32_t csr;
csr = SWREG_READ(ncr_sc, SWREG_CSR);
csr &= ~SW_CSR_SEND;
SWREG_WRITE(ncr_sc, SWREG_CSR, csr);
SWREG_WRITE(ncr_sc, SWREG_DMA_ADDR, 0);
SWREG_WRITE(ncr_sc, SWREG_DMA_CNT, 0);
}
void
sw_dma_start(struct ncr5380_softc *ncr_sc)
{
struct sw_softc *sc = (struct sw_softc *)ncr_sc;
struct sci_req *sr = ncr_sc->sc_current;
struct sw_dma_handle *dh = sr->sr_dma_hand;
u_long dva;
int xlen, adj, adjlen;
u_int mode;
uint32_t csr;
dva = (u_long)(dh->dh_dvma);
if (dva & 1)
panic("%s: bad dva=0x%lx", __func__, dva);
xlen = ncr_sc->sc_datalen;
xlen &= ~1;
sc->sc_xlen = xlen;
#ifdef DEBUG
if (sw_debug & 2) {
printf("%s: dh=%p, dva=0x%lx, xlen=%d\n",
__func__, dh, dva, xlen);
}
#endif
csr = SWREG_READ(ncr_sc, SWREG_CSR);
if (dh->dh_flags & SIDH_OUT) {
csr |= SW_CSR_SEND;
} else {
csr &= ~SW_CSR_SEND;
}
SWREG_WRITE(ncr_sc, SWREG_CSR, csr);
adj = 0;
if (dva & 2) {
adj = 2;
#ifdef DEBUG
if (sw_debug & 2)
printf("%s: adjusted up %d bytes\n", __func__, adj);
#endif
}
dh->dh_startingpa = (dva | 0xF00000);
SWREG_WRITE(ncr_sc, SWREG_DMA_ADDR, (u_int)(dh->dh_startingpa + adj));
SWREG_WRITE(ncr_sc, SWREG_DMA_CNT, xlen - adj);
if (dh->dh_flags & SIDH_OUT) {
NCR5380_WRITE(ncr_sc, sci_tcmd, PHASE_DATA_OUT);
if (adj) {
adjlen = ncr5380_pio_out(ncr_sc, PHASE_DATA_OUT,
adj, dh->dh_addr);
if (adjlen != adj)
printf("%s: bad outgoing adj, %d != %d\n",
device_xname(ncr_sc->sc_dev), adjlen, adj);
}
SCI_CLR_INTR(ncr_sc);
NCR5380_WRITE(ncr_sc, sci_icmd, SCI_ICMD_DATA);
mode = NCR5380_READ(ncr_sc, sci_mode);
mode |= (SCI_MODE_DMA | SCI_MODE_DMA_IE);
NCR5380_WRITE(ncr_sc, sci_mode, mode);
NCR5380_WRITE(ncr_sc, sci_dma_send, 0);
} else {
NCR5380_WRITE(ncr_sc, sci_tcmd, PHASE_DATA_IN);
if (adj) {
adjlen = ncr5380_pio_in(ncr_sc, PHASE_DATA_IN,
adj, dh->dh_addr);
if (adjlen != adj)
printf("%s: bad incoming adj, %d != %d\n",
device_xname(ncr_sc->sc_dev), adjlen, adj);
}
SCI_CLR_INTR(ncr_sc);
NCR5380_WRITE(ncr_sc, sci_icmd, 0);
mode = NCR5380_READ(ncr_sc, sci_mode);
mode |= (SCI_MODE_DMA | SCI_MODE_DMA_IE);
NCR5380_WRITE(ncr_sc, sci_mode, mode);
NCR5380_WRITE(ncr_sc, sci_irecv, 0);
}
csr |= SW_CSR_DMA_EN;
SWREG_WRITE(ncr_sc, SWREG_CSR, csr);
ncr_sc->sc_state |= NCR_DOINGDMA;
#ifdef DEBUG
if (sw_debug & 2) {
printf("%s: started, flags=0x%x\n",
__func__, ncr_sc->sc_state);
}
#endif
}
void
sw_dma_eop(struct ncr5380_softc *ncr_sc)
{
}
#if (defined(DEBUG) || defined(DIAGNOSTIC)) && !defined(COUNT_SW_LEFTOVERS)
#define COUNT_SW_LEFTOVERS
#endif
#ifdef COUNT_SW_LEFTOVERS
int sw_3_leftover = 0;
int sw_2_leftover = 0;
int sw_1_leftover = 0;
int sw_0_leftover = 0;
#endif
void
sw_dma_stop(struct ncr5380_softc *ncr_sc)
{
struct sci_req *sr = ncr_sc->sc_current;
struct sw_dma_handle *dh = sr->sr_dma_hand;
int ntrans = 0, dva;
u_int mode;
uint32_t csr;
if ((ncr_sc->sc_state & NCR_DOINGDMA) == 0) {
#ifdef DEBUG
printf("%s: DMA not running\n", __func__);
#endif
return;
}
ncr_sc->sc_state &= ~NCR_DOINGDMA;
csr = SWREG_READ(ncr_sc, SWREG_CSR);
csr &= ~SW_CSR_DMA_EN;
SWREG_WRITE(ncr_sc, SWREG_CSR, csr);
#if 0
if (csr & (SW_CSR_DMA_CONFLICT | SW_CSR_DMA_BUS_ERR))
#else
if (csr & (SW_CSR_DMA_CONFLICT))
#endif
{
printf("sw: DMA error, csr=0x%x, reset\n", csr);
sr->sr_xs->error = XS_DRIVER_STUFFUP;
ncr_sc->sc_state |= NCR_ABORTING;
sw_reset_adapter(ncr_sc);
}
if (ncr_sc->sc_state & NCR_ABORTING)
goto out;
dva = SWREG_READ(ncr_sc, SWREG_DMA_ADDR);
ntrans = (dva - dh->dh_startingpa);
#ifdef DEBUG
if (sw_debug & 2) {
printf("%s: ntrans=0x%x\n", __func__, ntrans);
}
#endif
if (ntrans > ncr_sc->sc_datalen)
panic("%s: excess transfer", __func__);
ncr_sc->sc_dataptr += ntrans;
ncr_sc->sc_datalen -= ntrans;
if ((dh->dh_flags & SIDH_OUT) == 0) {
char *cp = ncr_sc->sc_dataptr;
uint32_t bpr;
bpr = SWREG_READ(ncr_sc, SWREG_BPR);
switch (dva & 3) {
case 3:
cp[0] = (bpr & 0xff000000) >> 24;
cp[1] = (bpr & 0x00ff0000) >> 16;
cp[2] = (bpr & 0x0000ff00) >> 8;
#ifdef COUNT_SW_LEFTOVERS
++sw_3_leftover;
#endif
break;
case 2:
cp[0] = (bpr & 0xff000000) >> 24;
cp[1] = (bpr & 0x00ff0000) >> 16;
#ifdef COUNT_SW_LEFTOVERS
++sw_2_leftover;
#endif
break;
case 1:
cp[0] = (bpr & 0xff000000) >> 24;
#ifdef COUNT_SW_LEFTOVERS
++sw_1_leftover;
#endif
break;
#ifdef COUNT_SW_LEFTOVERS
default:
++sw_0_leftover;
break;
#endif
}
}
out:
SWREG_WRITE(ncr_sc, SWREG_DMA_ADDR, 0);
SWREG_WRITE(ncr_sc, SWREG_DMA_CNT, 0);
mode = NCR5380_READ(ncr_sc, sci_mode);
mode &= ~(SCI_MODE_DMA | SCI_MODE_DMA_IE);
NCR5380_WRITE(ncr_sc, sci_mode, mode);
NCR5380_WRITE(ncr_sc, sci_icmd, 0);
#ifdef DEBUG
if (sw_debug & 2) {
printf("%s: ntrans=0x%x\n", __func__, ntrans);
}
#endif
}