| /* | |
| * Generic Macintosh NCR5380 driver | |
| * | |
| * Copyright 1998, Michael Schmitz <mschmitz@lbl.gov> | |
| * | |
| * derived in part from: | |
| */ | |
| /* | |
| * Generic Generic NCR5380 driver | |
| * | |
| * Copyright 1995, Russell King | |
| */ | |
| #include <linux/types.h> | |
| #include <linux/module.h> | |
| #include <linux/ioport.h> | |
| #include <linux/init.h> | |
| #include <linux/blkdev.h> | |
| #include <linux/interrupt.h> | |
| #include <linux/platform_device.h> | |
| #include <asm/hwtest.h> | |
| #include <asm/io.h> | |
| #include <asm/macints.h> | |
| #include <asm/setup.h> | |
| #include <scsi/scsi_host.h> | |
| /* Definitions for the core NCR5380 driver. */ | |
| #define NCR5380_implementation_fields int pdma_residual | |
| #define NCR5380_read(reg) in_8(hostdata->io + ((reg) << 4)) | |
| #define NCR5380_write(reg, value) out_8(hostdata->io + ((reg) << 4), value) | |
| #define NCR5380_dma_xfer_len macscsi_dma_xfer_len | |
| #define NCR5380_dma_recv_setup macscsi_pread | |
| #define NCR5380_dma_send_setup macscsi_pwrite | |
| #define NCR5380_dma_residual macscsi_dma_residual | |
| #define NCR5380_intr macscsi_intr | |
| #define NCR5380_queue_command macscsi_queue_command | |
| #define NCR5380_abort macscsi_abort | |
| #define NCR5380_host_reset macscsi_host_reset | |
| #define NCR5380_info macscsi_info | |
| #include "NCR5380.h" | |
| static int setup_can_queue = -1; | |
| module_param(setup_can_queue, int, 0); | |
| static int setup_cmd_per_lun = -1; | |
| module_param(setup_cmd_per_lun, int, 0); | |
| static int setup_sg_tablesize = -1; | |
| module_param(setup_sg_tablesize, int, 0); | |
| static int setup_use_pdma = -1; | |
| module_param(setup_use_pdma, int, 0); | |
| static int setup_hostid = -1; | |
| module_param(setup_hostid, int, 0); | |
| static int setup_toshiba_delay = -1; | |
| module_param(setup_toshiba_delay, int, 0); | |
| #ifndef MODULE | |
| static int __init mac_scsi_setup(char *str) | |
| { | |
| int ints[8]; | |
| (void)get_options(str, ARRAY_SIZE(ints), ints); | |
| if (ints[0] < 1) { | |
| pr_err("Usage: mac5380=<can_queue>[,<cmd_per_lun>[,<sg_tablesize>[,<hostid>[,<use_tags>[,<use_pdma>[,<toshiba_delay>]]]]]]\n"); | |
| return 0; | |
| } | |
| if (ints[0] >= 1) | |
| setup_can_queue = ints[1]; | |
| if (ints[0] >= 2) | |
| setup_cmd_per_lun = ints[2]; | |
| if (ints[0] >= 3) | |
| setup_sg_tablesize = ints[3]; | |
| if (ints[0] >= 4) | |
| setup_hostid = ints[4]; | |
| /* ints[5] (use_tagged_queuing) is ignored */ | |
| if (ints[0] >= 6) | |
| setup_use_pdma = ints[6]; | |
| if (ints[0] >= 7) | |
| setup_toshiba_delay = ints[7]; | |
| return 1; | |
| } | |
| __setup("mac5380=", mac_scsi_setup); | |
| #endif /* !MODULE */ | |
| /* Pseudo DMA asm originally by Ove Edlund */ | |
| #define CP_IO_TO_MEM(s,d,n) \ | |
| __asm__ __volatile__ \ | |
| (" cmp.w #4,%2\n" \ | |
| " bls 8f\n" \ | |
| " move.w %1,%%d0\n" \ | |
| " neg.b %%d0\n" \ | |
| " and.w #3,%%d0\n" \ | |
| " sub.w %%d0,%2\n" \ | |
| " bra 2f\n" \ | |
| " 1: move.b (%0),(%1)+\n" \ | |
| " 2: dbf %%d0,1b\n" \ | |
| " move.w %2,%%d0\n" \ | |
| " lsr.w #5,%%d0\n" \ | |
| " bra 4f\n" \ | |
| " 3: move.l (%0),(%1)+\n" \ | |
| "31: move.l (%0),(%1)+\n" \ | |
| "32: move.l (%0),(%1)+\n" \ | |
| "33: move.l (%0),(%1)+\n" \ | |
| "34: move.l (%0),(%1)+\n" \ | |
| "35: move.l (%0),(%1)+\n" \ | |
| "36: move.l (%0),(%1)+\n" \ | |
| "37: move.l (%0),(%1)+\n" \ | |
| " 4: dbf %%d0,3b\n" \ | |
| " move.w %2,%%d0\n" \ | |
| " lsr.w #2,%%d0\n" \ | |
| " and.w #7,%%d0\n" \ | |
| " bra 6f\n" \ | |
| " 5: move.l (%0),(%1)+\n" \ | |
| " 6: dbf %%d0,5b\n" \ | |
| " and.w #3,%2\n" \ | |
| " bra 8f\n" \ | |
| " 7: move.b (%0),(%1)+\n" \ | |
| " 8: dbf %2,7b\n" \ | |
| " moveq.l #0, %2\n" \ | |
| " 9: \n" \ | |
| ".section .fixup,\"ax\"\n" \ | |
| " .even\n" \ | |
| "91: moveq.l #1, %2\n" \ | |
| " jra 9b\n" \ | |
| "94: moveq.l #4, %2\n" \ | |
| " jra 9b\n" \ | |
| ".previous\n" \ | |
| ".section __ex_table,\"a\"\n" \ | |
| " .align 4\n" \ | |
| " .long 1b,91b\n" \ | |
| " .long 3b,94b\n" \ | |
| " .long 31b,94b\n" \ | |
| " .long 32b,94b\n" \ | |
| " .long 33b,94b\n" \ | |
| " .long 34b,94b\n" \ | |
| " .long 35b,94b\n" \ | |
| " .long 36b,94b\n" \ | |
| " .long 37b,94b\n" \ | |
| " .long 5b,94b\n" \ | |
| " .long 7b,91b\n" \ | |
| ".previous" \ | |
| : "=a"(s), "=a"(d), "=d"(n) \ | |
| : "0"(s), "1"(d), "2"(n) \ | |
| : "d0") | |
| static inline int macscsi_pread(struct NCR5380_hostdata *hostdata, | |
| unsigned char *dst, int len) | |
| { | |
| u8 __iomem *s = hostdata->pdma_io + (INPUT_DATA_REG << 4); | |
| unsigned char *d = dst; | |
| int n = len; | |
| int transferred; | |
| while (!NCR5380_poll_politely(hostdata, BUS_AND_STATUS_REG, | |
| BASR_DRQ | BASR_PHASE_MATCH, | |
| BASR_DRQ | BASR_PHASE_MATCH, HZ / 64)) { | |
| CP_IO_TO_MEM(s, d, n); | |
| transferred = d - dst - n; | |
| hostdata->pdma_residual = len - transferred; | |
| /* No bus error. */ | |
| if (n == 0) | |
| return 0; | |
| /* Target changed phase early? */ | |
| if (NCR5380_poll_politely2(hostdata, STATUS_REG, SR_REQ, SR_REQ, | |
| BUS_AND_STATUS_REG, BASR_ACK, BASR_ACK, HZ / 64) < 0) | |
| scmd_printk(KERN_ERR, hostdata->connected, | |
| "%s: !REQ and !ACK\n", __func__); | |
| if (!(NCR5380_read(BUS_AND_STATUS_REG) & BASR_PHASE_MATCH)) | |
| return 0; | |
| dsprintk(NDEBUG_PSEUDO_DMA, hostdata->host, | |
| "%s: bus error (%d/%d)\n", __func__, transferred, len); | |
| NCR5380_dprint(NDEBUG_PSEUDO_DMA, hostdata->host); | |
| d = dst + transferred; | |
| n = len - transferred; | |
| } | |
| scmd_printk(KERN_ERR, hostdata->connected, | |
| "%s: phase mismatch or !DRQ\n", __func__); | |
| NCR5380_dprint(NDEBUG_PSEUDO_DMA, hostdata->host); | |
| return -1; | |
| } | |
| #define CP_MEM_TO_IO(s,d,n) \ | |
| __asm__ __volatile__ \ | |
| (" cmp.w #4,%2\n" \ | |
| " bls 8f\n" \ | |
| " move.w %0,%%d0\n" \ | |
| " neg.b %%d0\n" \ | |
| " and.w #3,%%d0\n" \ | |
| " sub.w %%d0,%2\n" \ | |
| " bra 2f\n" \ | |
| " 1: move.b (%0)+,(%1)\n" \ | |
| " 2: dbf %%d0,1b\n" \ | |
| " move.w %2,%%d0\n" \ | |
| " lsr.w #5,%%d0\n" \ | |
| " bra 4f\n" \ | |
| " 3: move.l (%0)+,(%1)\n" \ | |
| "31: move.l (%0)+,(%1)\n" \ | |
| "32: move.l (%0)+,(%1)\n" \ | |
| "33: move.l (%0)+,(%1)\n" \ | |
| "34: move.l (%0)+,(%1)\n" \ | |
| "35: move.l (%0)+,(%1)\n" \ | |
| "36: move.l (%0)+,(%1)\n" \ | |
| "37: move.l (%0)+,(%1)\n" \ | |
| " 4: dbf %%d0,3b\n" \ | |
| " move.w %2,%%d0\n" \ | |
| " lsr.w #2,%%d0\n" \ | |
| " and.w #7,%%d0\n" \ | |
| " bra 6f\n" \ | |
| " 5: move.l (%0)+,(%1)\n" \ | |
| " 6: dbf %%d0,5b\n" \ | |
| " and.w #3,%2\n" \ | |
| " bra 8f\n" \ | |
| " 7: move.b (%0)+,(%1)\n" \ | |
| " 8: dbf %2,7b\n" \ | |
| " moveq.l #0, %2\n" \ | |
| " 9: \n" \ | |
| ".section .fixup,\"ax\"\n" \ | |
| " .even\n" \ | |
| "91: moveq.l #1, %2\n" \ | |
| " jra 9b\n" \ | |
| "94: moveq.l #4, %2\n" \ | |
| " jra 9b\n" \ | |
| ".previous\n" \ | |
| ".section __ex_table,\"a\"\n" \ | |
| " .align 4\n" \ | |
| " .long 1b,91b\n" \ | |
| " .long 3b,94b\n" \ | |
| " .long 31b,94b\n" \ | |
| " .long 32b,94b\n" \ | |
| " .long 33b,94b\n" \ | |
| " .long 34b,94b\n" \ | |
| " .long 35b,94b\n" \ | |
| " .long 36b,94b\n" \ | |
| " .long 37b,94b\n" \ | |
| " .long 5b,94b\n" \ | |
| " .long 7b,91b\n" \ | |
| ".previous" \ | |
| : "=a"(s), "=a"(d), "=d"(n) \ | |
| : "0"(s), "1"(d), "2"(n) \ | |
| : "d0") | |
| static inline int macscsi_pwrite(struct NCR5380_hostdata *hostdata, | |
| unsigned char *src, int len) | |
| { | |
| unsigned char *s = src; | |
| u8 __iomem *d = hostdata->pdma_io + (OUTPUT_DATA_REG << 4); | |
| int n = len; | |
| int transferred; | |
| while (!NCR5380_poll_politely(hostdata, BUS_AND_STATUS_REG, | |
| BASR_DRQ | BASR_PHASE_MATCH, | |
| BASR_DRQ | BASR_PHASE_MATCH, HZ / 64)) { | |
| CP_MEM_TO_IO(s, d, n); | |
| transferred = s - src - n; | |
| hostdata->pdma_residual = len - transferred; | |
| /* Target changed phase early? */ | |
| if (NCR5380_poll_politely2(hostdata, STATUS_REG, SR_REQ, SR_REQ, | |
| BUS_AND_STATUS_REG, BASR_ACK, BASR_ACK, HZ / 64) < 0) | |
| scmd_printk(KERN_ERR, hostdata->connected, | |
| "%s: !REQ and !ACK\n", __func__); | |
| if (!(NCR5380_read(BUS_AND_STATUS_REG) & BASR_PHASE_MATCH)) | |
| return 0; | |
| /* No bus error. */ | |
| if (n == 0) { | |
| if (NCR5380_poll_politely(hostdata, TARGET_COMMAND_REG, | |
| TCR_LAST_BYTE_SENT, | |
| TCR_LAST_BYTE_SENT, HZ / 64) < 0) | |
| scmd_printk(KERN_ERR, hostdata->connected, | |
| "%s: Last Byte Sent timeout\n", __func__); | |
| return 0; | |
| } | |
| dsprintk(NDEBUG_PSEUDO_DMA, hostdata->host, | |
| "%s: bus error (%d/%d)\n", __func__, transferred, len); | |
| NCR5380_dprint(NDEBUG_PSEUDO_DMA, hostdata->host); | |
| s = src + transferred; | |
| n = len - transferred; | |
| } | |
| scmd_printk(KERN_ERR, hostdata->connected, | |
| "%s: phase mismatch or !DRQ\n", __func__); | |
| NCR5380_dprint(NDEBUG_PSEUDO_DMA, hostdata->host); | |
| return -1; | |
| } | |
| static int macscsi_dma_xfer_len(struct NCR5380_hostdata *hostdata, | |
| struct scsi_cmnd *cmd) | |
| { | |
| if (hostdata->flags & FLAG_NO_PSEUDO_DMA || | |
| cmd->SCp.this_residual < 16) | |
| return 0; | |
| return cmd->SCp.this_residual; | |
| } | |
| static int macscsi_dma_residual(struct NCR5380_hostdata *hostdata) | |
| { | |
| return hostdata->pdma_residual; | |
| } | |
| #include "NCR5380.c" | |
| #define DRV_MODULE_NAME "mac_scsi" | |
| #define PFX DRV_MODULE_NAME ": " | |
| static struct scsi_host_template mac_scsi_template = { | |
| .module = THIS_MODULE, | |
| .proc_name = DRV_MODULE_NAME, | |
| .name = "Macintosh NCR5380 SCSI", | |
| .info = macscsi_info, | |
| .queuecommand = macscsi_queue_command, | |
| .eh_abort_handler = macscsi_abort, | |
| .eh_host_reset_handler = macscsi_host_reset, | |
| .can_queue = 16, | |
| .this_id = 7, | |
| .sg_tablesize = 1, | |
| .cmd_per_lun = 2, | |
| .use_clustering = DISABLE_CLUSTERING, | |
| .cmd_size = NCR5380_CMD_SIZE, | |
| .max_sectors = 128, | |
| }; | |
| static int __init mac_scsi_probe(struct platform_device *pdev) | |
| { | |
| struct Scsi_Host *instance; | |
| struct NCR5380_hostdata *hostdata; | |
| int error; | |
| int host_flags = 0; | |
| struct resource *irq, *pio_mem, *pdma_mem = NULL; | |
| pio_mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); | |
| if (!pio_mem) | |
| return -ENODEV; | |
| pdma_mem = platform_get_resource(pdev, IORESOURCE_MEM, 1); | |
| irq = platform_get_resource(pdev, IORESOURCE_IRQ, 0); | |
| if (!hwreg_present((unsigned char *)pio_mem->start + | |
| (STATUS_REG << 4))) { | |
| pr_info(PFX "no device detected at %pap\n", &pio_mem->start); | |
| return -ENODEV; | |
| } | |
| if (setup_can_queue > 0) | |
| mac_scsi_template.can_queue = setup_can_queue; | |
| if (setup_cmd_per_lun > 0) | |
| mac_scsi_template.cmd_per_lun = setup_cmd_per_lun; | |
| if (setup_sg_tablesize >= 0) | |
| mac_scsi_template.sg_tablesize = setup_sg_tablesize; | |
| if (setup_hostid >= 0) | |
| mac_scsi_template.this_id = setup_hostid & 7; | |
| instance = scsi_host_alloc(&mac_scsi_template, | |
| sizeof(struct NCR5380_hostdata)); | |
| if (!instance) | |
| return -ENOMEM; | |
| if (irq) | |
| instance->irq = irq->start; | |
| else | |
| instance->irq = NO_IRQ; | |
| hostdata = shost_priv(instance); | |
| hostdata->base = pio_mem->start; | |
| hostdata->io = (u8 __iomem *)pio_mem->start; | |
| if (pdma_mem && setup_use_pdma) | |
| hostdata->pdma_io = (u8 __iomem *)pdma_mem->start; | |
| else | |
| host_flags |= FLAG_NO_PSEUDO_DMA; | |
| host_flags |= setup_toshiba_delay > 0 ? FLAG_TOSHIBA_DELAY : 0; | |
| error = NCR5380_init(instance, host_flags | FLAG_LATE_DMA_SETUP); | |
| if (error) | |
| goto fail_init; | |
| if (instance->irq != NO_IRQ) { | |
| error = request_irq(instance->irq, macscsi_intr, IRQF_SHARED, | |
| "NCR5380", instance); | |
| if (error) | |
| goto fail_irq; | |
| } | |
| NCR5380_maybe_reset_bus(instance); | |
| error = scsi_add_host(instance, NULL); | |
| if (error) | |
| goto fail_host; | |
| platform_set_drvdata(pdev, instance); | |
| scsi_scan_host(instance); | |
| return 0; | |
| fail_host: | |
| if (instance->irq != NO_IRQ) | |
| free_irq(instance->irq, instance); | |
| fail_irq: | |
| NCR5380_exit(instance); | |
| fail_init: | |
| scsi_host_put(instance); | |
| return error; | |
| } | |
| static int __exit mac_scsi_remove(struct platform_device *pdev) | |
| { | |
| struct Scsi_Host *instance = platform_get_drvdata(pdev); | |
| scsi_remove_host(instance); | |
| if (instance->irq != NO_IRQ) | |
| free_irq(instance->irq, instance); | |
| NCR5380_exit(instance); | |
| scsi_host_put(instance); | |
| return 0; | |
| } | |
| static struct platform_driver mac_scsi_driver = { | |
| .remove = __exit_p(mac_scsi_remove), | |
| .driver = { | |
| .name = DRV_MODULE_NAME, | |
| }, | |
| }; | |
| module_platform_driver_probe(mac_scsi_driver, mac_scsi_probe); | |
| MODULE_ALIAS("platform:" DRV_MODULE_NAME); | |
| MODULE_LICENSE("GPL"); |