305 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2#include <linux/types.h>3#include <linux/init.h>4#include <linux/interrupt.h>5#include <linux/mm.h>6#include <linux/slab.h>7#include <linux/spinlock.h>8#include <linux/zorro.h>9#include <linux/module.h>10 11#include <asm/page.h>12#include <asm/amigaints.h>13#include <asm/amigahw.h>14 15#include <scsi/scsi.h>16#include <scsi/scsi_cmnd.h>17#include <scsi/scsi_device.h>18#include <scsi/scsi_eh.h>19#include <scsi/scsi_tcq.h>20#include "wd33c93.h"21#include "a2091.h"22 23 24struct a2091_hostdata {25 struct WD33C93_hostdata wh;26 struct a2091_scsiregs *regs;27 struct device *dev;28};29 30#define DMA_DIR(d) ((d == DATA_OUT_DIR) ? DMA_TO_DEVICE : DMA_FROM_DEVICE)31 32static irqreturn_t a2091_intr(int irq, void *data)33{34 struct Scsi_Host *instance = data;35 struct a2091_hostdata *hdata = shost_priv(instance);36 unsigned int status = hdata->regs->ISTR;37 unsigned long flags;38 39 if (!(status & (ISTR_INT_F | ISTR_INT_P)) || !(status & ISTR_INTS))40 return IRQ_NONE;41 42 spin_lock_irqsave(instance->host_lock, flags);43 wd33c93_intr(instance);44 spin_unlock_irqrestore(instance->host_lock, flags);45 return IRQ_HANDLED;46}47 48static int dma_setup(struct scsi_cmnd *cmd, int dir_in)49{50 struct scsi_pointer *scsi_pointer = WD33C93_scsi_pointer(cmd);51 unsigned long len = scsi_pointer->this_residual;52 struct Scsi_Host *instance = cmd->device->host;53 struct a2091_hostdata *hdata = shost_priv(instance);54 struct WD33C93_hostdata *wh = &hdata->wh;55 struct a2091_scsiregs *regs = hdata->regs;56 unsigned short cntr = CNTR_PDMD | CNTR_INTEN;57 dma_addr_t addr;58 59 addr = dma_map_single(hdata->dev, scsi_pointer->ptr,60 len, DMA_DIR(dir_in));61 if (dma_mapping_error(hdata->dev, addr)) {62 dev_warn(hdata->dev, "cannot map SCSI data block %p\n",63 scsi_pointer->ptr);64 return 1;65 }66 scsi_pointer->dma_handle = addr;67 68 /* don't allow DMA if the physical address is bad */69 if (addr & A2091_XFER_MASK) {70 /* drop useless mapping */71 dma_unmap_single(hdata->dev, scsi_pointer->dma_handle,72 scsi_pointer->this_residual,73 DMA_DIR(dir_in));74 scsi_pointer->dma_handle = (dma_addr_t) NULL;75 76 wh->dma_bounce_len = (scsi_pointer->this_residual + 511) & ~0x1ff;77 wh->dma_bounce_buffer = kmalloc(wh->dma_bounce_len,78 GFP_KERNEL);79 80 /* can't allocate memory; use PIO */81 if (!wh->dma_bounce_buffer) {82 wh->dma_bounce_len = 0;83 return 1;84 }85 86 if (!dir_in) {87 /* copy to bounce buffer for a write */88 memcpy(wh->dma_bounce_buffer, scsi_pointer->ptr,89 scsi_pointer->this_residual);90 }91 92 /* will flush/invalidate cache for us */93 addr = dma_map_single(hdata->dev, wh->dma_bounce_buffer,94 wh->dma_bounce_len, DMA_DIR(dir_in));95 /* can't map buffer; use PIO */96 if (dma_mapping_error(hdata->dev, addr)) {97 dev_warn(hdata->dev, "cannot map bounce buffer %p\n",98 wh->dma_bounce_buffer);99 return 1;100 }101 102 /* the bounce buffer may not be in the first 16M of physmem */103 if (addr & A2091_XFER_MASK) {104 /* we could use chipmem... maybe later */105 kfree(wh->dma_bounce_buffer);106 wh->dma_bounce_buffer = NULL;107 wh->dma_bounce_len = 0;108 return 1;109 }110 111 scsi_pointer->dma_handle = addr;112 }113 114 /* setup dma direction */115 if (!dir_in)116 cntr |= CNTR_DDIR;117 118 /* remember direction */119 wh->dma_dir = dir_in;120 121 regs->CNTR = cntr;122 123 /* setup DMA *physical* address */124 regs->ACR = addr;125 126 /* no more cache flush here - dma_map_single() takes care */127 128 /* start DMA */129 regs->ST_DMA = 1;130 131 /* return success */132 return 0;133}134 135static void dma_stop(struct Scsi_Host *instance, struct scsi_cmnd *SCpnt,136 int status)137{138 struct scsi_pointer *scsi_pointer = WD33C93_scsi_pointer(SCpnt);139 struct a2091_hostdata *hdata = shost_priv(instance);140 struct WD33C93_hostdata *wh = &hdata->wh;141 struct a2091_scsiregs *regs = hdata->regs;142 143 /* disable SCSI interrupts */144 unsigned short cntr = CNTR_PDMD;145 146 if (!wh->dma_dir)147 cntr |= CNTR_DDIR;148 149 /* disable SCSI interrupts */150 regs->CNTR = cntr;151 152 /* flush if we were reading */153 if (wh->dma_dir) {154 regs->FLUSH = 1;155 while (!(regs->ISTR & ISTR_FE_FLG))156 ;157 }158 159 /* clear a possible interrupt */160 regs->CINT = 1;161 162 /* stop DMA */163 regs->SP_DMA = 1;164 165 /* restore the CONTROL bits (minus the direction flag) */166 regs->CNTR = CNTR_PDMD | CNTR_INTEN;167 168 dma_unmap_single(hdata->dev, scsi_pointer->dma_handle,169 scsi_pointer->this_residual,170 DMA_DIR(wh->dma_dir));171 172 /* copy from a bounce buffer, if necessary */173 if (status && wh->dma_bounce_buffer) {174 if (wh->dma_dir)175 memcpy(scsi_pointer->ptr, wh->dma_bounce_buffer,176 scsi_pointer->this_residual);177 kfree(wh->dma_bounce_buffer);178 wh->dma_bounce_buffer = NULL;179 wh->dma_bounce_len = 0;180 }181}182 183static const struct scsi_host_template a2091_scsi_template = {184 .module = THIS_MODULE,185 .name = "Commodore A2091/A590 SCSI",186 .show_info = wd33c93_show_info,187 .write_info = wd33c93_write_info,188 .proc_name = "A2901",189 .queuecommand = wd33c93_queuecommand,190 .eh_abort_handler = wd33c93_abort,191 .eh_host_reset_handler = wd33c93_host_reset,192 .can_queue = CAN_QUEUE,193 .this_id = 7,194 .sg_tablesize = SG_ALL,195 .cmd_per_lun = CMD_PER_LUN,196 .dma_boundary = PAGE_SIZE - 1,197 .cmd_size = sizeof(struct scsi_pointer),198};199 200static int a2091_probe(struct zorro_dev *z, const struct zorro_device_id *ent)201{202 struct Scsi_Host *instance;203 int error;204 struct a2091_scsiregs *regs;205 wd33c93_regs wdregs;206 struct a2091_hostdata *hdata;207 208 if (dma_set_mask_and_coherent(&z->dev, DMA_BIT_MASK(24))) {209 dev_warn(&z->dev, "cannot use 24 bit DMA\n");210 return -ENODEV;211 }212 213 if (!request_mem_region(z->resource.start, 256, "wd33c93"))214 return -EBUSY;215 216 instance = scsi_host_alloc(&a2091_scsi_template,217 sizeof(struct a2091_hostdata));218 if (!instance) {219 error = -ENOMEM;220 goto fail_alloc;221 }222 223 instance->irq = IRQ_AMIGA_PORTS;224 instance->unique_id = z->slotaddr;225 226 regs = ZTWO_VADDR(z->resource.start);227 regs->DAWR = DAWR_A2091;228 229 wdregs.SASR = ®s->SASR;230 wdregs.SCMD = ®s->SCMD;231 232 hdata = shost_priv(instance);233 hdata->dev = &z->dev;234 hdata->wh.no_sync = 0xff;235 hdata->wh.fast = 0;236 hdata->wh.dma_mode = CTRL_DMA;237 hdata->regs = regs;238 239 wd33c93_init(instance, wdregs, dma_setup, dma_stop, WD33C93_FS_8_10);240 error = request_irq(IRQ_AMIGA_PORTS, a2091_intr, IRQF_SHARED,241 "A2091 SCSI", instance);242 if (error)243 goto fail_irq;244 245 regs->CNTR = CNTR_PDMD | CNTR_INTEN;246 247 error = scsi_add_host(instance, NULL);248 if (error)249 goto fail_host;250 251 zorro_set_drvdata(z, instance);252 253 scsi_scan_host(instance);254 return 0;255 256fail_host:257 free_irq(IRQ_AMIGA_PORTS, instance);258fail_irq:259 scsi_host_put(instance);260fail_alloc:261 release_mem_region(z->resource.start, 256);262 return error;263}264 265static void a2091_remove(struct zorro_dev *z)266{267 struct Scsi_Host *instance = zorro_get_drvdata(z);268 struct a2091_hostdata *hdata = shost_priv(instance);269 270 hdata->regs->CNTR = 0;271 scsi_remove_host(instance);272 free_irq(IRQ_AMIGA_PORTS, instance);273 scsi_host_put(instance);274 release_mem_region(z->resource.start, 256);275}276 277static struct zorro_device_id a2091_zorro_tbl[] = {278 { ZORRO_PROD_CBM_A590_A2091_1 },279 { ZORRO_PROD_CBM_A590_A2091_2 },280 { 0 }281};282MODULE_DEVICE_TABLE(zorro, a2091_zorro_tbl);283 284static struct zorro_driver a2091_driver = {285 .name = "a2091",286 .id_table = a2091_zorro_tbl,287 .probe = a2091_probe,288 .remove = a2091_remove,289};290 291static int __init a2091_init(void)292{293 return zorro_register_driver(&a2091_driver);294}295module_init(a2091_init);296 297static void __exit a2091_exit(void)298{299 zorro_unregister_driver(&a2091_driver);300}301module_exit(a2091_exit);302 303MODULE_DESCRIPTION("Commodore A2091/A590 SCSI");304MODULE_LICENSE("GPL");305