NetBSD/sys/arch/pc532/dev/dp.c

1045 lines
26 KiB
C
Raw Normal View History

1994-10-26 11:23:50 +03:00
/* $NetBSD: dp.c,v 1.6 1994/10/26 08:24:10 cgd Exp $ */
1993-09-10 03:53:45 +04:00
/* Written by Phil Nelson for the pc532. Used source with the following
* copyrights as a model.
*
* dp.c: A NCR DP8490 driver for the pc532.
1993-09-10 03:53:45 +04:00
*/
1993-09-10 03:53:45 +04:00
/*
* (Mostly) Written by Julian Elischer (julian@tfs.com)
* for TRW Financial Systems for use under the MACH(2.5) operating system.
*
* TRW Financial Systems, in accordance with their agreement with Carnegie
* Mellon University, makes this software available to CMU to distribute
* or use in any manner that they see fit as long as this message is kept with
* the software. For this reason TFS also grants any other persons or
* organisations permission to use or modify this software.
*
* TFS supplies this software to be publicly redistributed
* on the understanding that TFS is not responsible for the correct
* functioning of this software in any circumstances.
*
*/
/*
* a FEW lines in this driver come from a MACH adaptec-disk driver
* so the copyright below is included:
*
* Copyright 1990 by Open Software Foundation,
* Grenoble, FRANCE
*
* All Rights Reserved
*
* Permission to use, copy, modify, and distribute this software and
* its documentation for any purpose and without fee is hereby granted,
* provided that the above copyright notice appears in all copies and
* that both the copyright notice and this permission notice appear in
* supporting documentation, and that the name of OSF or Open Software
* Foundation not be used in advertising or publicity pertaining to
* distribution of the software without specific, written prior
* permission.
*
* OSF DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE
* INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS,
* IN NO EVENT SHALL OSF BE LIABLE FOR ANY SPECIAL, INDIRECT, OR
* CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM
* LOSS OF USE, DATA OR PROFITS, WHETHER IN ACTION OF CONTRACT,
* NEGLIGENCE, OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION
* WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
*/
#include <sys/types.h>
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/errno.h>
#include <sys/ioctl.h>
#include <sys/buf.h>
#include <machine/stdarg.h>
#include <sys/proc.h>
#include <sys/user.h>
#include <sys/dkbad.h>
#include <sys/disklabel.h>
#include <scsi/scsi_all.h>
#include <scsi/scsiconf.h>
#include <machine/frame.h>
#include <machine/icu.h>
1993-09-10 03:53:45 +04:00
#include "device.h"
#include "dpreg.h"
#define DP_DEBUG 0
1993-09-10 03:53:45 +04:00
/* Some constants (may need to be changed!) */
#define DP_NSEG 16
int dpprobe(struct pc532_device *);
int dpattach(struct pc532_device *);
int dp_scsi_cmd(struct scsi_xfer *);
void dpminphys(struct buf *);
long int dp_adapter_info(int);
void dp_intr(void);
void dp_intr_work(void);
1993-09-10 03:53:45 +04:00
struct scsidevs *
scsi_probe(int masunit, struct scsi_switch *sw, int physid, int type, int want);
struct pc532_driver dpdriver = {
dpprobe, dpattach, "dp",
};
struct scsi_switch dp_switch = {
"dp",
dp_scsi_cmd,
dpminphys,
0,
0,
dp_adapter_info,
0, 0, 0
};
/* Sense command. */
static u_char sense_cmd[] = { 3, 0, 0, 0, 0, 0};
1993-09-10 03:53:45 +04:00
/* Do we need to initialize. */
int dp_needs_init = 1;
/* Do we need a reset . */
int dp_needs_reset = 1;
/* SCSI phase we are currently in . . . */
int dp_scsi_phase;
/* SCSI Driver state */
int dp_dvr_state = DP_DVR_READY;
/* For polled error reporting. */
int dp_intr_retval;
/* For counting the retries. */
int dp_try_count;
/* Give the interrupt routine access to the current scsi_xfer info block. */
struct scsi_xfer *cur_xs = NULL;
1993-09-10 03:53:45 +04:00
/* names of phases for debug printouts */
const char *dp_phase_names[] = {
"DATA OUT",
"DATA IN",
"CMD",
"STATUS",
"PHASE 4",
"PHASE 5",
"MSG OUT",
"MSG IN",
};
1993-09-10 03:53:45 +04:00
/* Initial probe for a device. If it is using the dp controller,
just say yes so that attach can be the one to find the real drive. */
int dpprobe(struct pc532_device *dvp)
{
/* If we call this, we need to add SPL_DP to the bio mask! */
PL_bio |= SPL_DP;
PL_zero |= PL_bio;
if (dp_needs_init)
dp_initialize();
if (dp_needs_reset)
dp_reset();
/* All pc532s should have one, so we don't check ! :) */
return (1);
}
int dpattach(struct pc532_device *dvp)
{
int r;
r = scsi_attach(0, 7, &dp_switch,
&dvp->pd_drive, &dvp->pd_unit, dvp->pd_flags);
return(r);
}
void dpminphys(struct buf *bp)
{
if(bp->b_bcount > ((DP_NSEG - 1) * NBPG))
bp->b_bcount = ((DP_NSEG - 1) * NBPG);
}
long int dp_adapter_info(int unit)
{
return (1); /* only 1 outstanding request. */
}
#if DP_DEBUG
void
dp_print_stat1(u_char stat1)
{
printf("stat1=");
if ( stat1 & 0x80 ) printf(" /RST");
if ( stat1 & 0x40 ) printf(" /BSY");
if ( stat1 & 0x20 ) printf(" /REQ");
if ( stat1 & 0x10 ) printf(" /MSG");
if ( stat1 & 0x08 ) printf(" /CD");
if ( stat1 & 0x04 ) printf(" /IO");
if ( stat1 & 0x02 ) printf(" /SEL");
if ( stat1 & 0x01 ) printf(" /DBP");
printf("\n");
}
void
dp_print_stat2(u_char stat2)
{
printf("stat2=");
if ( stat2 & 0x80 ) printf(" EDMA");
if ( stat2 & 0x40 ) printf(" DRQ");
if ( stat2 & 0x20 ) printf(" SPER");
if ( stat2 & 0x10 ) printf(" INT");
if ( stat2 & 0x08 ) printf(" PHSM");
if ( stat2 & 0x04 ) printf(" BSY");
if ( stat2 & 0x02 ) printf(" /ATN");
if ( stat2 & 0x01 ) printf(" /ACK");
printf("\n");
}
#endif
#if DP_DEBUG
void
dp_print_regs()
{
u_char stat1 = RD_ADR(u_char, DP_STAT1);
u_char stat2 = RD_ADR(u_char, DP_STAT2);
dp_print_stat1(stat1);
dp_print_stat2(stat2);
}
#endif
1993-09-10 03:53:45 +04:00
/* Do a scsi command. */
int dp_scsi_cmd(struct scsi_xfer *xs)
{
struct iovec *iovp;
int flags;
int retval; /* Return values from functions. */
int x; /* for splbio() & splhigh() */
int dvr_state;
int ti_val; /* For timeouts. */
#if DP_DEBUG
printf("\n");
#endif
x = splhigh();
if (dp_dvr_state == DP_DVR_READY)
dp_dvr_state = DP_DVR_STARTED;
dvr_state = dp_dvr_state;
splx(x);
if (dvr_state != DP_DVR_STARTED)
return (TRY_AGAIN_LATER);
1993-09-10 03:53:45 +04:00
cur_xs = xs;
/* Some initial checks. */
flags = xs->flags;
if (!(flags & INUSE)) {
#if DP_DEBUG
1993-11-04 10:58:29 +03:00
printf("dp xs not in use!\n");
#endif
1993-09-10 03:53:45 +04:00
xs->flags |= INUSE;
}
if (flags & ITSDONE) {
#if DP_DEBUG
1993-11-04 10:58:29 +03:00
printf("dp xs already done!\n");
#endif
1993-09-10 03:53:45 +04:00
xs->flags &= ~ITSDONE;
}
if (dp_needs_reset || (xs->flags & SCSI_RESET))
1993-09-10 03:53:45 +04:00
dp_reset();
#if DP_DEBUG
printf ("scsi_cmd: flags=0x%x, targ=%d, lu=%d, cmdlen=%d, cmd=%x\n",
1993-11-04 10:58:29 +03:00
xs->flags, xs->targ, xs->lu, xs->cmdlen, xs->cmd->opcode);
#endif
#if 1
/* we don't always get NOMASK passed in, so this hack fakes it. */
{
if ( !initproc )
xs->flags |= SCSI_NOMASK;
}
#endif
if (!(xs->flags & SCSI_NOMASK)) {
x = splbio();
retval = dp_start_cmd(xs);
splx(x);
return retval;
}
/* No interrupts available! */
retval = dp_start_cmd(xs);
if (retval != SUCCESSFULLY_QUEUED)
return retval;
#if DP_DEBUG > 1
printf("polling for interrupts\n");
#endif
ti_val = WAIT_MUL * xs->timeout;
while (dp_dvr_state != DP_DVR_READY) {
if (RD_ADR(u_char, DP_STAT2) & DP_S_IRQ) {
dp_intr_work();
ti_val = WAIT_MUL * xs->timeout;
retval = dp_intr_retval;
}
if (--ti_val == 0) {
/* Software Timeout! */
xs->error = XS_SWTIMEOUT;
dp_dvr_state = DP_DVR_READY;
retval = HAD_ERROR;
}
}
if (xs->error == XS_SWTIMEOUT) {
/* Software Timeout! */
printf ("scsi timeout!\n");
#if DP_DEBUG
dp_print_regs();
printf("TCMD = 0x%x\n", RD_ADR(u_char, DP_TCMD));
#endif
dp_reset();
}
#if 1
/* another hack: read cannot handle anything but SUCCESSFULLY_QUEUED */
if (xs->cmd->opcode == 0x28)
return SUCCESSFULLY_QUEUED;
#endif
return retval;
1993-09-10 03:53:45 +04:00
}
/*===========================================================================*
* dp_intr *
*===========================================================================*/
/* This is where a lot of the work happens! This is called in non-interrupt
mode when an interrupt would have happened. It is also the real interrupt
routine. It uses dp_dvr_state to determine the next actions along with
cur_xs->flags. */
void dp_intr(void)
1993-09-10 03:53:45 +04:00
{
int x = splhigh();
#if DP_DEBUG
printf("\n REAL dp_intr\n");
#endif
dp_intr_work();
splx(x);
}
1993-09-10 03:53:45 +04:00
void dp_intr_work(void)
{
u_char isr;
u_char new_phase;
u_char stat1;
u_char stat2;
static u_char status;
static u_char message;
int ret;
scsi_select_ctlr (DP8490);
WR_ADR(u_char, DP_EMR_ISR, DP_EF_ISR_NEXT);
isr = RD_ADR (u_char, DP_EMR_ISR);
dp_clear_isr();
stat1 = RD_ADR(u_char, DP_STAT1);
new_phase = (stat1 >> 2) & 7;
#if DP_DEBUG
printf ("dp_intr: dvr_state %d isr=0x%x new_phase = %d %s\n",
dp_dvr_state, isr, new_phase, dp_phase_names[new_phase]);
#if DP_DEBUG > 1
dp_print_regs();
#endif
#endif
#if 0
/* de-assert the bus */
WR_ADR(u_char, DP_ICMD, DP_EMODE);
/* disable dma */
RD_ADR(u_char, DP_MODE) &= ~DP_M_DMA;
#endif
if (isr & DP_ISR_BSYERR) {
#if DP_DEBUG
printf("dp_intr: Busy error\n");
#endif
}
if (isr & DP_ISR_EDMA) {
#if DP_DEBUG > 1
printf("dp_intr: EDMA detected\n");
#endif
RD_ADR(u_char, DP_MODE) &= ~DP_M_DMA;
WR_ADR(u_char, DP_ICMD, DP_EMODE);
}
if (!(isr & DP_ISR_APHS)) {
#if DP_DEBUG > 1
printf("dp_intr: Not an APHS!\n");
printf("dp_intr: dvr_state %d isr=0x%x (exit)\n",
dp_dvr_state, isr);
#endif
return;
}
switch (dp_dvr_state) {
case DP_DVR_ARB: /* Next comes the command phase! */
if (new_phase != DP_PHASE_CMD) {
#if DP_DEBUG
1993-11-04 10:58:29 +03:00
printf ("Phase mismatch cmd!\n");
#endif
1993-11-04 10:58:29 +03:00
goto phase_mismatch;
}
dp_dvr_state = DP_DVR_CMD;
ret = dp_pdma_out(cur_xs->cmd, cur_xs->cmdlen, DP_PHASE_CMD);
dp_clear_isr();
break;
case DP_DVR_CMD: /* Next comes the data i/o phase if needed. */
1993-11-04 10:58:29 +03:00
/*
* This state can potentially accept data in, data out,
* or status for new_phase. data in or data out could
* be skipped (new_phase is status) if an error was detected
* in the command.
*/
if (cur_xs->flags & SCSI_DATA_UIO) {
/* UIO work. */
panic ("scsi uio");
1993-11-04 10:58:29 +03:00
}
if (new_phase == DP_PHASE_DATAI) {
#if 1
/* just a quick hack until we
can trust flags to be correct
*/
if (!cur_xs->data) {
#else
1993-11-04 10:58:29 +03:00
if (!(cur_xs->flags & SCSI_DATA_IN)) {
#endif
#if DP_DEBUG
printf("Phase mismatch in.\n");
#endif
1993-11-04 10:58:29 +03:00
goto phase_mismatch;
}
1993-11-04 10:58:29 +03:00
/* expect STAT phase next */
dp_dvr_state = DP_DVR_DATA;
ret = dp_pdma_in(cur_xs->data, cur_xs->datalen,
DP_PHASE_DATAI);
dp_clear_isr();
break;
1993-11-04 10:58:29 +03:00
}
else if (new_phase == DP_PHASE_DATAO) {
#if 1
/* just a quick hack until we
can trust flags to be correct
*/
if (!cur_xs->data) {
#else
1993-11-04 10:58:29 +03:00
if (!(cur_xs->flags & SCSI_DATA_OUT)) {
#endif
#if DP_DEBUG
printf("Phase mismatch out.\n");
#endif
1993-11-04 10:58:29 +03:00
goto phase_mismatch;
}
1993-11-04 10:58:29 +03:00
/* expect STAT phase next */
dp_dvr_state = DP_DVR_DATA;
ret = dp_pdma_out(cur_xs->data, cur_xs->datalen,
DP_PHASE_DATAO);
dp_clear_isr();
break;
}
/* Fall through to next phase. */
case DP_DVR_DATA: /* Next comes the stat phase */
if (new_phase != DP_PHASE_STATUS) {
#if DP_DEBUG
printf("Phase mismatch stat.\n");
#endif
1993-11-04 10:58:29 +03:00
goto phase_mismatch;
}
dp_dvr_state = DP_DVR_STAT;
dp_pdma_in(&status, 1, DP_PHASE_STATUS);
dp_clear_isr();
#if DP_DEBUG > 1
printf("status = 0x%x\n", status);
#endif
break;
case DP_DVR_STAT:
if (new_phase != DP_PHASE_MSGI) {
#if DP_DEBUG
printf ("msgi phase mismatch\n");
#endif
goto phase_mismatch;
}
dp_dvr_state = DP_DVR_MSGI;
dp_pdma_in(&message, 1, DP_PHASE_MSGI);
dp_clear_isr();
#if DP_DEBUG > 1
printf("message = 0x%x\n", message);
#endif
#if 0
if (status != SCSI_OK && dp_try_count < cur_xs->retries) {
printf("dp_intr: retry: dp_try_count = %d\n",
dp_try_count);
dp_restart_cmd();
}
#endif
break;
default:
1993-11-04 10:58:29 +03:00
phase_mismatch:
/* TEMP error generation!!! */
dp_reset();
dp_dvr_state = DP_DVR_READY;
cur_xs->error = XS_DRIVER_STUFFUP;
dp_intr_retval = HAD_ERROR;
/* If this true interrupt code, call the done routine. */
if (cur_xs->when_done) {
(*(cur_xs->when_done))(cur_xs->done_arg, cur_xs->done_arg2);
}
}
if (dp_dvr_state == DP_DVR_MSGI) {
#if DP_DEBUG > 1
printf ("dvr_stat: dp_try_count = %d\n", dp_try_count);
#endif
WR_ADR (u_char, DP_MODE, 0); /* Turn off monbsy, dma, ... */
if (status == SCSI_OK) {
cur_xs->error = XS_NOERROR;
dp_intr_retval = COMPLETE;
} else if (status & SCSI_BUSY) {
cur_xs->error = XS_BUSY;
dp_intr_retval = HAD_ERROR;
} else if (status & SCSI_CHECK) {
/* Do a sense command. */
cur_xs->error = XS_SENSE;
dp_intr_retval = HAD_ERROR;
dp_get_sense (cur_xs);
}
cur_xs->flags |= ITSDONE;
dp_dvr_state = DP_DVR_READY;
#if DP_DEBUG > 1
printf("calling wakeup on 0x%x\n", cur_xs);
#endif
wakeup((caddr_t) cur_xs);
/* If this true interrupt code, call the done routine. */
if (cur_xs->when_done) {
#if DP_DEBUG > 1
printf("dp_intr: calling when_done 0x%x\n", cur_xs->when_done);
#endif
(*(cur_xs->when_done))(cur_xs->done_arg, cur_xs->done_arg2);
}
}
#if DP_DEBUG > 1
printf ("exit dp_intr.\n");
#endif
1993-09-10 03:53:45 +04:00
}
/*===========================================================================*
* dp_initialize *
*===========================================================================*/
dp_initialize()
{
#if DP_DEBUG
printf("dp_initialize()\n");
#endif
1993-09-10 03:53:45 +04:00
scsi_select_ctlr (DP8490);
WR_ADR (u_char, DP_ICMD, DP_EMODE); /* Set Enhanced mode */
WR_ADR (u_char, DP_MODE, 0); /* Disable everything. */
WR_ADR (u_char, DP_EMR_ISR, DP_EF_RESETIP);
1993-09-10 03:53:45 +04:00
WR_ADR (u_char, DP_EMR_ISR, DP_EF_NOP);
1993-11-04 10:58:29 +03:00
WR_ADR (u_char, DP_SER, 0x80); /* scsi adr 7. */
dp_scsi_phase = DP_PHASE_NONE;
dp_needs_init = 0;
1993-09-10 03:53:45 +04:00
}
/*===========================================================================*
* dp_reset *
*===========================================================================*/
/*
* Reset dp SCSI bus.
*/
dp_reset()
{
volatile int i;
int x = splbio();
scsi_select_ctlr (DP8490);
WR_ADR (u_char, DP_MODE, 0); /* get into harmless state */
WR_ADR (u_char, DP_OUTDATA, 0);
WR_ADR (u_char, DP_ICMD, DP_A_RST|DP_EMODE); /* assert RST on SCSI bus */
for (i = 55; i; --i); /* wait 25 usec */
WR_ADR (u_char, DP_ICMD, DP_EMODE); /* deassert RST, get off bus */
WR_ADR (u_char, DP_EMR_ISR, DP_EF_ISR_NEXT | DP_EMR_APHS);
WR_ADR (u_char, DP_EMR_ISR, DP_INT_MASK); /* set interrupt mask */
splx(x);
for (i = 800000; i; --i); /* wait 360 msec */
dp_needs_reset = 0;
}
/*===========================================================================*
* dp_wait_bus_free *
*===========================================================================*/
/* Wait for the SCSI bus to become free. Currently polled because I am
* assuming a single initiator configuration -- so this code would not be
* running if the bus were busy.
*/
int
dp_wait_bus_free()
{
int i;
1993-11-04 10:58:29 +03:00
u_char stat1;
1993-09-10 03:53:45 +04:00
volatile int j;
1993-11-04 10:58:29 +03:00
/* get into a harmless state */
WR_ADR (u_char, DP_TCMD, 0);
WR_ADR (u_char, DP_MODE, 0); /* return to initiator mode */
WR_ADR (u_char, DP_ICMD, DP_EMODE); /* clear SEL, disable data out */
i = WAIT_MUL * 2000;
1993-09-10 03:53:45 +04:00
while (i--) {
/* Must be clear for 2 usec, so read twice */
1993-11-04 10:58:29 +03:00
stat1 = RD_ADR (u_char, DP_STAT1);
if (stat1 & (DP_S_BSY | DP_S_SEL)) continue;
1993-09-10 03:53:45 +04:00
for (j = 5; j; j--);
1993-11-04 10:58:29 +03:00
stat1 = RD_ADR (u_char, DP_STAT1);
if (stat1 & (DP_S_BSY | DP_S_SEL)) continue;
1993-09-10 03:53:45 +04:00
return OK;
}
#if DP_DEBUG
printf("wait bus free failed\n");
dp_print_stat1(stat1);
#endif
dp_needs_reset = 1;
1993-09-10 03:53:45 +04:00
return NOT_OK;
}
/*===========================================================================*
* dp_select *
*===========================================================================*/
/* Select SCSI device, set up for command transfer.
*/
int
dp_select(adr)
long adr;
{
int i, stat1;
#if DP_DEBUG > 1
printf("dp_select(0x%x)\n", adr);
#endif
1993-11-04 10:58:29 +03:00
WR_ADR (u_char, DP_TCMD, 0); /* get to harmless state */
WR_ADR (u_char, DP_MODE, 0); /* get to harmless state */
1993-09-10 03:53:45 +04:00
WR_ADR (u_char, DP_OUTDATA, adr); /* SCSI bus address */
WR_ADR (u_char, DP_ICMD, DP_A_SEL | DP_ENABLE_DB | DP_EMODE);
for (i = 0;; ++i) { /* wait for target to assert SEL */
stat1 = RD_ADR (u_char, DP_STAT1);
if (stat1 & DP_S_BSY) break; /* select successful */
1993-11-04 10:58:29 +03:00
if (i > WAIT_MUL * 2000) { /* timeout */
u_char isr;
WR_ADR(u_char, DP_EMR_ISR, DP_EF_ISR_NEXT);
isr = RD_ADR (u_char, DP_EMR_ISR);
#if DP_DEBUG
1993-09-10 03:53:45 +04:00
printf ("SCSI: SELECT timeout adr %d\n", adr);
dp_print_regs();
printf("ICMD = 0x%x isr = 0x%x\n", RD_ADR(u_char, DP_ICMD), isr);
#endif
1993-09-10 03:53:45 +04:00
dp_reset();
return NOT_OK;
}
}
WR_ADR (u_char, DP_ICMD, DP_EMODE); /* clear SEL, disable data out */
WR_ADR (u_char, DP_OUTDATA, 0);
dp_clear_isr();
WR_ADR (u_char, DP_TCMD, 4); /* bogus phase, guarantee mismatch */
WR_ADR (u_char, DP_MODE, DP_M_BSY | DP_M_DMA);
return OK;
}
/*===========================================================================*
* scsi_select_ctlr
*===========================================================================*/
/* Select a SCSI device.
*/
scsi_select_ctlr (ctlr)
int ctlr;
{
/* May need other stuff here to syncronize between dp & aic. */
1993-09-10 03:53:45 +04:00
RD_ADR (u_char, ICU_IO) &= ~ICU_SCSI_BIT; /* i/o, not port */
RD_ADR (u_char, ICU_DIR) &= ~ICU_SCSI_BIT; /* output */
if (ctlr == DP8490)
RD_ADR (u_char, ICU_DATA) &= ~ICU_SCSI_BIT; /* select = 0 for 8490 */
else
RD_ADR (u_char, ICU_DATA) |= ICU_SCSI_BIT; /* select = 1 for AIC6250 */
}
/*===========================================================================*
* dp_start_cmd *
*===========================================================================*/
int dp_start_cmd(struct scsi_xfer *xs)
{
#if 0
WR_ADR (u_char, DP_OUTDATA, 1 << xs->targ); /* SCSI bus address */
WR_ADR (u_char, DP_EMR_ISR, DP_EF_ARB);
dp_dvr_state = DP_DVR_ARB;
#else
/* This is not the "right" way to start it. We should just have the
chip do the select for us and interrupt at the end. */
if (!dp_wait_bus_free()) {
#if DP_DEBUG
printf("dp_start_cmd: DP DRIVER BUSY\n");
#endif
xs->error = XS_BUSY;
return TRY_AGAIN_LATER;
}
if (!dp_select(1 << xs->targ)) {
#if DP_DEBUG
printf("dp_start_cmd: DP DRIVER STUFFUP\n");
#endif
xs->error = XS_DRIVER_STUFFUP;
return HAD_ERROR;
}
#endif
/* After selection, we now wait for the APHS interrupt! */
dp_dvr_state = DP_DVR_ARB; /* Just finished the select/arbitration */
dp_try_count = 1;
if (!(xs->flags & SCSI_NOMASK)) {
/* Set up the timeout! */
#if DP_DEBUG > 1
printf ("dp_start_cmd: dp timeouts not done\n");
#endif
}
return SUCCESSFULLY_QUEUED;
}
/*===========================================================================*
* dp_restart_cmd *
*===========================================================================*/
int dp_restart_cmd()
{
#if 0
WR_ADR (u_char, DP_OUTDATA, xs->targ); /* SCSI bus address */
WR_ADR (u_char, DP_EMR_ISR, DP_EF_ARB);
dp_dvr_state = DP_DVR_ARB;
#endif
/* This is not the "right" way to start it. We should just have the
chip do the select for us and interrupt at the end. */
DELAY(50);
#if DP_DEBUG
printf ("restart .. stat1=0x%x stat2=0x%x\n", RD_ADR(u_char, DP_STAT1),
RD_ADR(u_char, DP_STAT2));
#endif
if (!dp_wait_bus_free()) {
cur_xs->error = XS_BUSY;
return;
}
#if DP_DEBUG
printf ("restart .1 stat1=0x%x stat2=0x%x\n", RD_ADR(u_char, DP_STAT1),
RD_ADR(u_char, DP_STAT2));
printf ("cur_xs->targ=%d\n",cur_xs->targ);
#endif
if (!dp_select (1 << cur_xs->targ)) {
cur_xs->error = XS_DRIVER_STUFFUP;
return;
}
#if DP_DEBUG
printf ("restart .2 stat1=0x%x stat2=0x%x\n", RD_ADR(u_char, DP_STAT1),
RD_ADR(u_char, DP_STAT2));
#endif
/* After selection, we now wait for the APHS interrupt! */
dp_dvr_state = DP_DVR_ARB; /* Just finished the select/arbitration */
dp_try_count++;
if (!(cur_xs->flags & SCSI_NOMASK)) {
/* Set up the timeout! */
#if DP_DEBUG
printf ("dp_restart_cmd: dp timeouts not done\n");
#endif
}
}
/*===========================================================================*
* dp_pdma_out *
*===========================================================================*/
/* Note: in NetBSD, the scsi dma addresses are set by the mapping hardware
to inhibit cache. There is therefore, no need to worry about cache hits
during access to dma addresses. */
int dp_pdma_out(char *buf, int count, int phase)
{
int cnt;
int ret = OK;
u_int stat2;
#if DP_DEBUG
printf("dp_pdma_out: write %d bytes\n", count);
#endif
#if DP_DEBUG > 1
if (RD_ADR(u_char, DP_STAT2) & DP_S_IRQ)
printf("WARNING: stat2:IRQ set on call to dp_pdma_out\n");
#endif
/* Set it up. */
WR_ADR(u_char, DP_TCMD, phase);
RD_ADR(u_char, DP_MODE) |= DP_M_DMA;
WR_ADR(u_char, DP_ICMD, DP_ENABLE_DB | DP_EMODE);
WR_ADR(u_char, DP_START_SEND, 0);
/* Do the pdma: first longs, then bytes. */
while (count > sizeof(long)) {
WR_ADR(long, DP_DMA, *(((long *)buf)++));
count -= sizeof(long);
}
while (count-- > 1) {
WR_ADR(u_char, DP_DMA, *(buf++));
}
/* wait for DRQ to be asserted for the last byte, or an
* interrupt request to be signaled
*/
while (1) {
stat2 = RD_ADR(u_char, DP_STAT2);
if (stat2 & (DP_S_IRQ | DP_S_DRQ)) break;
}
if (stat2 & DP_S_DRQ) {
WR_ADR(u_char, DP_DMA_EOP, *buf);
}
else {
/* dma error! */
#if DP_DEBUG
printf ("dma write error!\n");
dp_print_stat1(RD_ADR(u_char, DP_STAT1));
dp_print_stat2(stat2);
#endif
cur_xs->error = XS_DRIVER_STUFFUP;
/* Clear dma mode, just in case, and disable the bus. */
RD_ADR (u_char, DP_MODE) &= ~DP_M_DMA;
WR_ADR (u_char, DP_ICMD, DP_EMODE);
ret = NOT_OK;
}
#if 0
/* Clear dma mode, just in case, and disable the bus. */
RD_ADR (u_char, DP_MODE) &= ~DP_M_DMA;
WR_ADR (u_char, DP_ICMD, DP_EMODE);
#endif
return ret;
}
/*===========================================================================*
* dp_pdma_in *
*===========================================================================*/
/* Note: in NetBSD, the scsi dma addresses are set by the mapping hardware
to inhibit cache. There is therefore, no need to worry about cache hits
during access to dma addresses. */
int dp_pdma_in(char *buf, int count, int phase)
{
int ret = OK;
int i_count = count;
u_int stat2;
u_char *dma_adr = (u_char *) DP_DMA; /* Address for last few bytes. */
#if DP_DEBUG > 1
printf("dp_pdma_in: read %d bytes\n", count);
#endif
/* Set it up. */
WR_ADR(u_char, DP_TCMD, phase);
RD_ADR(u_char, DP_MODE) |= DP_M_DMA;
WR_ADR(u_char, DP_EMR_ISR, DP_EF_START_RCV | DP_EMR_APHS);
/* Do the pdma */
while (count >= sizeof(long)) {
*(((long *)buf)++) = RD_ADR(long, DP_DMA);
count -= sizeof(long);
}
while (count-- > 0) {
*(buf++) = RD_ADR(u_char, (dma_adr++));
}
/* Clear dma mode, just in case, and disable the bus. */
RD_ADR(u_char, DP_MODE) &= ~DP_M_DMA;
WR_ADR(u_char, DP_ICMD, DP_EMODE);
return ret;
}
dp_wait_for_edma()
{
int i;
for (i = 0; i < 1000000; ++i) {
u_char tcmd = RD_ADR(u_char, DP_TCMD);
if (tcmd & DP_TCMD_EDMA) {
#if DP_DEBUG > 1
printf("dp_wait_for_phase: EDMA detected\n");
#endif
RD_ADR(u_char, DP_MODE) &= ~DP_M_DMA;
WR_ADR(u_char, DP_ICMD, DP_EMODE);
return;
}
}
printf("wait for edma timeout\n");
#if DP_DEBUG
dp_print_regs();
#endif
panic("dp: wait for edma");
}
dp_wait_for_phase(u_char phase)
{
int i;
u_char isr;
#if DP_DEBUG > 1
printf("wait for phase %d...", phase);
#endif
/* set the TCR register */
WR_ADR(u_char, DP_TCMD, phase);
/* wait for phase match */
for (i = 0; i < 1000000; ++i) {
u_char stat2 = RD_ADR(u_char, DP_STAT2);
if (stat2 & DP_S_PHASE) {
#if DP_DEBUG > 1
printf("done\n");
#endif
/* completely clear the isr */
WR_ADR(u_char, DP_EMR_ISR, DP_EF_ISR_NEXT);
isr = RD_ADR (u_char, DP_EMR_ISR);
dp_clear_isr();
return;
}
}
printf("wait for phase %d timeout\n", phase);
#if DP_DEBUG
dp_print_regs();
#endif
panic("dp: wait for phase");
}
/*===========================================================================*
* dp_get_sense *
*===========================================================================*/
dp_get_sense (struct scsi_xfer *xs)
{
u_char status;
u_char message;
u_char isr;
int ret;
bzero((u_char *) &xs->sense, sizeof(xs->sense));
/* completely clear the isr on entry */
WR_ADR(u_char, DP_EMR_ISR, DP_EF_ISR_NEXT);
isr = RD_ADR (u_char, DP_EMR_ISR);
dp_clear_isr();
RD_ADR(u_char, DP_MODE) &= ~DP_M_DMA;
WR_ADR(u_char, DP_ICMD, DP_EMODE);
#if DP_DEBUG > 2
printf ("sense 1: wait bus free\n");
#endif
if (!dp_wait_bus_free()) {
#if DP_DEBUG > 2
printf("sense 1: wait-bus-free failed\n");
#endif
xs->error = XS_BUSY;
return;
}
#if DP_DEBUG > 2
printf ("sense 2: select device\n");
#endif
if (!dp_select (1 << xs->targ)) {
#if DP_DEBUG
printf("sense 2: select failed\n");
#endif
xs->error = XS_DRIVER_STUFFUP;
return;
}
/* completely clear the isr */
WR_ADR(u_char, DP_EMR_ISR, DP_EF_ISR_NEXT);
isr = RD_ADR (u_char, DP_EMR_ISR);
dp_clear_isr();
/* send the command */
sense_cmd[1] = xs->lu << 5;
#if 0
sense_cmd[4] = sizeof(struct scsi_sense_data);
#else
sense_cmd[4] = 0x04;
#endif
dp_wait_for_phase(DP_PHASE_CMD);
ret = dp_pdma_out(sense_cmd, sizeof(sense_cmd), DP_PHASE_CMD);
if (ret != OK) {
#if DP_DEBUG
printf("dp_pdma_out: ret=%d\n", ret);
#endif
return;
}
/* read sense data */
dp_wait_for_edma();
dp_wait_for_phase(DP_PHASE_DATAI);
ret = dp_pdma_in((u_char *) &xs->sense, sense_cmd[4], DP_PHASE_DATAI);
if (ret != OK) {
#if DP_DEBUG
printf ("dp_pdma_in: ret=%d\n", ret);
#endif
}
/* read status */
dp_wait_for_phase(DP_PHASE_STATUS);
ret = dp_pdma_in(&status, 1, DP_PHASE_STATUS);
if (ret != OK) {
#if DP_DEBUG
printf ("dp_pdma_in: ret=%d\n", ret);
#endif
}
/* read message */
dp_wait_for_phase(DP_PHASE_MSGI);
ret = dp_pdma_in(&message, 1, DP_PHASE_MSGI);
if (ret != OK) {
#if DP_DEBUG
printf ("dp_pdma_in: ret=%d\n", ret);
#endif
}
#if DP_DEBUG
printf("sense status = 0x%x\n", status);
printf(" sense (0x%x) valid = %d code = 0x%x class = 0x%x\n",
*(u_char *) &xs->sense,
xs->sense.valid, xs->sense.error_code, xs->sense.error_class);
#endif
if (status & SCSI_BUSY) {
xs->error = XS_BUSY;
}
WR_ADR (u_char, DP_MODE, 0); /* Turn off monbsy, dma, ... */
}