mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
684 lines
19 KiB
684 lines
19 KiB
/* $Id$ |
|
* 1993/03/31 |
|
* linux/kernel/aha1740.c |
|
* |
|
* Based loosely on aha1542.c which is |
|
* Copyright (C) 1992 Tommy Thorn and |
|
* Modified by Eric Youngdale |
|
* |
|
* This file is aha1740.c, written and |
|
* Copyright (C) 1992,1993 Brad McLean |
|
* [email protected] or [email protected]. |
|
* |
|
* Modifications to makecode and queuecommand |
|
* for proper handling of multiple devices courteously |
|
* provided by Michael Weller, March, 1993 |
|
* |
|
* Multiple adapter support, extended translation detection, |
|
* update to current scsi subsystem changes, proc fs support, |
|
* working (!) module support based on patches from Andreas Arens, |
|
* by Andreas Degert <[email protected]>, 2/1997 |
|
* |
|
* aha1740_makecode may still need even more work |
|
* if it doesn't work for your devices, take a look. |
|
* |
|
* Reworked for new_eh and new locking by Alan Cox <[email protected]> |
|
* |
|
* Converted to EISA and generic DMA APIs by Marc Zyngier |
|
* <[email protected]>, 4/2003. |
|
* |
|
* Shared interrupt support added by Rask Ingemann Lambertsen |
|
* <[email protected]>, 10/2003 |
|
* |
|
* For the avoidance of doubt the "preferred form" of this code is one which |
|
* is in an open non patent encumbered format. Where cryptographic key signing |
|
* forms part of the process of creating an executable the information |
|
* including keys needed to generate an equivalently functional executable |
|
* are deemed to be part of the source code. |
|
*/ |
|
|
|
#include <linux/blkdev.h> |
|
#include <linux/interrupt.h> |
|
#include <linux/module.h> |
|
#include <linux/kernel.h> |
|
#include <linux/types.h> |
|
#include <linux/string.h> |
|
#include <linux/ioport.h> |
|
#include <linux/proc_fs.h> |
|
#include <linux/stat.h> |
|
#include <linux/init.h> |
|
#include <linux/device.h> |
|
#include <linux/eisa.h> |
|
#include <linux/dma-mapping.h> |
|
#include <linux/gfp.h> |
|
|
|
#include <asm/dma.h> |
|
#include <asm/io.h> |
|
|
|
#include <scsi/scsi.h> |
|
#include <scsi/scsi_cmnd.h> |
|
#include <scsi/scsi_device.h> |
|
#include <scsi/scsi_eh.h> |
|
#include <scsi/scsi_host.h> |
|
#include <scsi/scsi_tcq.h> |
|
#include "aha1740.h" |
|
|
|
/* IF YOU ARE HAVING PROBLEMS WITH THIS DRIVER, AND WANT TO WATCH |
|
IT WORK, THEN: |
|
#define DEBUG |
|
*/ |
|
#ifdef DEBUG |
|
#define DEB(x) x |
|
#else |
|
#define DEB(x) |
|
#endif |
|
|
|
struct aha1740_hostdata { |
|
struct eisa_device *edev; |
|
unsigned int translation; |
|
unsigned int last_ecb_used; |
|
dma_addr_t ecb_dma_addr; |
|
struct ecb ecb[AHA1740_ECBS]; |
|
}; |
|
|
|
struct aha1740_sg { |
|
struct aha1740_chain sg_chain[AHA1740_SCATTER]; |
|
dma_addr_t sg_dma_addr; |
|
dma_addr_t buf_dma_addr; |
|
}; |
|
|
|
#define HOSTDATA(host) ((struct aha1740_hostdata *) &host->hostdata) |
|
|
|
static inline struct ecb *ecb_dma_to_cpu (struct Scsi_Host *host, |
|
dma_addr_t dma) |
|
{ |
|
struct aha1740_hostdata *hdata = HOSTDATA (host); |
|
dma_addr_t offset; |
|
|
|
offset = dma - hdata->ecb_dma_addr; |
|
|
|
return (struct ecb *)(((char *) hdata->ecb) + (unsigned int) offset); |
|
} |
|
|
|
static inline dma_addr_t ecb_cpu_to_dma (struct Scsi_Host *host, void *cpu) |
|
{ |
|
struct aha1740_hostdata *hdata = HOSTDATA (host); |
|
dma_addr_t offset; |
|
|
|
offset = (char *) cpu - (char *) hdata->ecb; |
|
|
|
return hdata->ecb_dma_addr + offset; |
|
} |
|
|
|
static int aha1740_show_info(struct seq_file *m, struct Scsi_Host *shpnt) |
|
{ |
|
struct aha1740_hostdata *host = HOSTDATA(shpnt); |
|
seq_printf(m, "aha174x at IO:%lx, IRQ %d, SLOT %d.\n" |
|
"Extended translation %sabled.\n", |
|
shpnt->io_port, shpnt->irq, host->edev->slot, |
|
host->translation ? "en" : "dis"); |
|
return 0; |
|
} |
|
|
|
static int aha1740_makecode(unchar *sense, unchar *status) |
|
{ |
|
struct statusword |
|
{ |
|
ushort don:1, /* Command Done - No Error */ |
|
du:1, /* Data underrun */ |
|
:1, qf:1, /* Queue full */ |
|
sc:1, /* Specification Check */ |
|
dor:1, /* Data overrun */ |
|
ch:1, /* Chaining Halted */ |
|
intr:1, /* Interrupt issued */ |
|
asa:1, /* Additional Status Available */ |
|
sns:1, /* Sense information Stored */ |
|
:1, ini:1, /* Initialization Required */ |
|
me:1, /* Major error or exception */ |
|
:1, eca:1, /* Extended Contingent alliance */ |
|
:1; |
|
} status_word; |
|
int retval = DID_OK; |
|
|
|
status_word = * (struct statusword *) status; |
|
#ifdef DEBUG |
|
printk("makecode from %x,%x,%x,%x %x,%x,%x,%x", |
|
status[0], status[1], status[2], status[3], |
|
sense[0], sense[1], sense[2], sense[3]); |
|
#endif |
|
if (!status_word.don) { /* Anything abnormal was detected */ |
|
if ( (status[1]&0x18) || status_word.sc ) { |
|
/*Additional info available*/ |
|
/* Use the supplied info for further diagnostics */ |
|
switch ( status[2] ) { |
|
case 0x12: |
|
if ( status_word.dor ) |
|
retval=DID_ERROR; /* It's an Overrun */ |
|
/* If not overrun, assume underrun and |
|
* ignore it! */ |
|
break; |
|
case 0x00: /* No info, assume no error, should |
|
* not occur */ |
|
break; |
|
case 0x11: |
|
case 0x21: |
|
retval=DID_TIME_OUT; |
|
break; |
|
case 0x0a: |
|
retval=DID_BAD_TARGET; |
|
break; |
|
case 0x04: |
|
case 0x05: |
|
retval=DID_ABORT; |
|
/* Either by this driver or the |
|
* AHA1740 itself */ |
|
break; |
|
default: |
|
retval=DID_ERROR; /* No further |
|
* diagnostics |
|
* possible */ |
|
} |
|
} else { |
|
/* Michael suggests, and Brad concurs: */ |
|
if ( status_word.qf ) { |
|
retval = DID_TIME_OUT; /* forces a redo */ |
|
/* I think this specific one should |
|
* not happen -Brad */ |
|
printk("aha1740.c: WARNING: AHA1740 queue overflow!\n"); |
|
} else |
|
if ( status[0]&0x60 ) { |
|
/* Didn't find a better error */ |
|
retval = DID_ERROR; |
|
} |
|
/* In any other case return DID_OK so for example |
|
CONDITION_CHECKS make it through to the appropriate |
|
device driver */ |
|
} |
|
} |
|
/* Under all circumstances supply the target status -Michael */ |
|
return status[3] | retval << 16; |
|
} |
|
|
|
static int aha1740_test_port(unsigned int base) |
|
{ |
|
if ( inb(PORTADR(base)) & PORTADDR_ENH ) |
|
return 1; /* Okay, we're all set */ |
|
|
|
printk("aha174x: Board detected, but not in enhanced mode, so disabled it.\n"); |
|
return 0; |
|
} |
|
|
|
/* A "high" level interrupt handler */ |
|
static irqreturn_t aha1740_intr_handle(int irq, void *dev_id) |
|
{ |
|
struct Scsi_Host *host = (struct Scsi_Host *) dev_id; |
|
void (*my_done)(struct scsi_cmnd *); |
|
int errstatus, adapstat; |
|
int number_serviced; |
|
struct ecb *ecbptr; |
|
struct scsi_cmnd *SCtmp; |
|
unsigned int base; |
|
unsigned long flags; |
|
int handled = 0; |
|
struct aha1740_sg *sgptr; |
|
struct eisa_device *edev; |
|
|
|
if (!host) |
|
panic("aha1740.c: Irq from unknown host!\n"); |
|
spin_lock_irqsave(host->host_lock, flags); |
|
base = host->io_port; |
|
number_serviced = 0; |
|
edev = HOSTDATA(host)->edev; |
|
|
|
while(inb(G2STAT(base)) & G2STAT_INTPEND) { |
|
handled = 1; |
|
DEB(printk("aha1740_intr top of loop.\n")); |
|
adapstat = inb(G2INTST(base)); |
|
ecbptr = ecb_dma_to_cpu (host, inl(MBOXIN0(base))); |
|
outb(G2CNTRL_IRST,G2CNTRL(base)); /* interrupt reset */ |
|
|
|
switch ( adapstat & G2INTST_MASK ) { |
|
case G2INTST_CCBRETRY: |
|
case G2INTST_CCBERROR: |
|
case G2INTST_CCBGOOD: |
|
/* Host Ready -> Mailbox in complete */ |
|
outb(G2CNTRL_HRDY,G2CNTRL(base)); |
|
if (!ecbptr) { |
|
printk("Aha1740 null ecbptr in interrupt (%x,%x,%x,%d)\n", |
|
inb(G2STAT(base)),adapstat, |
|
inb(G2INTST(base)), number_serviced++); |
|
continue; |
|
} |
|
SCtmp = ecbptr->SCpnt; |
|
if (!SCtmp) { |
|
printk("Aha1740 null SCtmp in interrupt (%x,%x,%x,%d)\n", |
|
inb(G2STAT(base)),adapstat, |
|
inb(G2INTST(base)), number_serviced++); |
|
continue; |
|
} |
|
sgptr = (struct aha1740_sg *) SCtmp->host_scribble; |
|
scsi_dma_unmap(SCtmp); |
|
|
|
/* Free the sg block */ |
|
dma_free_coherent (&edev->dev, |
|
sizeof (struct aha1740_sg), |
|
SCtmp->host_scribble, |
|
sgptr->sg_dma_addr); |
|
|
|
/* Fetch the sense data, and tuck it away, in |
|
the required slot. The Adaptec |
|
automatically fetches it, and there is no |
|
guarantee that we will still have it in the |
|
cdb when we come back */ |
|
if ( (adapstat & G2INTST_MASK) == G2INTST_CCBERROR ) { |
|
memcpy_and_pad(SCtmp->sense_buffer, |
|
SCSI_SENSE_BUFFERSIZE, |
|
ecbptr->sense, |
|
sizeof(ecbptr->sense), |
|
0); |
|
errstatus = aha1740_makecode(ecbptr->sense,ecbptr->status); |
|
} else |
|
errstatus = 0; |
|
DEB(if (errstatus) |
|
printk("aha1740_intr_handle: returning %6x\n", |
|
errstatus)); |
|
SCtmp->result = errstatus; |
|
my_done = ecbptr->done; |
|
memset(ecbptr,0,sizeof(struct ecb)); |
|
if ( my_done ) |
|
my_done(SCtmp); |
|
break; |
|
|
|
case G2INTST_HARDFAIL: |
|
printk(KERN_ALERT "aha1740 hardware failure!\n"); |
|
panic("aha1740.c"); /* Goodbye */ |
|
|
|
case G2INTST_ASNEVENT: |
|
printk("aha1740 asynchronous event: %02x %02x %02x %02x %02x\n", |
|
adapstat, |
|
inb(MBOXIN0(base)), |
|
inb(MBOXIN1(base)), |
|
inb(MBOXIN2(base)), |
|
inb(MBOXIN3(base))); /* Say What? */ |
|
/* Host Ready -> Mailbox in complete */ |
|
outb(G2CNTRL_HRDY,G2CNTRL(base)); |
|
break; |
|
|
|
case G2INTST_CMDGOOD: |
|
/* set immediate command success flag here: */ |
|
break; |
|
|
|
case G2INTST_CMDERROR: |
|
/* Set immediate command failure flag here: */ |
|
break; |
|
} |
|
number_serviced++; |
|
} |
|
|
|
spin_unlock_irqrestore(host->host_lock, flags); |
|
return IRQ_RETVAL(handled); |
|
} |
|
|
|
static int aha1740_queuecommand_lck(struct scsi_cmnd *SCpnt) |
|
{ |
|
void (*done)(struct scsi_cmnd *) = scsi_done; |
|
unchar direction; |
|
unchar *cmd = (unchar *) SCpnt->cmnd; |
|
unchar target = scmd_id(SCpnt); |
|
struct aha1740_hostdata *host = HOSTDATA(SCpnt->device->host); |
|
unsigned long flags; |
|
dma_addr_t sg_dma; |
|
struct aha1740_sg *sgptr; |
|
int ecbno, nseg; |
|
DEB(int i); |
|
|
|
if(*cmd == REQUEST_SENSE) { |
|
SCpnt->result = 0; |
|
done(SCpnt); |
|
return 0; |
|
} |
|
|
|
#ifdef DEBUG |
|
if (*cmd == READ_10 || *cmd == WRITE_10) |
|
i = xscsi2int(cmd+2); |
|
else if (*cmd == READ_6 || *cmd == WRITE_6) |
|
i = scsi2int(cmd+2); |
|
else |
|
i = -1; |
|
printk("aha1740_queuecommand: dev %d cmd %02x pos %d len %d ", |
|
target, *cmd, i, bufflen); |
|
printk("scsi cmd:"); |
|
for (i = 0; i < SCpnt->cmd_len; i++) printk("%02x ", cmd[i]); |
|
printk("\n"); |
|
#endif |
|
|
|
/* locate an available ecb */ |
|
spin_lock_irqsave(SCpnt->device->host->host_lock, flags); |
|
ecbno = host->last_ecb_used + 1; /* An optimization */ |
|
if (ecbno >= AHA1740_ECBS) |
|
ecbno = 0; |
|
do { |
|
if (!host->ecb[ecbno].cmdw) |
|
break; |
|
ecbno++; |
|
if (ecbno >= AHA1740_ECBS) |
|
ecbno = 0; |
|
} while (ecbno != host->last_ecb_used); |
|
|
|
if (host->ecb[ecbno].cmdw) |
|
panic("Unable to find empty ecb for aha1740.\n"); |
|
|
|
host->ecb[ecbno].cmdw = AHA1740CMD_INIT; /* SCSI Initiator Command |
|
doubles as reserved flag */ |
|
|
|
host->last_ecb_used = ecbno; |
|
spin_unlock_irqrestore(SCpnt->device->host->host_lock, flags); |
|
|
|
#ifdef DEBUG |
|
printk("Sending command (%d %x)...", ecbno, done); |
|
#endif |
|
|
|
host->ecb[ecbno].cdblen = SCpnt->cmd_len; /* SCSI Command |
|
* Descriptor Block |
|
* Length */ |
|
|
|
direction = 0; |
|
if (*cmd == READ_10 || *cmd == READ_6) |
|
direction = 1; |
|
else if (*cmd == WRITE_10 || *cmd == WRITE_6) |
|
direction = 0; |
|
|
|
memcpy(host->ecb[ecbno].cdb, cmd, SCpnt->cmd_len); |
|
|
|
SCpnt->host_scribble = dma_alloc_coherent (&host->edev->dev, |
|
sizeof (struct aha1740_sg), |
|
&sg_dma, GFP_ATOMIC); |
|
if(SCpnt->host_scribble == NULL) { |
|
printk(KERN_WARNING "aha1740: out of memory in queuecommand!\n"); |
|
return 1; |
|
} |
|
sgptr = (struct aha1740_sg *) SCpnt->host_scribble; |
|
sgptr->sg_dma_addr = sg_dma; |
|
|
|
nseg = scsi_dma_map(SCpnt); |
|
BUG_ON(nseg < 0); |
|
if (nseg) { |
|
struct scatterlist *sg; |
|
struct aha1740_chain * cptr; |
|
int i; |
|
DEB(unsigned char * ptr); |
|
|
|
host->ecb[ecbno].sg = 1; /* SCSI Initiator Command |
|
* w/scatter-gather*/ |
|
cptr = sgptr->sg_chain; |
|
scsi_for_each_sg(SCpnt, sg, nseg, i) { |
|
cptr[i].datalen = sg_dma_len (sg); |
|
cptr[i].dataptr = sg_dma_address (sg); |
|
} |
|
host->ecb[ecbno].datalen = nseg * sizeof(struct aha1740_chain); |
|
host->ecb[ecbno].dataptr = sg_dma; |
|
#ifdef DEBUG |
|
printk("cptr %x: ",cptr); |
|
ptr = (unsigned char *) cptr; |
|
for(i=0;i<24;i++) printk("%02x ", ptr[i]); |
|
#endif |
|
} else { |
|
host->ecb[ecbno].datalen = 0; |
|
host->ecb[ecbno].dataptr = 0; |
|
} |
|
host->ecb[ecbno].lun = SCpnt->device->lun; |
|
host->ecb[ecbno].ses = 1; /* Suppress underrun errors */ |
|
host->ecb[ecbno].dir = direction; |
|
host->ecb[ecbno].ars = 1; /* Yes, get the sense on an error */ |
|
host->ecb[ecbno].senselen = 12; |
|
host->ecb[ecbno].senseptr = ecb_cpu_to_dma (SCpnt->device->host, |
|
host->ecb[ecbno].sense); |
|
host->ecb[ecbno].statusptr = ecb_cpu_to_dma (SCpnt->device->host, |
|
host->ecb[ecbno].status); |
|
host->ecb[ecbno].done = done; |
|
host->ecb[ecbno].SCpnt = SCpnt; |
|
#ifdef DEBUG |
|
{ |
|
int i; |
|
printk("aha1740_command: sending.. "); |
|
for (i = 0; i < sizeof(host->ecb[ecbno]) - 10; i++) |
|
printk("%02x ", ((unchar *)&host->ecb[ecbno])[i]); |
|
} |
|
printk("\n"); |
|
#endif |
|
if (done) { |
|
/* The Adaptec Spec says the card is so fast that the loops |
|
will only be executed once in the code below. Even if this |
|
was true with the fastest processors when the spec was |
|
written, it doesn't seem to be true with today's fast |
|
processors. We print a warning if the code is executed more |
|
often than LOOPCNT_WARN. If this happens, it should be |
|
investigated. If the count reaches LOOPCNT_MAX, we assume |
|
something is broken; since there is no way to return an |
|
error (the return value is ignored by the mid-level scsi |
|
layer) we have to panic (and maybe that's the best thing we |
|
can do then anyhow). */ |
|
|
|
#define LOOPCNT_WARN 10 /* excessive mbxout wait -> syslog-msg */ |
|
#define LOOPCNT_MAX 1000000 /* mbxout deadlock -> panic() after ~ 2 sec. */ |
|
int loopcnt; |
|
unsigned int base = SCpnt->device->host->io_port; |
|
DEB(printk("aha1740[%d] critical section\n",ecbno)); |
|
|
|
spin_lock_irqsave(SCpnt->device->host->host_lock, flags); |
|
for (loopcnt = 0; ; loopcnt++) { |
|
if (inb(G2STAT(base)) & G2STAT_MBXOUT) break; |
|
if (loopcnt == LOOPCNT_WARN) { |
|
printk("aha1740[%d]_mbxout wait!\n",ecbno); |
|
} |
|
if (loopcnt == LOOPCNT_MAX) |
|
panic("aha1740.c: mbxout busy!\n"); |
|
} |
|
outl (ecb_cpu_to_dma (SCpnt->device->host, host->ecb + ecbno), |
|
MBOXOUT0(base)); |
|
for (loopcnt = 0; ; loopcnt++) { |
|
if (! (inb(G2STAT(base)) & G2STAT_BUSY)) break; |
|
if (loopcnt == LOOPCNT_WARN) { |
|
printk("aha1740[%d]_attn wait!\n",ecbno); |
|
} |
|
if (loopcnt == LOOPCNT_MAX) |
|
panic("aha1740.c: attn wait failed!\n"); |
|
} |
|
outb(ATTN_START | (target & 7), ATTN(base)); /* Start it up */ |
|
spin_unlock_irqrestore(SCpnt->device->host->host_lock, flags); |
|
DEB(printk("aha1740[%d] request queued.\n",ecbno)); |
|
} else |
|
printk(KERN_ALERT "aha1740_queuecommand: done can't be NULL\n"); |
|
return 0; |
|
} |
|
|
|
static DEF_SCSI_QCMD(aha1740_queuecommand) |
|
|
|
/* Query the board for its irq_level and irq_type. Nothing else matters |
|
in enhanced mode on an EISA bus. */ |
|
|
|
static void aha1740_getconfig(unsigned int base, unsigned int *irq_level, |
|
unsigned int *irq_type, |
|
unsigned int *translation) |
|
{ |
|
static int intab[] = { 9, 10, 11, 12, 0, 14, 15, 0 }; |
|
|
|
*irq_level = intab[inb(INTDEF(base)) & 0x7]; |
|
*irq_type = (inb(INTDEF(base)) & 0x8) >> 3; |
|
*translation = inb(RESV1(base)) & 0x1; |
|
outb(inb(INTDEF(base)) | 0x10, INTDEF(base)); |
|
} |
|
|
|
static int aha1740_biosparam(struct scsi_device *sdev, |
|
struct block_device *dev, |
|
sector_t capacity, int* ip) |
|
{ |
|
int size = capacity; |
|
int extended = HOSTDATA(sdev->host)->translation; |
|
|
|
DEB(printk("aha1740_biosparam\n")); |
|
if (extended && (ip[2] > 1024)) { |
|
ip[0] = 255; |
|
ip[1] = 63; |
|
ip[2] = size / (255 * 63); |
|
} else { |
|
ip[0] = 64; |
|
ip[1] = 32; |
|
ip[2] = size >> 11; |
|
} |
|
return 0; |
|
} |
|
|
|
static int aha1740_eh_abort_handler (struct scsi_cmnd *dummy) |
|
{ |
|
/* |
|
* From Alan Cox : |
|
* The AHA1740 has firmware handled abort/reset handling. The "head in |
|
* sand" kernel code is correct for once 8) |
|
* |
|
* So we define a dummy handler just to keep the kernel SCSI code as |
|
* quiet as possible... |
|
*/ |
|
|
|
return SUCCESS; |
|
} |
|
|
|
static struct scsi_host_template aha1740_template = { |
|
.module = THIS_MODULE, |
|
.proc_name = "aha1740", |
|
.show_info = aha1740_show_info, |
|
.name = "Adaptec 174x (EISA)", |
|
.queuecommand = aha1740_queuecommand, |
|
.bios_param = aha1740_biosparam, |
|
.can_queue = AHA1740_ECBS, |
|
.this_id = 7, |
|
.sg_tablesize = AHA1740_SCATTER, |
|
.eh_abort_handler = aha1740_eh_abort_handler, |
|
}; |
|
|
|
static int aha1740_probe (struct device *dev) |
|
{ |
|
int slotbase, rc; |
|
unsigned int irq_level, irq_type, translation; |
|
struct Scsi_Host *shpnt; |
|
struct aha1740_hostdata *host; |
|
struct eisa_device *edev = to_eisa_device (dev); |
|
|
|
DEB(printk("aha1740_probe: \n")); |
|
|
|
slotbase = edev->base_addr + EISA_VENDOR_ID_OFFSET; |
|
if (!request_region(slotbase, SLOTSIZE, "aha1740")) /* See if in use */ |
|
return -EBUSY; |
|
if (!aha1740_test_port(slotbase)) |
|
goto err_release_region; |
|
aha1740_getconfig(slotbase,&irq_level,&irq_type,&translation); |
|
if ((inb(G2STAT(slotbase)) & |
|
(G2STAT_MBXOUT|G2STAT_BUSY)) != G2STAT_MBXOUT) { |
|
/* If the card isn't ready, hard reset it */ |
|
outb(G2CNTRL_HRST, G2CNTRL(slotbase)); |
|
outb(0, G2CNTRL(slotbase)); |
|
} |
|
printk(KERN_INFO "Configuring slot %d at IO:%x, IRQ %u (%s)\n", |
|
edev->slot, slotbase, irq_level, irq_type ? "edge" : "level"); |
|
printk(KERN_INFO "aha174x: Extended translation %sabled.\n", |
|
translation ? "en" : "dis"); |
|
shpnt = scsi_host_alloc(&aha1740_template, |
|
sizeof(struct aha1740_hostdata)); |
|
if(shpnt == NULL) |
|
goto err_release_region; |
|
|
|
shpnt->base = 0; |
|
shpnt->io_port = slotbase; |
|
shpnt->n_io_port = SLOTSIZE; |
|
shpnt->irq = irq_level; |
|
shpnt->dma_channel = 0xff; |
|
host = HOSTDATA(shpnt); |
|
host->edev = edev; |
|
host->translation = translation; |
|
host->ecb_dma_addr = dma_map_single (&edev->dev, host->ecb, |
|
sizeof (host->ecb), |
|
DMA_BIDIRECTIONAL); |
|
if (!host->ecb_dma_addr) { |
|
printk (KERN_ERR "aha1740_probe: Couldn't map ECB, giving up\n"); |
|
goto err_host_put; |
|
} |
|
|
|
DEB(printk("aha1740_probe: enable interrupt channel %d\n",irq_level)); |
|
if (request_irq(irq_level,aha1740_intr_handle,irq_type ? 0 : IRQF_SHARED, |
|
"aha1740",shpnt)) { |
|
printk(KERN_ERR "aha1740_probe: Unable to allocate IRQ %d.\n", |
|
irq_level); |
|
goto err_unmap; |
|
} |
|
|
|
eisa_set_drvdata (edev, shpnt); |
|
|
|
rc = scsi_add_host (shpnt, dev); |
|
if (rc) |
|
goto err_irq; |
|
|
|
scsi_scan_host (shpnt); |
|
return 0; |
|
|
|
err_irq: |
|
free_irq(irq_level, shpnt); |
|
err_unmap: |
|
dma_unmap_single (&edev->dev, host->ecb_dma_addr, |
|
sizeof (host->ecb), DMA_BIDIRECTIONAL); |
|
err_host_put: |
|
scsi_host_put (shpnt); |
|
err_release_region: |
|
release_region(slotbase, SLOTSIZE); |
|
|
|
return -ENODEV; |
|
} |
|
|
|
static int aha1740_remove (struct device *dev) |
|
{ |
|
struct Scsi_Host *shpnt = dev_get_drvdata(dev); |
|
struct aha1740_hostdata *host = HOSTDATA (shpnt); |
|
|
|
scsi_remove_host(shpnt); |
|
|
|
free_irq (shpnt->irq, shpnt); |
|
dma_unmap_single (dev, host->ecb_dma_addr, |
|
sizeof (host->ecb), DMA_BIDIRECTIONAL); |
|
release_region (shpnt->io_port, SLOTSIZE); |
|
|
|
scsi_host_put (shpnt); |
|
|
|
return 0; |
|
} |
|
|
|
static struct eisa_device_id aha1740_ids[] = { |
|
{ "ADP0000" }, /* 1740 */ |
|
{ "ADP0001" }, /* 1740A */ |
|
{ "ADP0002" }, /* 1742A */ |
|
{ "ADP0400" }, /* 1744 */ |
|
{ "" } |
|
}; |
|
MODULE_DEVICE_TABLE(eisa, aha1740_ids); |
|
|
|
static struct eisa_driver aha1740_driver = { |
|
.id_table = aha1740_ids, |
|
.driver = { |
|
.name = "aha1740", |
|
.probe = aha1740_probe, |
|
.remove = aha1740_remove, |
|
}, |
|
}; |
|
|
|
static __init int aha1740_init (void) |
|
{ |
|
return eisa_driver_register (&aha1740_driver); |
|
} |
|
|
|
static __exit void aha1740_exit (void) |
|
{ |
|
eisa_driver_unregister (&aha1740_driver); |
|
} |
|
|
|
module_init (aha1740_init); |
|
module_exit (aha1740_exit); |
|
|
|
MODULE_LICENSE("GPL");
|
|
|