a3000.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/ioport.h>
  7. #include <linux/init.h>
  8. #include <linux/spinlock.h>
  9. #include <asm/setup.h>
  10. #include <asm/page.h>
  11. #include <asm/pgtable.h>
  12. #include <asm/amigaints.h>
  13. #include <asm/amigahw.h>
  14. #include <asm/irq.h>
  15. #include "scsi.h"
  16. #include "hosts.h"
  17. #include "wd33c93.h"
  18. #include "a3000.h"
  19. #include<linux/stat.h>
  20. #define DMA(ptr) ((a3000_scsiregs *)((ptr)->base))
  21. #define HDATA(ptr) ((struct WD33C93_hostdata *)((ptr)->hostdata))
  22. static struct Scsi_Host *a3000_host = NULL;
  23. static void a3000_intr (int irq, void *dummy, struct pt_regs *fp)
  24. {
  25. unsigned long flags;
  26. unsigned int status = DMA(a3000_host)->ISTR;
  27. if (!(status & ISTR_INT_P))
  28. return;
  29. if (status & ISTR_INTS)
  30. {
  31. spin_lock_irqsave(&io_request_lock, flags);
  32. wd33c93_intr (a3000_host);
  33. spin_unlock_irqrestore(&io_request_lock, flags);
  34. } else
  35. printk("Non-serviced A3000 SCSI-interrupt? ISTR = %02xn",
  36.        status);
  37. }
  38. static int dma_setup (Scsi_Cmnd *cmd, int dir_in)
  39. {
  40.     unsigned short cntr = CNTR_PDMD | CNTR_INTEN;
  41.     unsigned long addr = virt_to_bus(cmd->SCp.ptr);
  42.     /*
  43.      * if the physical address has the wrong alignment, or if
  44.      * physical address is bad, or if it is a write and at the
  45.      * end of a physical memory chunk, then allocate a bounce
  46.      * buffer
  47.      */
  48.     if (addr & A3000_XFER_MASK ||
  49. (!dir_in && mm_end_of_chunk (addr, cmd->SCp.this_residual)))
  50.     {
  51. HDATA(a3000_host)->dma_bounce_len = (cmd->SCp.this_residual + 511)
  52.     & ~0x1ff;
  53. HDATA(a3000_host)->dma_bounce_buffer =
  54.     scsi_malloc (HDATA(a3000_host)->dma_bounce_len);
  55. /* can't allocate memory; use PIO */
  56. if (!HDATA(a3000_host)->dma_bounce_buffer) {
  57.     HDATA(a3000_host)->dma_bounce_len = 0;
  58.     return 1;
  59. }
  60. if (!dir_in) {
  61.     /* copy to bounce buffer for a write */
  62.     if (cmd->use_sg) {
  63. memcpy (HDATA(a3000_host)->dma_bounce_buffer,
  64. cmd->SCp.ptr, cmd->SCp.this_residual);
  65.     } else
  66. memcpy (HDATA(a3000_host)->dma_bounce_buffer,
  67. cmd->request_buffer, cmd->request_bufflen);
  68. }
  69. addr = virt_to_bus(HDATA(a3000_host)->dma_bounce_buffer);
  70.     }
  71.     /* setup dma direction */
  72.     if (!dir_in)
  73. cntr |= CNTR_DDIR;
  74.     /* remember direction */
  75.     HDATA(a3000_host)->dma_dir = dir_in;
  76.     DMA(a3000_host)->CNTR = cntr;
  77.     /* setup DMA *physical* address */
  78.     DMA(a3000_host)->ACR = addr;
  79.     if (dir_in)
  80.    /* invalidate any cache */
  81. cache_clear (addr, cmd->SCp.this_residual);
  82.     else
  83. /* push any dirty cache */
  84. cache_push (addr, cmd->SCp.this_residual);
  85.     /* start DMA */
  86.     mb(); /* make sure setup is completed */
  87.     DMA(a3000_host)->ST_DMA = 1;
  88.     mb(); /* make sure DMA has started before next IO */
  89.     /* return success */
  90.     return 0;
  91. }
  92. static void dma_stop (struct Scsi_Host *instance, Scsi_Cmnd *SCpnt,
  93.       int status)
  94. {
  95.     /* disable SCSI interrupts */
  96.     unsigned short cntr = CNTR_PDMD;
  97.     if (!HDATA(instance)->dma_dir)
  98. cntr |= CNTR_DDIR;
  99.     DMA(instance)->CNTR = cntr;
  100.     mb(); /* make sure CNTR is updated before next IO */
  101.     /* flush if we were reading */
  102.     if (HDATA(instance)->dma_dir) {
  103. DMA(instance)->FLUSH = 1;
  104. mb(); /* don't allow prefetch */
  105. while (!(DMA(instance)->ISTR & ISTR_FE_FLG))
  106.     barrier();
  107. mb(); /* no IO until FLUSH is done */
  108.     }
  109.     /* clear a possible interrupt */
  110.     /* I think that this CINT is only necessary if you are
  111.      * using the terminal count features.   HM 7 Mar 1994
  112.      */
  113.     DMA(instance)->CINT = 1;
  114.     /* stop DMA */
  115.     DMA(instance)->SP_DMA = 1;
  116.     mb(); /* make sure DMA is stopped before next IO */
  117.     /* restore the CONTROL bits (minus the direction flag) */
  118.     DMA(instance)->CNTR = CNTR_PDMD | CNTR_INTEN;
  119.     mb(); /* make sure CNTR is updated before next IO */
  120.     /* copy from a bounce buffer, if necessary */
  121.     if (status && HDATA(instance)->dma_bounce_buffer) {
  122. if (SCpnt && SCpnt->use_sg) {
  123.     if (HDATA(instance)->dma_dir && SCpnt)
  124. memcpy (SCpnt->SCp.ptr,
  125. HDATA(instance)->dma_bounce_buffer,
  126. SCpnt->SCp.this_residual);
  127.     scsi_free (HDATA(instance)->dma_bounce_buffer,
  128.        HDATA(instance)->dma_bounce_len);
  129.     HDATA(instance)->dma_bounce_buffer = NULL;
  130.     HDATA(instance)->dma_bounce_len = 0;
  131. } else {
  132.     if (HDATA(instance)->dma_dir && SCpnt)
  133. memcpy (SCpnt->request_buffer,
  134. HDATA(instance)->dma_bounce_buffer,
  135. SCpnt->request_bufflen);
  136.     scsi_free (HDATA(instance)->dma_bounce_buffer,
  137.        HDATA(instance)->dma_bounce_len);
  138.     HDATA(instance)->dma_bounce_buffer = NULL;
  139.     HDATA(instance)->dma_bounce_len = 0;
  140. }
  141.     }
  142. }
  143. int __init a3000_detect(Scsi_Host_Template *tpnt)
  144. {
  145.     wd33c93_regs regs;
  146.     if  (!MACH_IS_AMIGA || !AMIGAHW_PRESENT(A3000_SCSI))
  147. return 0;
  148.     if (!request_mem_region(0xDD0000, 256, "wd33c93"))
  149. return 0;
  150.     tpnt->proc_name = "A3000";
  151.     tpnt->proc_info = &wd33c93_proc_info;
  152.     a3000_host = scsi_register (tpnt, sizeof(struct WD33C93_hostdata));
  153.     if (a3000_host == NULL)
  154. goto fail_register;
  155.     a3000_host->base = ZTWO_VADDR(0xDD0000);
  156.     a3000_host->irq = IRQ_AMIGA_PORTS;
  157.     DMA(a3000_host)->DAWR = DAWR_A3000;
  158.     regs.SASR = &(DMA(a3000_host)->SASR);
  159.     regs.SCMD = &(DMA(a3000_host)->SCMD);
  160.     wd33c93_init(a3000_host, regs, dma_setup, dma_stop, WD33C93_FS_12_15);
  161.     if (request_irq(IRQ_AMIGA_PORTS, a3000_intr, SA_SHIRQ, "A3000 SCSI",
  162.     a3000_intr))
  163.         goto fail_irq;
  164.     DMA(a3000_host)->CNTR = CNTR_PDMD | CNTR_INTEN;
  165.     return 1;
  166. fail_irq:
  167. #ifdef MODULE
  168.     wd33c93_release();
  169. #endif /* MODULE */
  170.     scsi_unregister(a3000_host);
  171. fail_register:
  172.     release_mem_region(0xDD0000, 256);
  173.     return 0;
  174. }
  175. #define HOSTS_C
  176. static Scsi_Host_Template driver_template = _A3000_SCSI;
  177. #include "scsi_module.c"
  178. int __exit a3000_release(struct Scsi_Host *instance)
  179. {
  180. #ifdef MODULE
  181.     wd33c93_release();
  182. #endif /* MODULE*/
  183.     DMA(instance)->CNTR = 0;
  184.     release_mem_region(0xDD0000, 256);
  185.     free_irq(IRQ_AMIGA_PORTS, a3000_intr);
  186.     return 1;
  187. }