a2091.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:6k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. #include <linux/types.h>
  2. #include <linux/mm.h>
  3. #include <linux/blk.h>
  4. #include <linux/sched.h>
  5. #include <linux/version.h>
  6. #include <linux/init.h>
  7. #include <asm/setup.h>
  8. #include <asm/page.h>
  9. #include <asm/pgtable.h>
  10. #include <asm/amigaints.h>
  11. #include <asm/amigahw.h>
  12. #include <linux/zorro.h>
  13. #include <asm/irq.h>
  14. #include <linux/spinlock.h>
  15. #include "scsi.h"
  16. #include "hosts.h"
  17. #include "wd33c93.h"
  18. #include "a2091.h"
  19. #include<linux/stat.h>
  20. #define DMA(ptr) ((a2091_scsiregs *)((ptr)->base))
  21. #define HDATA(ptr) ((struct WD33C93_hostdata *)((ptr)->hostdata))
  22. static struct Scsi_Host *first_instance = NULL;
  23. static Scsi_Host_Template *a2091_template;
  24. static void a2091_intr (int irq, void *dummy, struct pt_regs *fp)
  25. {
  26.     unsigned long flags;
  27.     unsigned int status;
  28.     struct Scsi_Host *instance;
  29.     for (instance = first_instance; instance &&
  30.  instance->hostt == a2091_template; instance = instance->next)
  31.     {
  32. status = DMA(instance)->ISTR;
  33. if (!(status & (ISTR_INT_F|ISTR_INT_P)))
  34. continue;
  35. if (status & ISTR_INTS) {
  36. spin_lock_irqsave(&io_request_lock, flags);
  37. wd33c93_intr (instance);
  38. spin_unlock_irqrestore(&io_request_lock, flags);
  39. }
  40.     }
  41. }
  42. static int dma_setup (Scsi_Cmnd *cmd, int dir_in)
  43. {
  44.     unsigned short cntr = CNTR_PDMD | CNTR_INTEN;
  45.     unsigned long addr = virt_to_bus(cmd->SCp.ptr);
  46.     struct Scsi_Host *instance = cmd->host;
  47.     /* don't allow DMA if the physical address is bad */
  48.     if (addr & A2091_XFER_MASK ||
  49. (!dir_in && mm_end_of_chunk (addr, cmd->SCp.this_residual)))
  50.     {
  51. HDATA(instance)->dma_bounce_len = (cmd->SCp.this_residual + 511)
  52.     & ~0x1ff;
  53. HDATA(instance)->dma_bounce_buffer =
  54.     scsi_malloc (HDATA(instance)->dma_bounce_len);
  55. /* can't allocate memory; use PIO */
  56. if (!HDATA(instance)->dma_bounce_buffer) {
  57.     HDATA(instance)->dma_bounce_len = 0;
  58.     return 1;
  59. }
  60. /* get the physical address of the bounce buffer */
  61. addr = virt_to_bus(HDATA(instance)->dma_bounce_buffer);
  62. /* the bounce buffer may not be in the first 16M of physmem */
  63. if (addr & A2091_XFER_MASK) {
  64.     /* we could use chipmem... maybe later */
  65.     scsi_free (HDATA(instance)->dma_bounce_buffer,
  66.        HDATA(instance)->dma_bounce_len);
  67.     HDATA(instance)->dma_bounce_buffer = NULL;
  68.     HDATA(instance)->dma_bounce_len = 0;
  69.     return 1;
  70. }
  71. if (!dir_in) {
  72.     /* copy to bounce buffer for a write */
  73.     if (cmd->use_sg)
  74. #if 0
  75. panic ("scsi%ddma: incomplete s/g support",
  76.        instance->host_no);
  77. #else
  78. memcpy (HDATA(instance)->dma_bounce_buffer,
  79. cmd->SCp.ptr, cmd->SCp.this_residual);
  80. #endif
  81.     else
  82. memcpy (HDATA(instance)->dma_bounce_buffer,
  83. cmd->request_buffer, cmd->request_bufflen);
  84. }
  85.     }
  86.     /* setup dma direction */
  87.     if (!dir_in)
  88. cntr |= CNTR_DDIR;
  89.     /* remember direction */
  90.     HDATA(cmd->host)->dma_dir = dir_in;
  91.     DMA(cmd->host)->CNTR = cntr;
  92.     /* setup DMA *physical* address */
  93.     DMA(cmd->host)->ACR = addr;
  94.     if (dir_in){
  95. /* invalidate any cache */
  96. cache_clear (addr, cmd->SCp.this_residual);
  97.     }else{
  98. /* push any dirty cache */
  99. cache_push (addr, cmd->SCp.this_residual);
  100.       }
  101.     /* start DMA */
  102.     DMA(cmd->host)->ST_DMA = 1;
  103.     /* return success */
  104.     return 0;
  105. }
  106. static void dma_stop (struct Scsi_Host *instance, Scsi_Cmnd *SCpnt, 
  107.       int status)
  108. {
  109.     /* disable SCSI interrupts */
  110.     unsigned short cntr = CNTR_PDMD;
  111.     if (!HDATA(instance)->dma_dir)
  112.     cntr |= CNTR_DDIR;
  113.     /* disable SCSI interrupts */
  114.     DMA(instance)->CNTR = cntr;
  115.     /* flush if we were reading */
  116.     if (HDATA(instance)->dma_dir) {
  117. DMA(instance)->FLUSH = 1;
  118. while (!(DMA(instance)->ISTR & ISTR_FE_FLG))
  119.     ;
  120.     }
  121.     /* clear a possible interrupt */
  122.     DMA(instance)->CINT = 1;
  123.     /* stop DMA */
  124.     DMA(instance)->SP_DMA = 1;
  125.     /* restore the CONTROL bits (minus the direction flag) */
  126.     DMA(instance)->CNTR = CNTR_PDMD | CNTR_INTEN;
  127.     /* copy from a bounce buffer, if necessary */
  128.     if (status && HDATA(instance)->dma_bounce_buffer) {
  129. if (SCpnt && SCpnt->use_sg) {
  130. #if 0
  131.     panic ("scsi%d: incomplete s/g support",
  132.    instance->host_no);
  133. #else
  134.     if( HDATA(instance)->dma_dir )
  135. memcpy (SCpnt->SCp.ptr, 
  136. HDATA(instance)->dma_bounce_buffer,
  137. SCpnt->SCp.this_residual);
  138.     scsi_free (HDATA(instance)->dma_bounce_buffer,
  139.        HDATA(instance)->dma_bounce_len);
  140.     HDATA(instance)->dma_bounce_buffer = NULL;
  141.     HDATA(instance)->dma_bounce_len = 0;
  142.     
  143. #endif
  144. } else {
  145.     if (HDATA(instance)->dma_dir && SCpnt)
  146. memcpy (SCpnt->request_buffer,
  147. HDATA(instance)->dma_bounce_buffer,
  148. SCpnt->request_bufflen);
  149.     scsi_free (HDATA(instance)->dma_bounce_buffer,
  150.        HDATA(instance)->dma_bounce_len);
  151.     HDATA(instance)->dma_bounce_buffer = NULL;
  152.     HDATA(instance)->dma_bounce_len = 0;
  153. }
  154.     }
  155. }
  156. static int num_a2091 = 0;
  157. int __init a2091_detect(Scsi_Host_Template *tpnt)
  158. {
  159.     static unsigned char called = 0;
  160.     struct Scsi_Host *instance;
  161.     unsigned long address;
  162.     struct zorro_dev *z = NULL;
  163.     wd33c93_regs regs;
  164.     if (!MACH_IS_AMIGA || called)
  165. return 0;
  166.     called = 1;
  167.     tpnt->proc_name = "A2091";
  168.     tpnt->proc_info = &wd33c93_proc_info;
  169.     while ((z = zorro_find_device(ZORRO_WILDCARD, z))) {
  170. if (z->id != ZORRO_PROD_CBM_A590_A2091_1 &&
  171.     z->id != ZORRO_PROD_CBM_A590_A2091_2)
  172.     continue;
  173. address = z->resource.start;
  174. if (!request_mem_region(address, 256, "wd33c93"))
  175.     continue;
  176. instance = scsi_register (tpnt, sizeof (struct WD33C93_hostdata));
  177. if (instance == NULL) {
  178.     release_mem_region(address, 256);
  179.     continue;
  180. }
  181. instance->base = ZTWO_VADDR(address);
  182. instance->irq = IRQ_AMIGA_PORTS;
  183. instance->unique_id = z->slotaddr;
  184. DMA(instance)->DAWR = DAWR_A2091;
  185. regs.SASR = &(DMA(instance)->SASR);
  186. regs.SCMD = &(DMA(instance)->SCMD);
  187. wd33c93_init(instance, regs, dma_setup, dma_stop, WD33C93_FS_8_10);
  188. if (num_a2091++ == 0) {
  189.     first_instance = instance;
  190.     a2091_template = instance->hostt;
  191.     request_irq(IRQ_AMIGA_PORTS, a2091_intr, SA_SHIRQ, "A2091 SCSI",
  192. a2091_intr);
  193. }
  194. DMA(instance)->CNTR = CNTR_PDMD | CNTR_INTEN;
  195.     }
  196.     return num_a2091;
  197. }
  198. #define HOSTS_C
  199. static Scsi_Host_Template driver_template = A2091_SCSI;
  200. #include "scsi_module.c"
  201. int a2091_release(struct Scsi_Host *instance)
  202. {
  203. #ifdef MODULE
  204. DMA(instance)->CNTR = 0;
  205. release_mem_region(ZTWO_PADDR(instance->base), 256);
  206. if (--num_a2091 == 0)
  207. free_irq(IRQ_AMIGA_PORTS, a2091_intr);
  208. wd33c93_release();
  209. #endif
  210. return 1;
  211. }