123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677 |
- #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.h"
- #include <scsi/scsi_host.h>
- #include "aha1740.h"
- #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,
- du:1,
- :1, qf:1,
- sc:1,
- dor:1,
- ch:1,
- intr:1,
- asa:1,
- sns:1,
- :1, ini:1,
- me:1,
- :1, eca:1,
- :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) {
- if ( (status[1]&0x18) || status_word.sc ) {
-
-
- switch ( status[2] ) {
- case 0x12:
- if ( status_word.dor )
- retval=DID_ERROR;
-
- case 0x00:
- break;
- case 0x11:
- case 0x21:
- retval=DID_TIME_OUT;
- break;
- case 0x0a:
- retval=DID_BAD_TARGET;
- break;
- case 0x04:
- case 0x05:
- retval=DID_ABORT;
-
- break;
- default:
- retval=DID_ERROR;
- }
- } else {
-
- if ( status_word.qf ) {
- retval = DID_TIME_OUT;
-
- printk("aha1740.c: WARNING: AHA1740 queue overflow!\n");
- } else
- if ( status[0]&0x60 ) {
-
- retval = DID_ERROR;
- }
-
- }
- }
-
- return status[3] | retval << 16;
- }
- static int aha1740_test_port(unsigned int base)
- {
- if ( inb(PORTADR(base)) & PORTADDR_ENH )
- return 1;
-
- printk("aha174x: Board detected, but not in enhanced mode, so disabled it.\n");
- return 0;
- }
- static irqreturn_t aha1740_intr_handle(int irq, void *dev_id)
- {
- struct Scsi_Host *host = (struct Scsi_Host *) dev_id;
- void (*my_done)(Scsi_Cmnd *);
- int errstatus, adapstat;
- int number_serviced;
- struct ecb *ecbptr;
- 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));
-
- switch ( adapstat & G2INTST_MASK ) {
- case G2INTST_CCBRETRY:
- case G2INTST_CCBERROR:
- case G2INTST_CCBGOOD:
-
- 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);
-
- dma_free_coherent (&edev->dev,
- sizeof (struct aha1740_sg),
- SCtmp->host_scribble,
- sgptr->sg_dma_addr);
-
-
- if ( (adapstat & G2INTST_MASK) == G2INTST_CCBERROR ) {
- memcpy(SCtmp->sense_buffer, ecbptr->sense,
- SCSI_SENSE_BUFFERSIZE);
- 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");
-
- 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)));
-
- outb(G2CNTRL_HRDY,G2CNTRL(base));
- break;
-
- case G2INTST_CMDGOOD:
-
- break;
-
- case G2INTST_CMDERROR:
-
- break;
- }
- number_serviced++;
- }
- spin_unlock_irqrestore(host->host_lock, flags);
- return IRQ_RETVAL(handled);
- }
- static int aha1740_queuecommand_lck(Scsi_Cmnd * SCpnt, void (*done)(Scsi_Cmnd *))
- {
- 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
-
- spin_lock_irqsave(SCpnt->device->host->host_lock, flags);
- ecbno = host->last_ecb_used + 1;
- 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;
- 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;
- 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;
- 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;
- host->ecb[ecbno].dir = direction;
- host->ecb[ecbno].ars = 1;
- 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) {
-
- #define LOOPCNT_WARN 10
- #define LOOPCNT_MAX 1000000
- 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));
- 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)
- 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 (Scsi_Cmnd *dummy)
- {
- 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,
- .use_clustering = ENABLE_CLUSTERING,
- .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"))
- 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) {
-
- 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");
- scsi_unregister (shpnt);
- 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" },
- { "ADP0001" },
- { "ADP0002" },
- { "ADP0400" },
- { "" }
- };
- 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");
|