1378 lines
33 KiB
C
1378 lines
33 KiB
C
/*
|
|
* (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.
|
|
*
|
|
* $Id: aha1542.c,v 1.18 1994/03/06 17:18:43 mycroft Exp $
|
|
*/
|
|
|
|
/*
|
|
* 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 "aha.h"
|
|
|
|
#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 <sys/proc.h>
|
|
#include <sys/user.h>
|
|
#include <sys/dkbad.h>
|
|
#include <sys/disklabel.h>
|
|
|
|
#include <machine/stdarg.h>
|
|
#include <machine/pio.h>
|
|
|
|
#include <scsi/scsi_all.h>
|
|
#include <scsi/scsiconf.h>
|
|
|
|
#include <i386/isa/isa_device.h>
|
|
|
|
|
|
#ifdef DDB
|
|
int Debugger();
|
|
#else DDB
|
|
#define Debugger() panic("should call debugger here (adaptec.c)")
|
|
#endif DDB
|
|
|
|
extern int delaycount; /* from clock setup code */
|
|
|
|
/* I/O Port Interface */
|
|
#define AHA_BASE aha_base[unit]
|
|
#define AHA_CTRL_STAT_PORT (AHA_BASE + 0x0) /* control & status */
|
|
#define AHA_CMD_DATA_PORT (AHA_BASE + 0x1) /* cmds and datas */
|
|
#define AHA_INTR_PORT (AHA_BASE + 0x2) /* Intr. stat */
|
|
|
|
/* AHA_CTRL_STAT bits (write) */
|
|
#define AHA_HRST 0x80 /* Hardware reset */
|
|
#define AHA_SRST 0x40 /* Software reset */
|
|
#define AHA_IRST 0x20 /* Interrupt reset */
|
|
#define AHA_SCRST 0x10 /* SCSI bus reset */
|
|
|
|
/* AHA_CTRL_STAT bits (read) */
|
|
#define AHA_STST 0x80 /* Self test in Progress */
|
|
#define AHA_DIAGF 0x40 /* Diagnostic Failure */
|
|
#define AHA_INIT 0x20 /* Mbx Init required */
|
|
#define AHA_IDLE 0x10 /* Host Adapter Idle */
|
|
#define AHA_CDF 0x08 /* cmd/data out port full */
|
|
#define AHA_DF 0x04 /* Data in port full */
|
|
#define AHA_INVDCMD 0x01 /* Invalid command */
|
|
|
|
/* AHA_CMD_DATA bits (write) */
|
|
#define AHA_NOP 0x00 /* No operation */
|
|
#define AHA_MBX_INIT 0x01 /* Mbx initialization */
|
|
#define AHA_START_SCSI 0x02 /* start scsi command */
|
|
#define AHA_START_BIOS 0x03 /* start bios command */
|
|
#define AHA_INQUIRE 0x04 /* Adapter Inquiry */
|
|
#define AHA_MBO_INTR_EN 0x05 /* Enable MBO available interrupt */
|
|
#define AHA_SEL_TIMEOUT_SET 0x06 /* set selection time-out */
|
|
#define AHA_BUS_ON_TIME_SET 0x07 /* set bus-on time */
|
|
#define AHA_BUS_OFF_TIME_SET 0x08 /* set bus-off time */
|
|
#define AHA_SPEED_SET 0x09 /* set transfer speed */
|
|
#define AHA_DEV_GET 0x0a /* return installed devices */
|
|
#define AHA_CONF_GET 0x0b /* return configuration data */
|
|
#define AHA_TARGET_EN 0x0c /* enable target mode */
|
|
#define AHA_SETUP_GET 0x0d /* return setup data */
|
|
#define AHA_WRITE_CH2 0x1a /* write channel 2 buffer */
|
|
#define AHA_READ_CH2 0x1b /* read channel 2 buffer */
|
|
#define AHA_WRITE_FIFO 0x1c /* write fifo buffer */
|
|
#define AHA_READ_FIFO 0x1d /* read fifo buffer */
|
|
#define AHA_ECHO 0x1e /* Echo command data */
|
|
|
|
struct aha_cmd_buf {
|
|
u_char byte[16];
|
|
};
|
|
|
|
/* AHA_INTR_PORT bits (read) */
|
|
#define AHA_ANY_INTR 0x80 /* Any interrupt */
|
|
#define AHA_SCRD 0x08 /* SCSI reset detected */
|
|
#define AHA_HACC 0x04 /* Command complete */
|
|
#define AHA_MBOA 0x02 /* MBX out empty */
|
|
#define AHA_MBIF 0x01 /* MBX in full */
|
|
|
|
/* Mail box defs */
|
|
#define AHA_MBX_SIZE 16 /* mail box size */
|
|
|
|
struct aha_mbx {
|
|
struct aha_mbx_out {
|
|
unsigned char cmd;
|
|
unsigned char ccb_addr[3];
|
|
} mbo[AHA_MBX_SIZE];
|
|
struct aha_mbx_in{
|
|
unsigned char stat;
|
|
unsigned char ccb_addr[3];
|
|
} mbi[AHA_MBX_SIZE];
|
|
};
|
|
|
|
/* mbo.cmd values */
|
|
#define AHA_MBO_FREE 0x0 /* MBO entry is free */
|
|
#define AHA_MBO_START 0x1 /* MBO activate entry */
|
|
#define AHA_MBO_ABORT 0x2 /* MBO abort entry */
|
|
|
|
#define AHA_MBI_FREE 0x0 /* MBI entry is free */
|
|
#define AHA_MBI_OK 0x1 /* completed without error */
|
|
#define AHA_MBI_ABORT 0x2 /* aborted ccb */
|
|
#define AHA_MBI_UNKNOWN 0x3 /* Tried to abort invalid CCB */
|
|
#define AHA_MBI_ERROR 0x4 /* Completed with error */
|
|
|
|
extern struct aha_mbx aha_mbx[];
|
|
|
|
/* FOR OLD VERSIONS OF THE !%$@ this may have to be 16 (yuk) */
|
|
/* Number of scatter gather segments <= 16, allow 64 K i/o (min) */
|
|
#define AHA_NSEG 17
|
|
|
|
struct aha_ccb {
|
|
unsigned char opcode;
|
|
unsigned char lun:3;
|
|
unsigned char data_in:1; /* must be 0 */
|
|
unsigned char data_out:1; /* must be 0 */
|
|
unsigned char target:3;
|
|
unsigned char scsi_cmd_length;
|
|
unsigned char req_sense_length;
|
|
unsigned char data_length[3];
|
|
unsigned char data_addr[3];
|
|
unsigned char link_addr[3];
|
|
unsigned char link_id;
|
|
unsigned char host_stat;
|
|
unsigned char target_stat;
|
|
unsigned char reserved[2];
|
|
struct scsi_generic scsi_cmd;
|
|
struct scsi_sense_data scsi_sense;
|
|
struct aha_scat_gath {
|
|
unsigned char seg_len[3];
|
|
unsigned char seg_addr[3];
|
|
} scat_gath[AHA_NSEG];
|
|
struct aha_ccb *next;
|
|
struct scsi_xfer *xfer; /* the scsi_xfer for this cmd */
|
|
struct aha_mbx_out *mbx; /* pointer to mail box */
|
|
long int delta; /* difference from previous*/
|
|
struct aha_ccb *later,*sooner;
|
|
int flags;
|
|
};
|
|
|
|
/* flags value? */
|
|
#define CCB_FREE 0
|
|
#define CCB_ACTIVE 1
|
|
#define CCB_ABORTED 2
|
|
|
|
struct aha_ccb *aha_soonest = (struct aha_ccb *)0;
|
|
struct aha_ccb *aha_latest = (struct aha_ccb *)0;
|
|
long int aha_furtherest = 0; /* longest time in the timeout queue */
|
|
|
|
/* opcode fields */
|
|
#define AHA_INITIATOR_CCB 0x00 /* SCSI Initiator CCB */
|
|
#define AHA_TARGET_CCB 0x01 /* SCSI Target CCB */
|
|
#define AHA_INIT_SCAT_GATH_CCB 0x02 /* SCSI Initiator with scattter gather*/
|
|
#define AHA_RESET_CCB 0x81 /* SCSI Bus reset */
|
|
|
|
|
|
/* aha_ccb.host_stat values */
|
|
#define AHA_OK 0x00 /* cmd ok */
|
|
#define AHA_LINK_OK 0x0a /* Link cmd ok */
|
|
#define AHA_LINK_IT 0x0b /* Link cmd ok + int */
|
|
#define AHA_SEL_TIMEOUT 0x11 /* Selection time out */
|
|
#define AHA_OVER_UNDER 0x12 /* Data over/under run */
|
|
#define AHA_BUS_FREE 0x13 /* Bus dropped at unexpected time */
|
|
#define AHA_INV_BUS 0x14 /* Invalid bus phase/sequence */
|
|
#define AHA_BAD_MBO 0x15 /* Incorrect MBO cmd */
|
|
#define AHA_BAD_CCB 0x16 /* Incorrect ccb opcode */
|
|
#define AHA_BAD_LINK 0x17 /* Not same values of LUN for links */
|
|
#define AHA_INV_TARGET 0x18 /* Invalid target direction */
|
|
#define AHA_CCB_DUP 0x19 /* Duplicate CCB received */
|
|
#define AHA_INV_CCB 0x1a /* Invalid CCB or segment list */
|
|
#define AHA_ABORTED 42
|
|
|
|
struct aha_setup {
|
|
u_char sync_neg:1;
|
|
u_char parity:1;
|
|
u_char :6;
|
|
u_char speed;
|
|
u_char bus_on;
|
|
u_char bus_off;
|
|
u_char num_mbx;
|
|
u_char mbx[3];
|
|
struct {
|
|
u_char offset:4;
|
|
u_char period:3;
|
|
u_char valid:1;
|
|
} sync[8];
|
|
u_char disc_sts;
|
|
};
|
|
|
|
struct aha_config {
|
|
u_char chan;
|
|
u_char intr;
|
|
u_char scsi_dev:3;
|
|
u_char :5;
|
|
};
|
|
|
|
#define INT9 0x01
|
|
#define INT10 0x02
|
|
#define INT11 0x04
|
|
#define INT12 0x08
|
|
#define INT14 0x20
|
|
#define INT15 0x40
|
|
|
|
#define CHAN0 0x01
|
|
#define CHAN5 0x20
|
|
#define CHAN6 0x40
|
|
#define CHAN7 0x80
|
|
|
|
|
|
|
|
#define PHYSTOKV(x) ((x) + KERNBASE)
|
|
#define KVTOPHYS(x) vtophys(x)
|
|
#define AHA_DMA_PAGES AHA_NSEG
|
|
|
|
#define PAGESIZ 4096
|
|
#define INVALIDATE_CACHE {asm volatile( ".byte 0x0F ;.byte 0x08" ); }
|
|
|
|
struct scsi_xfer aha_scsi_xfer[NAHA];
|
|
struct isa_device *ahainfo[NAHA];
|
|
struct aha_mbx aha_mbx[NAHA];
|
|
struct aha_ccb *aha_ccb_free[NAHA];
|
|
struct aha_ccb aha_ccb[NAHA][AHA_MBX_SIZE];
|
|
struct aha_ccb *aha_get_ccb();
|
|
u_char aha_scratch_buf[256];
|
|
short aha_base[NAHA]; /* base port for each board */
|
|
int speed[NAHA];
|
|
int aha_int[NAHA];
|
|
int aha_dma[NAHA];
|
|
int aha_scsi_dev[NAHA];
|
|
int aha_initialized[NAHA];
|
|
|
|
int aha_debug = 0;
|
|
static int ahaunit = 0;
|
|
|
|
#define aha_abortmbx(mbx) \
|
|
(mbx)->cmd = AHA_MBO_ABORT; \
|
|
outb(AHA_CMD_DATA_PORT, AHA_START_SCSI);
|
|
#define aha_startmbx(mbx) \
|
|
(mbx)->cmd = AHA_MBO_START; \
|
|
outb(AHA_CMD_DATA_PORT, AHA_START_SCSI);
|
|
|
|
#define AHA_CMD_TIMEOUT_FUDGE 200 /* multiplied to get Secs */
|
|
#define AHA_RESET_TIMEOUT 1000000 /* time to wait for reset */
|
|
#define AHA_SCSI_TIMEOUT_FUDGE 20 /* divided by for mSecs */
|
|
|
|
|
|
int aha_cmd(int, int, int, int, u_char *, ...);
|
|
int ahaprobe(struct isa_device *);
|
|
int ahaattach(struct isa_device *);
|
|
long int aha_adapter_info(int);
|
|
int ahaintr(int);
|
|
void aha_free_ccb(int, struct aha_ccb *, int);
|
|
struct aha_ccb * aha_get_ccb(int, int);
|
|
int aha_done(int, struct aha_ccb *);
|
|
int aha_init(int);
|
|
void ahaminphys(struct buf *);
|
|
int aha_scsi_cmd(struct scsi_xfer *);
|
|
int aha_set_bus_speed(int);
|
|
int aha_bus_speed_check(int, int);
|
|
void aha_add_timeout(struct aha_ccb *, int);
|
|
void aha_remove_timeout(struct aha_ccb *);
|
|
void aha_timeout(int);
|
|
|
|
|
|
struct isa_driver ahadriver = {
|
|
ahaprobe,
|
|
ahaattach,
|
|
"aha"
|
|
};
|
|
|
|
struct scsi_switch aha_switch[NAHA];
|
|
|
|
/*
|
|
* aha_cmd(unit, icnt, ocnt,wait, retval, ...)
|
|
* Activate Adapter command
|
|
* icnt: number of args (outbound bytes written after opcode)
|
|
* ocnt: number of expected returned bytes
|
|
* wait: number of seconds to wait for response
|
|
* retval: buffer where to place returned bytes
|
|
* ...: opcode AHA_NOP, AHA_MBX_INIT, AHA_START_SCSI & parameters
|
|
*
|
|
* Performs an adapter command through the ports. Not to be confused
|
|
* with a scsi command, which is read in via the dma
|
|
* One of the adapter commands tells it to read in a scsi command
|
|
*/
|
|
int
|
|
aha_cmd(int unit, int icnt, int ocnt, int wait, u_char *retval, ...)
|
|
{
|
|
va_list ap;
|
|
int opc, sts;
|
|
u_char oc;
|
|
register i;
|
|
|
|
va_start(ap, retval);
|
|
opc = (u_char)va_arg(ap, int);
|
|
/*printf("command: %08x %02x\n", opc, (u_char)opc);*/
|
|
|
|
/*
|
|
* multiply the wait argument by a big constant
|
|
* zero defaults to 1
|
|
*/
|
|
if(!wait)
|
|
wait = AHA_CMD_TIMEOUT_FUDGE * delaycount;
|
|
else
|
|
wait *= AHA_CMD_TIMEOUT_FUDGE * delaycount;
|
|
/*
|
|
* Wait for the adapter to go idle, unless it's one of
|
|
* the commands which don't need this
|
|
*/
|
|
if (opc != AHA_MBX_INIT && opc != AHA_START_SCSI) {
|
|
i = AHA_CMD_TIMEOUT_FUDGE * delaycount; /* 1 sec?*/
|
|
while (--i) {
|
|
sts = inb(AHA_CTRL_STAT_PORT);
|
|
if (sts & AHA_IDLE)
|
|
break;
|
|
}
|
|
if (!i) {
|
|
printf("aha_cmd: aha1542 host not idle(0x%x)\n", sts);
|
|
return(ENXIO);
|
|
}
|
|
}
|
|
/*
|
|
* Now that it is idle, if we expect output, preflush the*
|
|
* queue feeding to us.
|
|
*/
|
|
if (ocnt) {
|
|
while((inb(AHA_CTRL_STAT_PORT)) & AHA_DF)
|
|
inb(AHA_CMD_DATA_PORT);
|
|
}
|
|
|
|
/*
|
|
* Output the command and the number of arguments given
|
|
* for each byte, first check the port is empty.
|
|
*/
|
|
icnt++; /* include the command */
|
|
while (icnt--) {
|
|
sts = inb(AHA_CTRL_STAT_PORT);
|
|
for (i=0; i< wait; i++) {
|
|
sts = inb(AHA_CTRL_STAT_PORT);
|
|
if (!(sts & AHA_CDF))
|
|
break;
|
|
}
|
|
if (i >= wait) {
|
|
printf("aha_cmd: aha1542 cmd/data port full\n");
|
|
outb(AHA_CTRL_STAT_PORT, AHA_SRST);
|
|
return(ENXIO);
|
|
}
|
|
outb(AHA_CMD_DATA_PORT, (u_char)opc);
|
|
if(icnt) {
|
|
opc = (u_char)va_arg(ap, int);
|
|
/*printf("extra: %08x %02x\n", opc, (u_char)opc);*/
|
|
}
|
|
}
|
|
va_end(ap);
|
|
|
|
/*
|
|
* If we expect input, loop that many times, each time,
|
|
* looking for the data register to have valid data
|
|
*/
|
|
while (ocnt--) {
|
|
sts = inb(AHA_CTRL_STAT_PORT);
|
|
for (i=0; i< wait; i++) {
|
|
sts = inb(AHA_CTRL_STAT_PORT);
|
|
if (sts & AHA_DF)
|
|
break;
|
|
}
|
|
if (i >= wait) {
|
|
printf("aha_cmd: aha1542 cmd/data port empty %d\n",ocnt);
|
|
return(ENXIO);
|
|
}
|
|
oc = inb(AHA_CMD_DATA_PORT);
|
|
if (retval)
|
|
*retval++ = oc;
|
|
}
|
|
/*
|
|
* Wait for the board to report a finised instruction
|
|
*/
|
|
i=AHA_CMD_TIMEOUT_FUDGE * delaycount; /* 1 sec? */
|
|
while (--i) {
|
|
sts = inb(AHA_INTR_PORT);
|
|
if (sts & AHA_HACC)
|
|
break;
|
|
}
|
|
if (!i) {
|
|
printf("aha_cmd: aha1542 host not finished(0x%x)\n",sts);
|
|
return(ENXIO);
|
|
}
|
|
outb(AHA_CTRL_STAT_PORT, AHA_IRST);
|
|
return(0);
|
|
}
|
|
|
|
/*
|
|
* Check if the device can be found at the port given
|
|
* and if so, set it up ready for further work
|
|
* as an argument, takes the isa_device structure from
|
|
* autoconf.c
|
|
*/
|
|
int
|
|
ahaprobe(struct isa_device *dev)
|
|
{
|
|
int unit = ahaunit;
|
|
|
|
dev->id_unit = unit;
|
|
aha_base[unit] = dev->id_iobase;
|
|
if(unit >= NAHA) {
|
|
printf("aha: unit number (%d) too high\n",unit);
|
|
return(0);
|
|
}
|
|
|
|
/*
|
|
* Try initialise a unit at this location
|
|
* sets up dma and bus speed, loads aha_int[unit]
|
|
*/
|
|
if (aha_init(unit) != 0)
|
|
return(0);
|
|
|
|
/*
|
|
* If it's there, put in it's interrupt vectors
|
|
*/
|
|
dev->id_irq = (1 << aha_int[unit]);
|
|
dev->id_drq = aha_dma[unit];
|
|
ahaunit++;
|
|
return(8);
|
|
}
|
|
|
|
/*
|
|
* Attach all the sub-devices we can find
|
|
*/
|
|
int
|
|
ahaattach(struct isa_device *dev)
|
|
{
|
|
static int firsttime;
|
|
static int firstswitch[NAHA];
|
|
static u_long speedprint; /* max 32 aha controllers */
|
|
int masunit = dev->id_masunit;
|
|
int r;
|
|
|
|
if (!firstswitch[masunit]) {
|
|
firstswitch[masunit] = 1;
|
|
aha_switch[masunit].name = "aha";
|
|
aha_switch[masunit].scsi_cmd = aha_scsi_cmd;
|
|
aha_switch[masunit].scsi_minphys = ahaminphys;
|
|
aha_switch[masunit].open_target_lu = 0;
|
|
aha_switch[masunit].close_target_lu = 0;
|
|
aha_switch[masunit].adapter_info = aha_adapter_info;
|
|
for (r = 0; r < 8; r++) {
|
|
aha_switch[masunit].empty[r] = 0;
|
|
aha_switch[masunit].used[r] = 0;
|
|
aha_switch[masunit].printed[r] = 0;
|
|
}
|
|
}
|
|
if(!(speedprint & (1<<masunit))) {
|
|
delay(1000000);
|
|
speedprint |= (1<<masunit);
|
|
printf("aha%d: bus speed %dns\n", masunit, speed[masunit]);
|
|
}
|
|
|
|
r = scsi_attach(masunit, aha_scsi_dev[masunit], &aha_switch[masunit],
|
|
&dev->id_physid, &dev->id_unit, dev->id_flags);
|
|
|
|
/* only one for all boards */
|
|
if(firsttime==0) {
|
|
firsttime = 1;
|
|
aha_timeout(0);
|
|
}
|
|
return r;
|
|
}
|
|
|
|
|
|
/*
|
|
* Return some information to the caller about
|
|
* the adapter and it's capabilities
|
|
*/
|
|
long int
|
|
aha_adapter_info(int unit)
|
|
{
|
|
return(2); /* 2 outstanding requests at a time per device */
|
|
}
|
|
|
|
/*
|
|
* Catch an interrupt from the adaptor
|
|
*/
|
|
int
|
|
ahaintr(int unit)
|
|
{
|
|
struct aha_ccb *ccb;
|
|
unsigned char stat;
|
|
register i;
|
|
|
|
if(scsi_debug & PRINTROUTINES)
|
|
printf("ahaintr ");
|
|
/*
|
|
* First acknowlege the interrupt, Then if it's
|
|
* not telling about a completed operation
|
|
* just return.
|
|
*/
|
|
stat = inb(AHA_INTR_PORT);
|
|
outb(AHA_CTRL_STAT_PORT, AHA_IRST);
|
|
if(scsi_debug & TRACEINTERRUPTS)
|
|
printf("int ");
|
|
if (! (stat & AHA_MBIF))
|
|
return(1);
|
|
if(scsi_debug & TRACEINTERRUPTS)
|
|
printf("b ");
|
|
|
|
/*
|
|
* If it IS then process the competed operation
|
|
*/
|
|
for (i = 0; i < AHA_MBX_SIZE; i++) {
|
|
if (aha_mbx[unit].mbi[i].stat != AHA_MBI_FREE) {
|
|
ccb = (struct aha_ccb *)PHYSTOKV(
|
|
(_3btol(aha_mbx[unit].mbi[i].ccb_addr)));
|
|
if((stat = aha_mbx[unit].mbi[i].stat) != AHA_MBI_OK) {
|
|
switch(stat) {
|
|
case AHA_MBI_ABORT:
|
|
if(aha_debug)
|
|
printf("abort");
|
|
ccb->host_stat = AHA_ABORTED;
|
|
break;
|
|
case AHA_MBI_UNKNOWN:
|
|
ccb = (struct aha_ccb *)0;
|
|
if(aha_debug)
|
|
printf("unknown ccb for abort ");
|
|
/* may have missed it */
|
|
/* no such ccb known for abort */
|
|
break;
|
|
case AHA_MBI_ERROR:
|
|
break;
|
|
default:
|
|
panic("Impossible mbxi status");
|
|
}
|
|
if( aha_debug && ccb ) {
|
|
u_char *cp;
|
|
cp = (u_char *)(&(ccb->scsi_cmd));
|
|
printf("op=%x %x %x %x %x %x\n",
|
|
cp[0], cp[1], cp[2],
|
|
cp[3], cp[4], cp[5]);
|
|
printf("stat %x for mbi[%d]\n"
|
|
, aha_mbx[unit].mbi[i].stat, i);
|
|
printf("addr = 0x%x\n", ccb);
|
|
}
|
|
}
|
|
if(ccb) {
|
|
aha_remove_timeout(ccb);
|
|
aha_done(unit,ccb);
|
|
}
|
|
aha_mbx[unit].mbi[i].stat = AHA_MBI_FREE;
|
|
}
|
|
}
|
|
return(1);
|
|
}
|
|
|
|
/*
|
|
* A ccb (and hence a mbx-out is put onto the
|
|
* free list.
|
|
*/
|
|
void
|
|
aha_free_ccb(int unit, struct aha_ccb *ccb, int flags)
|
|
{
|
|
unsigned int opri;
|
|
|
|
if(scsi_debug & PRINTROUTINES)
|
|
printf("ccb%d(0x%x)> ",unit,flags);
|
|
if (!(flags & SCSI_NOMASK))
|
|
opri = splbio();
|
|
|
|
ccb->next = aha_ccb_free[unit];
|
|
aha_ccb_free[unit] = ccb;
|
|
ccb->flags = CCB_FREE;
|
|
if(ccb->sooner || ccb->later) {
|
|
printf("yikes, still in timeout queue\n");
|
|
aha_remove_timeout(ccb);
|
|
}
|
|
/*
|
|
* If there were none, wake abybody waiting for
|
|
* one to come free, starting with queued entries*
|
|
*/
|
|
if (!ccb->next)
|
|
wakeup( (caddr_t)&aha_ccb_free[unit]);
|
|
if (!(flags & SCSI_NOMASK))
|
|
splx(opri);
|
|
}
|
|
|
|
/*
|
|
* Get a free ccb (and hence mbox-out entry)
|
|
*/
|
|
struct aha_ccb *
|
|
aha_get_ccb(int unit, int flags)
|
|
{
|
|
unsigned opri;
|
|
struct aha_ccb *rc;
|
|
|
|
if(scsi_debug & PRINTROUTINES)
|
|
printf("<ccb%d(0x%x) ",unit,flags);
|
|
if (!(flags & SCSI_NOMASK))
|
|
opri = splbio();
|
|
/*
|
|
* If we can and have to, sleep waiting for one
|
|
* to come free
|
|
*/
|
|
while ((!(rc = aha_ccb_free[unit])) && (!(flags & SCSI_NOSLEEP)))
|
|
sleep((caddr_t)&aha_ccb_free[unit], PRIBIO);
|
|
if (rc) {
|
|
aha_ccb_free[unit] = aha_ccb_free[unit]->next;
|
|
rc->flags = CCB_ACTIVE;
|
|
}
|
|
if (!(flags & SCSI_NOMASK))
|
|
splx(opri);
|
|
return(rc);
|
|
}
|
|
|
|
|
|
/*
|
|
* We have a ccb which has been processed by the
|
|
* adaptor, now we look to see how the operation
|
|
* went. Wake up the owner if waiting
|
|
*/
|
|
int
|
|
aha_done(int unit, struct aha_ccb *ccb)
|
|
{
|
|
struct scsi_sense_data *s1,*s2;
|
|
struct scsi_xfer *xs = ccb->xfer;
|
|
|
|
if(scsi_debug & PRINTROUTINES )
|
|
printf("aha_done ");
|
|
/*
|
|
* Otherwise, put the results of the operation
|
|
* into the xfer and call whoever started it
|
|
*/
|
|
if(!(xs->flags & INUSE)) {
|
|
printf("exiting but not in use! ");
|
|
Debugger();
|
|
}
|
|
if ((ccb->host_stat != AHA_OK || ccb->target_stat != SCSI_OK)
|
|
&& (!(xs->flags & SCSI_ERR_OK))) {
|
|
s1 = (struct scsi_sense_data *)(((char *)(&ccb->scsi_cmd))
|
|
+ ccb->scsi_cmd_length);
|
|
s2 = &(xs->sense);
|
|
|
|
if(ccb->host_stat) {
|
|
switch(ccb->host_stat) {
|
|
case AHA_ABORTED:
|
|
case AHA_SEL_TIMEOUT: /* No response */
|
|
xs->error = XS_TIMEOUT;
|
|
break;
|
|
default: /* Other scsi protocol messes */
|
|
xs->error = XS_DRIVER_STUFFUP;
|
|
if (aha_debug > 1)
|
|
printf("host_stat%x\n", ccb->host_stat);
|
|
}
|
|
|
|
} else {
|
|
switch(ccb->target_stat) {
|
|
case 0x02:
|
|
/* structure copy!!!!!*/
|
|
*s2=*s1;
|
|
xs->error = XS_SENSE;
|
|
break;
|
|
case 0x08:
|
|
xs->error = XS_BUSY;
|
|
break;
|
|
default:
|
|
if (aha_debug > 1)
|
|
printf("target_stat%x\n", ccb->target_stat);
|
|
xs->error = XS_DRIVER_STUFFUP;
|
|
}
|
|
}
|
|
} else
|
|
xs->resid = 0;
|
|
|
|
xs->flags |= ITSDONE;
|
|
aha_free_ccb(unit,ccb, xs->flags);
|
|
if(xs->when_done)
|
|
(*(xs->when_done))(xs->done_arg,xs->done_arg2);
|
|
}
|
|
|
|
|
|
/*
|
|
* Start the board, ready for normal operation
|
|
*/
|
|
int
|
|
aha_init(int unit)
|
|
{
|
|
struct aha_config conf;
|
|
unsigned char ad[3];
|
|
volatile int i,sts;
|
|
|
|
/*
|
|
* reset board, If it doesn't respond, assume
|
|
* that it's not there.. good for the probe
|
|
*/
|
|
|
|
outb(AHA_CTRL_STAT_PORT, AHA_HRST|AHA_SRST);
|
|
|
|
for (i=0; i < AHA_RESET_TIMEOUT; i++) {
|
|
sts = inb(AHA_CTRL_STAT_PORT) ;
|
|
if(sts == (AHA_IDLE | AHA_INIT))
|
|
break;
|
|
}
|
|
|
|
if (i >= AHA_RESET_TIMEOUT) {
|
|
if (aha_debug)
|
|
printf("aha_init: No answer from adaptec board\n");
|
|
return(ENXIO);
|
|
}
|
|
|
|
/*
|
|
* Assume we have a board at this stage
|
|
* setup dma channel from jumpers and save int level
|
|
*/
|
|
delay(1000);
|
|
aha_cmd(unit, 0, sizeof(conf), 0, (u_char *)&conf, AHA_CONF_GET);
|
|
switch(conf.chan) {
|
|
case CHAN0:
|
|
outb(0x0b, 0x0c);
|
|
outb(0x0a, 0x00);
|
|
aha_dma[unit] = 0;
|
|
break;
|
|
case CHAN5:
|
|
outb(0xd6, 0xc1);
|
|
outb(0xd4, 0x01);
|
|
aha_dma[unit] = 5;
|
|
break;
|
|
case CHAN6:
|
|
outb(0xd6, 0xc2);
|
|
outb(0xd4, 0x02);
|
|
aha_dma[unit] = 6;
|
|
break;
|
|
case CHAN7:
|
|
outb(0xd6, 0xc3);
|
|
outb(0xd4, 0x03);
|
|
aha_dma[unit] = 7;
|
|
break;
|
|
default:
|
|
printf("illegal dma jumper setting\n");
|
|
return(EIO);
|
|
}
|
|
|
|
switch(conf.intr) {
|
|
case INT9:
|
|
aha_int[unit] = 9;
|
|
break;
|
|
case INT10:
|
|
aha_int[unit] = 10;
|
|
break;
|
|
case INT11:
|
|
aha_int[unit] = 11;
|
|
break;
|
|
case INT12:
|
|
aha_int[unit] = 12;
|
|
break;
|
|
case INT14:
|
|
aha_int[unit] = 14;
|
|
break;
|
|
case INT15:
|
|
aha_int[unit] = 15;
|
|
break;
|
|
default:
|
|
printf("illegal int jumper setting\n");
|
|
return(EIO);
|
|
}
|
|
/* who are we on the scsi bus */
|
|
aha_scsi_dev[unit] = conf.scsi_dev;
|
|
|
|
|
|
/*
|
|
* Initialize memory transfer speed
|
|
*/
|
|
speed[unit] = aha_set_bus_speed(unit);
|
|
if(speed[unit] == 0) {
|
|
printf("aha%d found, but unable to talk to it correctly\n");
|
|
return(EIO);
|
|
}
|
|
|
|
/*
|
|
* Initialize bus-on time
|
|
*
|
|
* The default is 11ms, which can result in the fd driver becoming
|
|
* starved for data during simultaneous fd & scsi transfers. We
|
|
* set it to 9ms - if this still gives you trouble, set to 6 (ms)
|
|
* and work your way up.
|
|
*/
|
|
aha_cmd(unit,1, 0, 0, 0, AHA_BUS_ON_TIME_SET, 9);
|
|
|
|
/*
|
|
* Initialize mail box
|
|
*/
|
|
lto3b(KVTOPHYS(&aha_mbx[unit]), ad);
|
|
|
|
aha_cmd(unit, 4, 0, 0, (u_char *)0, AHA_MBX_INIT, AHA_MBX_SIZE,
|
|
ad[0], ad[1], ad[2]);
|
|
|
|
|
|
/*
|
|
* link the ccb's with the mbox-out entries and
|
|
* into a free-list
|
|
*/
|
|
for (i=0; i < AHA_MBX_SIZE; i++) {
|
|
aha_ccb[unit][i].next = aha_ccb_free[unit];
|
|
aha_ccb_free[unit] = &aha_ccb[unit][i];
|
|
aha_ccb_free[unit]->flags = CCB_FREE;
|
|
aha_ccb_free[unit]->mbx = &aha_mbx[unit].mbo[i];
|
|
lto3b(KVTOPHYS(aha_ccb_free[unit]), aha_mbx[unit].mbo[i].ccb_addr);
|
|
}
|
|
|
|
/*
|
|
* Note that we are going and return (to probe)
|
|
*/
|
|
aha_initialized[unit]++;
|
|
return(0);
|
|
}
|
|
|
|
/*
|
|
* aha seems to explode with 17 segs (64k may require 17 segs)
|
|
* on old boards so use a max of 16 segs if you have problems
|
|
* here
|
|
*/
|
|
void
|
|
ahaminphys(struct buf *bp)
|
|
{
|
|
if(bp->b_bcount > ((AHA_NSEG - 1) * PAGESIZ))
|
|
bp->b_bcount = ((AHA_NSEG - 1) * PAGESIZ);
|
|
}
|
|
|
|
/*
|
|
* start a scsi operation given the command and
|
|
* the data address. Also needs the unit, target
|
|
* and lu
|
|
*/
|
|
int
|
|
aha_scsi_cmd(struct scsi_xfer *xs)
|
|
{
|
|
struct scsi_sense_data *s1,*s2;
|
|
struct aha_ccb *ccb;
|
|
struct aha_scat_gath *sg;
|
|
int seg; /* scatter gather seg being worked on */
|
|
int i = 0;
|
|
int rc = 0;
|
|
int thiskv;
|
|
int thisphys,nextphys;
|
|
int unit =xs->adapter;
|
|
int bytes_this_seg,bytes_this_page,datalen,flags;
|
|
struct iovec *iovp;
|
|
int s;
|
|
|
|
if(scsi_debug & PRINTROUTINES)
|
|
printf("aha_scsi_cmd ");
|
|
/*
|
|
* get a ccb (mbox-out) to use. If the transfer
|
|
* is from a buf (possibly from interrupt time)
|
|
* then we can't allow it to sleep
|
|
*/
|
|
flags = xs->flags;
|
|
if(!(flags & INUSE)) {
|
|
printf("not in use!");
|
|
Debugger();
|
|
xs->flags |= INUSE;
|
|
}
|
|
if(flags & ITSDONE) {
|
|
printf("Already done! check device retry code ");
|
|
Debugger();
|
|
xs->flags &= ~ITSDONE;
|
|
}
|
|
if(xs->bp) flags |= (SCSI_NOSLEEP); /* just to be sure */
|
|
if (!(ccb = aha_get_ccb(unit,flags))) {
|
|
xs->error = XS_DRIVER_STUFFUP;
|
|
return(TRY_AGAIN_LATER);
|
|
}
|
|
|
|
if (ccb->mbx->cmd != AHA_MBO_FREE)
|
|
printf("MBO not free\n");
|
|
|
|
/*
|
|
* Put all the arguments for the xfer in the ccb
|
|
* (can't use S/G if zero length)
|
|
*/
|
|
ccb->xfer = xs;
|
|
if(flags & SCSI_RESET)
|
|
ccb->opcode = AHA_RESET_CCB;
|
|
else
|
|
ccb->opcode = (xs->datalen ? AHA_INIT_SCAT_GATH_CCB : AHA_INITIATOR_CCB);
|
|
ccb->target = xs->targ;;
|
|
ccb->data_out = 0;
|
|
ccb->data_in = 0;
|
|
ccb->lun = xs->lu;
|
|
ccb->scsi_cmd_length = xs->cmdlen;
|
|
ccb->req_sense_length = sizeof(ccb->scsi_sense);
|
|
|
|
/* can use S/G only if not zero length */
|
|
if((xs->datalen) && (!(flags & SCSI_RESET))) {
|
|
lto3b(KVTOPHYS(ccb->scat_gath), ccb->data_addr);
|
|
sg = ccb->scat_gath;
|
|
seg = 0;
|
|
if(flags & SCSI_DATA_UIO) {
|
|
iovp = ((struct uio *)xs->data)->uio_iov;
|
|
datalen = ((struct uio *)xs->data)->uio_iovcnt;
|
|
while ((datalen) && (seg < AHA_NSEG)) {
|
|
lto3b((u_long)iovp->iov_base, (u_char *)&sg->seg_addr);
|
|
lto3b(iovp->iov_len, (u_char *)&sg->seg_len);
|
|
if(scsi_debug & SHOWSCATGATH)
|
|
printf("(0x%x@0x%x)", iovp->iov_len,
|
|
iovp->iov_base);
|
|
sg++;
|
|
iovp++;
|
|
seg++;
|
|
datalen--;
|
|
}
|
|
} else {
|
|
/*
|
|
* Set up the scatter gather block
|
|
*/
|
|
if(scsi_debug & SHOWSCATGATH)
|
|
printf("%d @0x%x:- ", xs->datalen, xs->data);
|
|
datalen = xs->datalen;
|
|
thiskv = (int)xs->data;
|
|
thisphys = KVTOPHYS(thiskv);
|
|
|
|
while ((datalen) && (seg < AHA_NSEG)) {
|
|
bytes_this_seg = 0;
|
|
|
|
/* put in the base address */
|
|
lto3b(thisphys, (u_char *)&(sg->seg_addr));
|
|
|
|
if(scsi_debug & SHOWSCATGATH)
|
|
printf("0x%x",thisphys);
|
|
|
|
/* do it at least once */
|
|
nextphys = thisphys;
|
|
while ((datalen) && (thisphys == nextphys)) {
|
|
/*
|
|
* This page is contiguous (physically)
|
|
* with the the last, just extend the
|
|
* length
|
|
*/
|
|
/* how far to the end of the page? */
|
|
nextphys = (thisphys & (~(PAGESIZ - 1)))
|
|
+ PAGESIZ;
|
|
bytes_this_page =
|
|
min(nextphys - thisphys, datalen);
|
|
bytes_this_seg += bytes_this_page;
|
|
datalen -= bytes_this_page;
|
|
|
|
thiskv = (thiskv & (~(PAGESIZ - 1)))
|
|
+ PAGESIZ;
|
|
if(datalen)
|
|
thisphys = KVTOPHYS(thiskv);
|
|
}
|
|
/*
|
|
* next page isn't contiguous, finish the seg
|
|
*/
|
|
if(scsi_debug & SHOWSCATGATH)
|
|
printf("(0x%x)",bytes_this_seg);
|
|
lto3b(bytes_this_seg, (u_char *)&(sg->seg_len));
|
|
sg++;
|
|
seg++;
|
|
}
|
|
}
|
|
lto3b(seg * sizeof(struct aha_scat_gath), ccb->data_length);
|
|
if(scsi_debug & SHOWSCATGATH)
|
|
printf("\n");
|
|
if (datalen) {
|
|
/* there's still data, must have run out of segs! */
|
|
printf("aha_scsi_cmd%d: needed more than %d DMA segs, %d\n",
|
|
unit, AHA_NSEG, datalen);
|
|
xs->error = XS_DRIVER_STUFFUP;
|
|
aha_free_ccb(unit, ccb, flags);
|
|
return(HAD_ERROR);
|
|
}
|
|
} else { /* No data xfer, use non S/G values */
|
|
lto3b(0, ccb->data_addr );
|
|
lto3b(0, ccb->data_length);
|
|
}
|
|
lto3b(0, ccb->link_addr);
|
|
/*
|
|
* Put the scsi command in the ccb and start it
|
|
*/
|
|
if(!(flags & SCSI_RESET))
|
|
bcopy(xs->cmd, &ccb->scsi_cmd, ccb->scsi_cmd_length);
|
|
if(scsi_debug & SHOWCOMMANDS)
|
|
{
|
|
u_char *b = (u_char *)&ccb->scsi_cmd;
|
|
if(!(flags & SCSI_RESET))
|
|
{
|
|
int i = 0;
|
|
printf("aha%d:%d:%d-"
|
|
,unit
|
|
,ccb->target
|
|
,ccb->lun );
|
|
while(i < ccb->scsi_cmd_length )
|
|
{
|
|
if(i) printf(",");
|
|
printf("%x",b[i++]);
|
|
}
|
|
}
|
|
else
|
|
{
|
|
printf("aha%d:%d:%d-RESET- "
|
|
,unit
|
|
,ccb->target
|
|
,ccb->lun
|
|
);
|
|
}
|
|
}
|
|
if (!(flags & SCSI_NOMASK))
|
|
{
|
|
s= splbio(); /* stop instant timeouts */
|
|
aha_add_timeout(ccb,xs->timeout);
|
|
aha_startmbx(ccb->mbx);
|
|
/*
|
|
* Usually return SUCCESSFULLY QUEUED
|
|
*/
|
|
splx(s);
|
|
if(scsi_debug & TRACEINTERRUPTS)
|
|
printf("sent ");
|
|
return(SUCCESSFULLY_QUEUED);
|
|
}
|
|
aha_startmbx(ccb->mbx);
|
|
if(scsi_debug & TRACEINTERRUPTS)
|
|
printf("cmd_sent, waiting ");
|
|
/*
|
|
* If we can't use interrupts, poll on completion*
|
|
*/
|
|
{
|
|
int done = 0;
|
|
int count = delaycount * xs->timeout / AHA_SCSI_TIMEOUT_FUDGE;
|
|
while((!done) && count)
|
|
{
|
|
i=0;
|
|
while ( (!done) && i<AHA_MBX_SIZE)
|
|
{
|
|
if ((aha_mbx[unit].mbi[i].stat != AHA_MBI_FREE )
|
|
&& (PHYSTOKV(_3btol(aha_mbx[unit].mbi[i].ccb_addr)
|
|
== (int)ccb)))
|
|
{
|
|
aha_mbx[unit].mbi[i].stat = AHA_MBI_FREE;
|
|
aha_done(unit,ccb);
|
|
done++;
|
|
}
|
|
i++;
|
|
}
|
|
count--;
|
|
}
|
|
if (!count)
|
|
{
|
|
if (!(xs->flags & SCSI_SILENT))
|
|
printf("cmd fail\n");
|
|
aha_abortmbx(ccb->mbx);
|
|
count = delaycount * 2000 / AHA_SCSI_TIMEOUT_FUDGE;
|
|
while((!done) && count) {
|
|
i=0;
|
|
while ( (!done) && i<AHA_MBX_SIZE) {
|
|
if ((aha_mbx[unit].mbi[i].stat != AHA_MBI_FREE )
|
|
&& (PHYSTOKV(_3btol(aha_mbx[unit].mbi[i].ccb_addr)
|
|
== (int)ccb))) {
|
|
aha_mbx[unit].mbi[i].stat = AHA_MBI_FREE;
|
|
aha_done(unit,ccb);
|
|
done++;
|
|
}
|
|
i++;
|
|
}
|
|
count--;
|
|
}
|
|
if(!count) {
|
|
printf("abort failed in wait\n");
|
|
ccb->mbx->cmd = AHA_MBO_FREE;
|
|
}
|
|
aha_free_ccb(unit,ccb,flags);
|
|
ahaintr(unit);
|
|
xs->error = XS_DRIVER_STUFFUP;
|
|
return(HAD_ERROR);
|
|
}
|
|
ahaintr(unit);
|
|
if(xs->error) return(HAD_ERROR);
|
|
return(COMPLETE);
|
|
}
|
|
/* return ??? */
|
|
}
|
|
|
|
/*
|
|
* try each speed in turn, when we find one that works, use
|
|
* the NEXT one for a safety margin, unless that doesn't exist
|
|
* or doesn't work. returns the nsec value of the time used
|
|
* or 0 if it could get a working speed ( or the NEXT speed
|
|
* failed)
|
|
* Go one slower to be safe, unless eisa at 100 ns.. trust it
|
|
*/
|
|
int
|
|
aha_set_bus_speed(int unit)
|
|
{
|
|
int retval, retval2;
|
|
int speed;
|
|
|
|
#ifdef EISA
|
|
speed = 0; /* start at the fastest */
|
|
#else EISA
|
|
speed = 1; /* 100 ns can crash some ISA busses (!?!) */
|
|
#endif EISA
|
|
while (1) {
|
|
retval = aha_bus_speed_check(unit, speed);
|
|
if(retval == HAD_ERROR) {
|
|
printf("no working bus speed!!!\n");
|
|
return 0;
|
|
}
|
|
|
|
if(retval == 0)
|
|
speed++;
|
|
else {
|
|
if(speed != 0)
|
|
speed++;
|
|
|
|
/*printf("%d nsec ok, but using ", retval);*/
|
|
retval2 = aha_bus_speed_check(unit, speed);
|
|
if(retval2 == HAD_ERROR) {
|
|
/*printf("marginal ");*/
|
|
retval2 = retval;
|
|
}
|
|
if(retval2) {
|
|
/*printf("%d nsec\n", retval2);*/
|
|
return retval2;
|
|
} else {
|
|
/*printf(".. slower failed, abort.\n", retval);*/
|
|
return 0;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Set the DMA speed to the Nth speed and try an xfer. If it
|
|
* fails return 0, if it succeeds return the nsec value selected
|
|
* If there is no such speed return HAD_ERROR.
|
|
*/
|
|
static struct bus_speed {
|
|
char arg;
|
|
int nsecs;
|
|
} aha_bus_speeds[] = {
|
|
{0x88, 100},
|
|
{0x99, 150},
|
|
{0xaa, 200},
|
|
{0xbb, 250},
|
|
{0xcc, 300},
|
|
{0xdd, 350},
|
|
{0xee, 400},
|
|
{0xff, 450}
|
|
};
|
|
static char aha_test_string[] =
|
|
"ABCDEFGHIJKLMNOPQRSTUVWXYZ1234567890abcdefghijklmnopqrstuvwxyz!@";
|
|
|
|
int
|
|
aha_bus_speed_check(int unit, int speed)
|
|
{
|
|
int numspeeds = sizeof(aha_bus_speeds)/sizeof(struct bus_speed);
|
|
u_char ad[3];
|
|
|
|
/*
|
|
* Check we have such an entry
|
|
*/
|
|
if(speed >= numspeeds) return(HAD_ERROR); /* illegal speed */
|
|
|
|
/*
|
|
* Set the dma-speed
|
|
*/
|
|
aha_cmd(unit,1, 0, 0, (u_char *)0, AHA_SPEED_SET,aha_bus_speeds[speed].arg);
|
|
|
|
/*
|
|
* put the test data into the buffer and calculate
|
|
* it's address. Read it onto the board
|
|
*/
|
|
strcpy((char *)aha_scratch_buf, (char *)aha_test_string);
|
|
lto3b(KVTOPHYS(aha_scratch_buf), ad);
|
|
|
|
aha_cmd(unit,3, 0, 0, (u_char *)0, AHA_WRITE_FIFO,
|
|
ad[0], ad[1], ad[2]);
|
|
|
|
/*
|
|
* clear the buffer then copy the contents back from the
|
|
* board.
|
|
*/
|
|
bzero(aha_scratch_buf,54); /* 54 bytes transfered by test */
|
|
|
|
aha_cmd(unit,3, 0, 0, (u_char *)0, AHA_READ_FIFO,
|
|
ad[0], ad[1], ad[2]);
|
|
|
|
/*
|
|
* Compare the original data and the final data and
|
|
* return the correct value depending upon the result
|
|
* if copy fails.. assume too fast
|
|
*/
|
|
if(strcmp(aha_test_string, (char *)aha_scratch_buf))
|
|
return(0);
|
|
return(aha_bus_speeds[speed].nsecs);
|
|
}
|
|
|
|
|
|
/*
|
|
* +----------+ +----------+ +----------+
|
|
* aha_soonest--->| later |--->| later|--->| later|-->0
|
|
* | [Delta] | | [Delta] | | [Delta] |
|
|
* 0<---|sooner |<---|sooner |<---|sooner |<---aha_latest
|
|
* +----------+ +----------+ +----------+
|
|
*
|
|
* aha_furtherest = sum(Delta[1..n])
|
|
*/
|
|
void
|
|
aha_add_timeout(struct aha_ccb *ccb, int time)
|
|
{
|
|
int timeprev;
|
|
struct aha_ccb *prev;
|
|
int s = splbio();
|
|
|
|
if(prev = aha_latest) /* yes, an assign */
|
|
timeprev = aha_furtherest;
|
|
else
|
|
timeprev = 0;
|
|
|
|
while(prev && (timeprev > time)) {
|
|
timeprev -= prev->delta;
|
|
prev = prev->sooner;
|
|
}
|
|
if(prev) {
|
|
ccb->delta = time - timeprev;
|
|
if( ccb->later = prev->later) {
|
|
ccb->later->sooner = ccb;
|
|
ccb->later->delta -= ccb->delta;
|
|
} else {
|
|
aha_furtherest = time;
|
|
aha_latest = ccb;
|
|
}
|
|
ccb->sooner = prev;
|
|
prev->later = ccb;
|
|
} else {
|
|
if( ccb->later = aha_soonest) {
|
|
ccb->later->sooner = ccb;
|
|
ccb->later->delta -= time;
|
|
} else {
|
|
aha_furtherest = time;
|
|
aha_latest = ccb;
|
|
}
|
|
ccb->delta = time;
|
|
ccb->sooner = (struct aha_ccb *)0;
|
|
aha_soonest = ccb;
|
|
}
|
|
splx(s);
|
|
}
|
|
|
|
void
|
|
aha_remove_timeout(struct aha_ccb *ccb)
|
|
{
|
|
int s = splbio();
|
|
|
|
if(ccb->sooner)
|
|
ccb->sooner->later = ccb->later;
|
|
else
|
|
aha_soonest = ccb->later;
|
|
|
|
if(ccb->later) {
|
|
ccb->later->sooner = ccb->sooner;
|
|
ccb->later->delta += ccb->delta;
|
|
} else {
|
|
aha_latest = ccb->sooner;
|
|
aha_furtherest -= ccb->delta;
|
|
}
|
|
ccb->sooner = ccb->later = (struct aha_ccb *)0;
|
|
splx(s);
|
|
}
|
|
|
|
extern int hz;
|
|
#define ONETICK 500 /* milliseconds */
|
|
#define SLEEPTIME ((hz * 1000) / ONETICK)
|
|
|
|
void
|
|
aha_timeout(int arg)
|
|
{
|
|
struct aha_ccb *ccb;
|
|
int unit;
|
|
int s = splbio();
|
|
|
|
while( ccb = aha_soonest ) {
|
|
if(ccb->delta <= ONETICK) {
|
|
/*
|
|
* It has timed out, we need to do some work
|
|
*/
|
|
unit = ccb->xfer->adapter;
|
|
printf("aha%d: device %d timed out ", unit,
|
|
ccb->xfer->targ);
|
|
|
|
/*
|
|
* Unlink it from the queue
|
|
*/
|
|
aha_remove_timeout(ccb);
|
|
|
|
/*
|
|
* If The ccb's mbx is not free, then
|
|
* the board has gone south
|
|
*/
|
|
if(ccb->mbx->cmd != AHA_MBO_FREE) {
|
|
printf("aha%d not taking commands!\n", unit);
|
|
Debugger();
|
|
}
|
|
/*
|
|
* If it has been through before, then
|
|
* a previous abort has failed, don't
|
|
* try abort again
|
|
*/
|
|
if(ccb->flags == CCB_ABORTED) {
|
|
/* abort timed out */
|
|
printf(" AGAIN\n");
|
|
ccb->xfer->retries = 0; /* I MEAN IT ! */
|
|
ccb->host_stat = AHA_ABORTED;
|
|
aha_done(unit,ccb);
|
|
} else {
|
|
/* abort the operation that has timed out */
|
|
printf("\n");
|
|
aha_abortmbx(ccb->mbx);
|
|
/* 2 secs for the abort */
|
|
aha_add_timeout(ccb,2000 + ONETICK);
|
|
ccb->flags = CCB_ABORTED;
|
|
}
|
|
} else {
|
|
/*
|
|
* It has not timed out, adjust and leave
|
|
*/
|
|
ccb->delta -= ONETICK;
|
|
aha_furtherest -= ONETICK;
|
|
break;
|
|
}
|
|
}
|
|
splx(s);
|
|
timeout((timeout_t)aha_timeout, (caddr_t)arg, SLEEPTIME);
|
|
}
|