1 // SPDX-License-Identifier: GPL-2.0-only 2 #include <linux/types.h> 3 #include <linux/mm.h> 4 #include <linux/ioport.h> 5 #include <linux/init.h> 6 #include <linux/slab.h> 7 #include <linux/spinlock.h> 8 #include <linux/interrupt.h> 9 #include <linux/platform_device.h> 10 #include <linux/dma-mapping.h> 11 #include <linux/module.h> 12 13 #include <asm/page.h> 14 #include <asm/amigaints.h> 15 #include <asm/amigahw.h> 16 17 #include <scsi/scsi.h> 18 #include <scsi/scsi_cmnd.h> 19 #include <scsi/scsi_device.h> 20 #include <scsi/scsi_eh.h> 21 #include <scsi/scsi_tcq.h> 22 #include "wd33c93.h" 23 #include "a3000.h" 24 25 26 struct a3000_hostdata { 27 struct WD33C93_hostdata wh; 28 struct a3000_scsiregs *regs; 29 struct device *dev; 30 }; 31 32 #define DMA_DIR(d) ((d == DATA_OUT_DIR) ? DMA_TO_DEVICE : DMA_FROM_DEVICE) 33 34 static irqreturn_t a3000_intr(int irq, void *data) 35 { 36 struct Scsi_Host *instance = data; 37 struct a3000_hostdata *hdata = shost_priv(instance); 38 unsigned int status = hdata->regs->ISTR; 39 unsigned long flags; 40 41 if (!(status & ISTR_INT_P)) 42 return IRQ_NONE; 43 if (status & ISTR_INTS) { 44 spin_lock_irqsave(instance->host_lock, flags); 45 wd33c93_intr(instance); 46 spin_unlock_irqrestore(instance->host_lock, flags); 47 return IRQ_HANDLED; 48 } 49 pr_warn("Non-serviced A3000 SCSI-interrupt? ISTR = %02x\n", status); 50 return IRQ_NONE; 51 } 52 53 static int dma_setup(struct scsi_cmnd *cmd, int dir_in) 54 { 55 struct scsi_pointer *scsi_pointer = WD33C93_scsi_pointer(cmd); 56 unsigned long len = scsi_pointer->this_residual; 57 struct Scsi_Host *instance = cmd->device->host; 58 struct a3000_hostdata *hdata = shost_priv(instance); 59 struct WD33C93_hostdata *wh = &hdata->wh; 60 struct a3000_scsiregs *regs = hdata->regs; 61 unsigned short cntr = CNTR_PDMD | CNTR_INTEN; 62 dma_addr_t addr; 63 64 addr = dma_map_single(hdata->dev, scsi_pointer->ptr, 65 len, DMA_DIR(dir_in)); 66 if (dma_mapping_error(hdata->dev, addr)) { 67 dev_warn(hdata->dev, "cannot map SCSI data block %p\n", 68 scsi_pointer->ptr); 69 return 1; 70 } 71 scsi_pointer->dma_handle = addr; 72 73 /* 74 * if the physical address has the wrong alignment, or if 75 * physical address is bad, or if it is a write and at the 76 * end of a physical memory chunk, then allocate a bounce 77 * buffer 78 * MSch 20220629 - only wrong alignment tested - bounce 79 * buffer returned by kmalloc is guaranteed to be aligned 80 */ 81 if (addr & A3000_XFER_MASK) { 82 WARN_ONCE(1, "Invalid alignment for DMA!"); 83 /* drop useless mapping */ 84 dma_unmap_single(hdata->dev, scsi_pointer->dma_handle, 85 scsi_pointer->this_residual, 86 DMA_DIR(dir_in)); 87 88 wh->dma_bounce_len = (scsi_pointer->this_residual + 511) & ~0x1ff; 89 wh->dma_bounce_buffer = kmalloc(wh->dma_bounce_len, 90 GFP_KERNEL); 91 92 /* can't allocate memory; use PIO */ 93 if (!wh->dma_bounce_buffer) { 94 wh->dma_bounce_len = 0; 95 scsi_pointer->dma_handle = (dma_addr_t) NULL; 96 return 1; 97 } 98 99 if (!dir_in) { 100 /* copy to bounce buffer for a write */ 101 memcpy(wh->dma_bounce_buffer, scsi_pointer->ptr, 102 scsi_pointer->this_residual); 103 } 104 105 addr = dma_map_single(hdata->dev, scsi_pointer->ptr, 106 len, DMA_DIR(dir_in)); 107 if (dma_mapping_error(hdata->dev, addr)) { 108 dev_warn(hdata->dev, 109 "cannot map SCSI data block %p\n", 110 scsi_pointer->ptr); 111 return 1; 112 } 113 scsi_pointer->dma_handle = addr; 114 } 115 116 /* setup dma direction */ 117 if (!dir_in) 118 cntr |= CNTR_DDIR; 119 120 /* remember direction */ 121 wh->dma_dir = dir_in; 122 123 regs->CNTR = cntr; 124 125 /* setup DMA *physical* address */ 126 regs->ACR = addr; 127 128 /* no more cache flush here - dma_map_single() takes care */ 129 130 /* start DMA */ 131 mb(); /* make sure setup is completed */ 132 regs->ST_DMA = 1; 133 mb(); /* make sure DMA has started before next IO */ 134 135 /* return success */ 136 return 0; 137 } 138 139 static void dma_stop(struct Scsi_Host *instance, struct scsi_cmnd *SCpnt, 140 int status) 141 { 142 struct scsi_pointer *scsi_pointer = WD33C93_scsi_pointer(SCpnt); 143 struct a3000_hostdata *hdata = shost_priv(instance); 144 struct WD33C93_hostdata *wh = &hdata->wh; 145 struct a3000_scsiregs *regs = hdata->regs; 146 147 /* disable SCSI interrupts */ 148 unsigned short cntr = CNTR_PDMD; 149 150 if (!wh->dma_dir) 151 cntr |= CNTR_DDIR; 152 153 regs->CNTR = cntr; 154 mb(); /* make sure CNTR is updated before next IO */ 155 156 /* flush if we were reading */ 157 if (wh->dma_dir) { 158 regs->FLUSH = 1; 159 mb(); /* don't allow prefetch */ 160 while (!(regs->ISTR & ISTR_FE_FLG)) 161 barrier(); 162 mb(); /* no IO until FLUSH is done */ 163 } 164 165 /* clear a possible interrupt */ 166 /* I think that this CINT is only necessary if you are 167 * using the terminal count features. HM 7 Mar 1994 168 */ 169 regs->CINT = 1; 170 171 /* stop DMA */ 172 regs->SP_DMA = 1; 173 mb(); /* make sure DMA is stopped before next IO */ 174 175 /* restore the CONTROL bits (minus the direction flag) */ 176 regs->CNTR = CNTR_PDMD | CNTR_INTEN; 177 mb(); /* make sure CNTR is updated before next IO */ 178 179 dma_unmap_single(hdata->dev, scsi_pointer->dma_handle, 180 scsi_pointer->this_residual, 181 DMA_DIR(wh->dma_dir)); 182 183 /* copy from a bounce buffer, if necessary */ 184 if (status && wh->dma_bounce_buffer) { 185 if (SCpnt) { 186 if (wh->dma_dir && SCpnt) 187 memcpy(scsi_pointer->ptr, wh->dma_bounce_buffer, 188 scsi_pointer->this_residual); 189 kfree(wh->dma_bounce_buffer); 190 wh->dma_bounce_buffer = NULL; 191 wh->dma_bounce_len = 0; 192 } else { 193 kfree(wh->dma_bounce_buffer); 194 wh->dma_bounce_buffer = NULL; 195 wh->dma_bounce_len = 0; 196 } 197 } 198 } 199 200 static const struct scsi_host_template amiga_a3000_scsi_template = { 201 .module = THIS_MODULE, 202 .name = "Amiga 3000 built-in SCSI", 203 .show_info = wd33c93_show_info, 204 .write_info = wd33c93_write_info, 205 .proc_name = "A3000", 206 .queuecommand = wd33c93_queuecommand, 207 .eh_abort_handler = wd33c93_abort, 208 .eh_host_reset_handler = wd33c93_host_reset, 209 .can_queue = CAN_QUEUE, 210 .this_id = 7, 211 .sg_tablesize = SG_ALL, 212 .cmd_per_lun = CMD_PER_LUN, 213 .cmd_size = sizeof(struct scsi_pointer), 214 }; 215 216 static int __init amiga_a3000_scsi_probe(struct platform_device *pdev) 217 { 218 struct resource *res; 219 struct Scsi_Host *instance; 220 int error; 221 struct a3000_scsiregs *regs; 222 wd33c93_regs wdregs; 223 struct a3000_hostdata *hdata; 224 225 if (dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32))) { 226 dev_warn(&pdev->dev, "cannot use 32 bit DMA\n"); 227 return -ENODEV; 228 } 229 230 res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 231 if (!res) 232 return -ENODEV; 233 234 if (!request_mem_region(res->start, resource_size(res), "wd33c93")) 235 return -EBUSY; 236 237 instance = scsi_host_alloc(&amiga_a3000_scsi_template, 238 sizeof(struct a3000_hostdata)); 239 if (!instance) { 240 error = -ENOMEM; 241 goto fail_alloc; 242 } 243 244 instance->irq = IRQ_AMIGA_PORTS; 245 246 regs = ZTWO_VADDR(res->start); 247 regs->DAWR = DAWR_A3000; 248 249 wdregs.SASR = ®s->SASR; 250 wdregs.SCMD = ®s->SCMD; 251 252 hdata = shost_priv(instance); 253 hdata->dev = &pdev->dev; 254 hdata->wh.no_sync = 0xff; 255 hdata->wh.fast = 0; 256 hdata->wh.dma_mode = CTRL_DMA; 257 hdata->regs = regs; 258 259 wd33c93_init(instance, wdregs, dma_setup, dma_stop, WD33C93_FS_12_15); 260 error = request_irq(IRQ_AMIGA_PORTS, a3000_intr, IRQF_SHARED, 261 "A3000 SCSI", instance); 262 if (error) 263 goto fail_irq; 264 265 regs->CNTR = CNTR_PDMD | CNTR_INTEN; 266 267 error = scsi_add_host(instance, NULL); 268 if (error) 269 goto fail_host; 270 271 platform_set_drvdata(pdev, instance); 272 273 scsi_scan_host(instance); 274 return 0; 275 276 fail_host: 277 free_irq(IRQ_AMIGA_PORTS, instance); 278 fail_irq: 279 scsi_host_put(instance); 280 fail_alloc: 281 release_mem_region(res->start, resource_size(res)); 282 return error; 283 } 284 285 static void __exit amiga_a3000_scsi_remove(struct platform_device *pdev) 286 { 287 struct Scsi_Host *instance = platform_get_drvdata(pdev); 288 struct a3000_hostdata *hdata = shost_priv(instance); 289 struct resource *res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 290 291 hdata->regs->CNTR = 0; 292 scsi_remove_host(instance); 293 free_irq(IRQ_AMIGA_PORTS, instance); 294 scsi_host_put(instance); 295 release_mem_region(res->start, resource_size(res)); 296 } 297 298 static struct platform_driver amiga_a3000_scsi_driver = { 299 .remove_new = __exit_p(amiga_a3000_scsi_remove), 300 .driver = { 301 .name = "amiga-a3000-scsi", 302 }, 303 }; 304 305 module_platform_driver_probe(amiga_a3000_scsi_driver, amiga_a3000_scsi_probe); 306 307 MODULE_DESCRIPTION("Amiga 3000 built-in SCSI"); 308 MODULE_LICENSE("GPL"); 309 MODULE_ALIAS("platform:amiga-a3000-scsi"); 310