1 #include <linux/types.h> 2 #include <linux/init.h> 3 #include <linux/interrupt.h> 4 #include <linux/mm.h> 5 #include <linux/slab.h> 6 #include <linux/spinlock.h> 7 #include <linux/zorro.h> 8 #include <linux/module.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 "a2091.h" 18 19 20 struct a2091_hostdata { 21 struct WD33C93_hostdata wh; 22 struct a2091_scsiregs *regs; 23 }; 24 25 static irqreturn_t a2091_intr(int irq, void *data) 26 { 27 struct Scsi_Host *instance = data; 28 struct a2091_hostdata *hdata = shost_priv(instance); 29 unsigned int status = hdata->regs->ISTR; 30 unsigned long flags; 31 32 if (!(status & (ISTR_INT_F | ISTR_INT_P)) || !(status & ISTR_INTS)) 33 return IRQ_NONE; 34 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 41 static int dma_setup(struct scsi_cmnd *cmd, int dir_in) 42 { 43 struct Scsi_Host *instance = cmd->device->host; 44 struct a2091_hostdata *hdata = shost_priv(instance); 45 struct WD33C93_hostdata *wh = &hdata->wh; 46 struct a2091_scsiregs *regs = hdata->regs; 47 unsigned short cntr = CNTR_PDMD | CNTR_INTEN; 48 unsigned long addr = virt_to_bus(cmd->SCp.ptr); 49 50 /* don't allow DMA if the physical address is bad */ 51 if (addr & A2091_XFER_MASK) { 52 wh->dma_bounce_len = (cmd->SCp.this_residual + 511) & ~0x1ff; 53 wh->dma_bounce_buffer = kmalloc(wh->dma_bounce_len, 54 GFP_KERNEL); 55 56 /* can't allocate memory; use PIO */ 57 if (!wh->dma_bounce_buffer) { 58 wh->dma_bounce_len = 0; 59 return 1; 60 } 61 62 /* get the physical address of the bounce buffer */ 63 addr = virt_to_bus(wh->dma_bounce_buffer); 64 65 /* the bounce buffer may not be in the first 16M of physmem */ 66 if (addr & A2091_XFER_MASK) { 67 /* we could use chipmem... maybe later */ 68 kfree(wh->dma_bounce_buffer); 69 wh->dma_bounce_buffer = NULL; 70 wh->dma_bounce_len = 0; 71 return 1; 72 } 73 74 if (!dir_in) { 75 /* copy to bounce buffer for a write */ 76 memcpy(wh->dma_bounce_buffer, cmd->SCp.ptr, 77 cmd->SCp.this_residual); 78 } 79 } 80 81 /* setup dma direction */ 82 if (!dir_in) 83 cntr |= CNTR_DDIR; 84 85 /* remember direction */ 86 wh->dma_dir = dir_in; 87 88 regs->CNTR = cntr; 89 90 /* setup DMA *physical* address */ 91 regs->ACR = addr; 92 93 if (dir_in) { 94 /* invalidate any cache */ 95 cache_clear(addr, cmd->SCp.this_residual); 96 } else { 97 /* push any dirty cache */ 98 cache_push(addr, cmd->SCp.this_residual); 99 } 100 /* start DMA */ 101 regs->ST_DMA = 1; 102 103 /* return success */ 104 return 0; 105 } 106 107 static void dma_stop(struct Scsi_Host *instance, struct scsi_cmnd *SCpnt, 108 int status) 109 { 110 struct a2091_hostdata *hdata = shost_priv(instance); 111 struct WD33C93_hostdata *wh = &hdata->wh; 112 struct a2091_scsiregs *regs = hdata->regs; 113 114 /* disable SCSI interrupts */ 115 unsigned short cntr = CNTR_PDMD; 116 117 if (!wh->dma_dir) 118 cntr |= CNTR_DDIR; 119 120 /* disable SCSI interrupts */ 121 regs->CNTR = cntr; 122 123 /* flush if we were reading */ 124 if (wh->dma_dir) { 125 regs->FLUSH = 1; 126 while (!(regs->ISTR & ISTR_FE_FLG)) 127 ; 128 } 129 130 /* clear a possible interrupt */ 131 regs->CINT = 1; 132 133 /* stop DMA */ 134 regs->SP_DMA = 1; 135 136 /* restore the CONTROL bits (minus the direction flag) */ 137 regs->CNTR = CNTR_PDMD | CNTR_INTEN; 138 139 /* copy from a bounce buffer, if necessary */ 140 if (status && wh->dma_bounce_buffer) { 141 if (wh->dma_dir) 142 memcpy(SCpnt->SCp.ptr, wh->dma_bounce_buffer, 143 SCpnt->SCp.this_residual); 144 kfree(wh->dma_bounce_buffer); 145 wh->dma_bounce_buffer = NULL; 146 wh->dma_bounce_len = 0; 147 } 148 } 149 150 static struct scsi_host_template a2091_scsi_template = { 151 .module = THIS_MODULE, 152 .name = "Commodore A2091/A590 SCSI", 153 .show_info = wd33c93_show_info, 154 .write_info = wd33c93_write_info, 155 .proc_name = "A2901", 156 .queuecommand = wd33c93_queuecommand, 157 .eh_abort_handler = wd33c93_abort, 158 .eh_host_reset_handler = wd33c93_host_reset, 159 .can_queue = CAN_QUEUE, 160 .this_id = 7, 161 .sg_tablesize = SG_ALL, 162 .cmd_per_lun = CMD_PER_LUN, 163 .dma_boundary = PAGE_SIZE - 1, 164 }; 165 166 static int a2091_probe(struct zorro_dev *z, const struct zorro_device_id *ent) 167 { 168 struct Scsi_Host *instance; 169 int error; 170 struct a2091_scsiregs *regs; 171 wd33c93_regs wdregs; 172 struct a2091_hostdata *hdata; 173 174 if (!request_mem_region(z->resource.start, 256, "wd33c93")) 175 return -EBUSY; 176 177 instance = scsi_host_alloc(&a2091_scsi_template, 178 sizeof(struct a2091_hostdata)); 179 if (!instance) { 180 error = -ENOMEM; 181 goto fail_alloc; 182 } 183 184 instance->irq = IRQ_AMIGA_PORTS; 185 instance->unique_id = z->slotaddr; 186 187 regs = ZTWO_VADDR(z->resource.start); 188 regs->DAWR = DAWR_A2091; 189 190 wdregs.SASR = ®s->SASR; 191 wdregs.SCMD = ®s->SCMD; 192 193 hdata = shost_priv(instance); 194 hdata->wh.no_sync = 0xff; 195 hdata->wh.fast = 0; 196 hdata->wh.dma_mode = CTRL_DMA; 197 hdata->regs = regs; 198 199 wd33c93_init(instance, wdregs, dma_setup, dma_stop, WD33C93_FS_8_10); 200 error = request_irq(IRQ_AMIGA_PORTS, a2091_intr, IRQF_SHARED, 201 "A2091 SCSI", instance); 202 if (error) 203 goto fail_irq; 204 205 regs->CNTR = CNTR_PDMD | CNTR_INTEN; 206 207 error = scsi_add_host(instance, NULL); 208 if (error) 209 goto fail_host; 210 211 zorro_set_drvdata(z, instance); 212 213 scsi_scan_host(instance); 214 return 0; 215 216 fail_host: 217 free_irq(IRQ_AMIGA_PORTS, instance); 218 fail_irq: 219 scsi_host_put(instance); 220 fail_alloc: 221 release_mem_region(z->resource.start, 256); 222 return error; 223 } 224 225 static void a2091_remove(struct zorro_dev *z) 226 { 227 struct Scsi_Host *instance = zorro_get_drvdata(z); 228 struct a2091_hostdata *hdata = shost_priv(instance); 229 230 hdata->regs->CNTR = 0; 231 scsi_remove_host(instance); 232 free_irq(IRQ_AMIGA_PORTS, instance); 233 scsi_host_put(instance); 234 release_mem_region(z->resource.start, 256); 235 } 236 237 static struct zorro_device_id a2091_zorro_tbl[] = { 238 { ZORRO_PROD_CBM_A590_A2091_1 }, 239 { ZORRO_PROD_CBM_A590_A2091_2 }, 240 { 0 } 241 }; 242 MODULE_DEVICE_TABLE(zorro, a2091_zorro_tbl); 243 244 static struct zorro_driver a2091_driver = { 245 .name = "a2091", 246 .id_table = a2091_zorro_tbl, 247 .probe = a2091_probe, 248 .remove = a2091_remove, 249 }; 250 251 static int __init a2091_init(void) 252 { 253 return zorro_register_driver(&a2091_driver); 254 } 255 module_init(a2091_init); 256 257 static void __exit a2091_exit(void) 258 { 259 zorro_unregister_driver(&a2091_driver); 260 } 261 module_exit(a2091_exit); 262 263 MODULE_DESCRIPTION("Commodore A2091/A590 SCSI"); 264 MODULE_LICENSE("GPL"); 265