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