gvp11.c
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:10k
源码类别:

Linux/Unix编程

开发平台:

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 "gvp11.h"
  19. #include<linux/stat.h>
  20. #define DMA(ptr) ((gvp11_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 *gvp11_template;
  24. static void gvp11_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 == gvp11_template; instance = instance->next)
  31.     {
  32. status = DMA(instance)->CNTR;
  33. if (!(status & GVP11_DMAC_INT_PENDING))
  34.     continue;
  35. spin_lock_irqsave(&io_request_lock, flags);
  36. wd33c93_intr (instance);
  37. spin_unlock_irqrestore(&io_request_lock, flags);
  38.     }
  39. }
  40. static int gvp11_xfer_mask = 0;
  41. void gvp11_setup (char *str, int *ints)
  42. {
  43.     gvp11_xfer_mask = ints[1];
  44. }
  45. static int dma_setup (Scsi_Cmnd *cmd, int dir_in)
  46. {
  47.     unsigned short cntr = GVP11_DMAC_INT_ENABLE;
  48.     unsigned long addr = virt_to_bus(cmd->SCp.ptr);
  49.     int bank_mask;
  50.     static int scsi_alloc_out_of_range = 0;
  51.     /* use bounce buffer if the physical address is bad */
  52.     if (addr & HDATA(cmd->host)->dma_xfer_mask ||
  53. (!dir_in && mm_end_of_chunk (addr, cmd->SCp.this_residual)))
  54.     {
  55. HDATA(cmd->host)->dma_bounce_len = (cmd->SCp.this_residual + 511)
  56.     & ~0x1ff;
  57.   if( !scsi_alloc_out_of_range ) {
  58.     HDATA(cmd->host)->dma_bounce_buffer =
  59. scsi_malloc (HDATA(cmd->host)->dma_bounce_len);
  60.     HDATA(cmd->host)->dma_buffer_pool = BUF_SCSI_ALLOCED;
  61. }
  62. if ( scsi_alloc_out_of_range || !HDATA(cmd->host)->dma_bounce_buffer) {
  63.     HDATA(cmd->host)->dma_bounce_buffer =
  64. amiga_chip_alloc(HDATA(cmd->host)->dma_bounce_len,
  65.        "GVP II SCSI Bounce Buffer");
  66.     if(!HDATA(cmd->host)->dma_bounce_buffer)
  67.     {
  68. HDATA(cmd->host)->dma_bounce_len = 0;
  69. return 1;
  70.     }
  71.     HDATA(cmd->host)->dma_buffer_pool = BUF_CHIP_ALLOCED;
  72. }
  73. /* check if the address of the bounce buffer is OK */
  74. addr = virt_to_bus(HDATA(cmd->host)->dma_bounce_buffer);
  75. if (addr & HDATA(cmd->host)->dma_xfer_mask) {
  76.     /* fall back to Chip RAM if address out of range */
  77.     if( HDATA(cmd->host)->dma_buffer_pool == BUF_SCSI_ALLOCED) {
  78. scsi_free (HDATA(cmd->host)->dma_bounce_buffer,
  79.    HDATA(cmd->host)->dma_bounce_len);
  80. scsi_alloc_out_of_range = 1;
  81.     } else {
  82. amiga_chip_free (HDATA(cmd->host)->dma_bounce_buffer);
  83.             }
  84.     HDATA(cmd->host)->dma_bounce_buffer =
  85. amiga_chip_alloc(HDATA(cmd->host)->dma_bounce_len,
  86.        "GVP II SCSI Bounce Buffer");
  87.     if(!HDATA(cmd->host)->dma_bounce_buffer)
  88.     {
  89. HDATA(cmd->host)->dma_bounce_len = 0;
  90. return 1;
  91.     }
  92.     addr = virt_to_bus(HDATA(cmd->host)->dma_bounce_buffer);
  93.     HDATA(cmd->host)->dma_buffer_pool = BUF_CHIP_ALLOCED;
  94. }
  95.     
  96. if (!dir_in) {
  97.     /* copy to bounce buffer for a write */
  98.     memcpy (HDATA(cmd->host)->dma_bounce_buffer,
  99.     cmd->SCp.ptr, cmd->SCp.this_residual);
  100. }
  101.     }
  102.     /* setup dma direction */
  103.     if (!dir_in)
  104. cntr |= GVP11_DMAC_DIR_WRITE;
  105.     HDATA(cmd->host)->dma_dir = dir_in;
  106.     DMA(cmd->host)->CNTR = cntr;
  107.     /* setup DMA *physical* address */
  108.     DMA(cmd->host)->ACR = addr;
  109.     if (dir_in)
  110. /* invalidate any cache */
  111. cache_clear (addr, cmd->SCp.this_residual);
  112.     else
  113. /* push any dirty cache */
  114. cache_push (addr, cmd->SCp.this_residual);
  115.     if ((bank_mask = (~HDATA(cmd->host)->dma_xfer_mask >> 18) & 0x01c0))
  116.     DMA(cmd->host)->BANK = bank_mask & (addr >> 18);
  117.     /* start DMA */
  118.     DMA(cmd->host)->ST_DMA = 1;
  119.     /* return success */
  120.     return 0;
  121. }
  122. static void dma_stop (struct Scsi_Host *instance, Scsi_Cmnd *SCpnt,
  123.       int status)
  124. {
  125.     /* stop DMA */
  126.     DMA(instance)->SP_DMA = 1;
  127.     /* remove write bit from CONTROL bits */
  128.     DMA(instance)->CNTR = GVP11_DMAC_INT_ENABLE;
  129.     /* copy from a bounce buffer, if necessary */
  130.     if (status && HDATA(instance)->dma_bounce_buffer) {
  131. if (HDATA(instance)->dma_dir && SCpnt)
  132.     memcpy (SCpnt->SCp.ptr, 
  133.     HDATA(instance)->dma_bounce_buffer,
  134.     SCpnt->SCp.this_residual);
  135. if (HDATA(instance)->dma_buffer_pool == BUF_SCSI_ALLOCED)
  136.     scsi_free (HDATA(instance)->dma_bounce_buffer,
  137.        HDATA(instance)->dma_bounce_len);
  138. else
  139.     amiga_chip_free(HDATA(instance)->dma_bounce_buffer);
  140. HDATA(instance)->dma_bounce_buffer = NULL;
  141. HDATA(instance)->dma_bounce_len = 0;
  142.     }
  143. }
  144. static int num_gvp11 = 0;
  145. #define CHECK_WD33C93
  146. int __init gvp11_detect(Scsi_Host_Template *tpnt)
  147. {
  148.     static unsigned char called = 0;
  149.     struct Scsi_Host *instance;
  150.     unsigned long address;
  151.     unsigned int epc;
  152.     struct zorro_dev *z = NULL;
  153.     unsigned int default_dma_xfer_mask;
  154.     wd33c93_regs regs;
  155. #ifdef CHECK_WD33C93
  156.     volatile unsigned char *sasr_3393, *scmd_3393;
  157.     unsigned char save_sasr;
  158.     unsigned char q, qq;
  159. #endif
  160.     if (!MACH_IS_AMIGA || called)
  161. return 0;
  162.     called = 1;
  163.     tpnt->proc_name = "GVP11";
  164.     tpnt->proc_info = &wd33c93_proc_info;
  165.     while ((z = zorro_find_device(ZORRO_WILDCARD, z))) {
  166. /* 
  167.  * This should (hopefully) be the correct way to identify
  168.  * all the different GVP SCSI controllers (except for the
  169.  * SERIES I though).
  170.  */
  171. if (z->id == ZORRO_PROD_GVP_COMBO_030_R3_SCSI ||
  172.     z->id == ZORRO_PROD_GVP_SERIES_II)
  173.     default_dma_xfer_mask = ~0x00ffffff;
  174. else if (z->id == ZORRO_PROD_GVP_GFORCE_030_SCSI ||
  175.  z->id == ZORRO_PROD_GVP_A530_SCSI ||
  176.  z->id == ZORRO_PROD_GVP_COMBO_030_R4_SCSI)
  177.     default_dma_xfer_mask = ~0x01ffffff;
  178. else if (z->id == ZORRO_PROD_GVP_A1291 ||
  179.  z->id == ZORRO_PROD_GVP_GFORCE_040_SCSI_1)
  180.     default_dma_xfer_mask = ~0x07ffffff;
  181. else
  182.     continue;
  183. /*
  184.  * Rumors state that some GVP ram boards use the same product
  185.  * code as the SCSI controllers. Therefore if the board-size
  186.  * is not 64KB we asume it is a ram board and bail out.
  187.  */
  188. if (z->resource.end-z->resource.start != 0xffff)
  189. continue;
  190. address = z->resource.start;
  191. if (!request_mem_region(address, 256, "wd33c93"))
  192.     continue;
  193. #ifdef CHECK_WD33C93
  194. /*
  195.  * These darn GVP boards are a problem - it can be tough to tell
  196.  * whether or not they include a SCSI controller. This is the
  197.  * ultimate Yet-Another-GVP-Detection-Hack in that it actually
  198.  * probes for a WD33c93 chip: If we find one, it's extremely
  199.  * likely that this card supports SCSI, regardless of Product_
  200.  * Code, Board_Size, etc. 
  201.  */
  202.     /* Get pointers to the presumed register locations and save contents */
  203. sasr_3393 = &(((gvp11_scsiregs *)(ZTWO_VADDR(address)))->SASR);
  204. scmd_3393 = &(((gvp11_scsiregs *)(ZTWO_VADDR(address)))->SCMD);
  205. save_sasr = *sasr_3393;
  206.     /* First test the AuxStatus Reg */
  207. q = *sasr_3393; /* read it */
  208. if (q & 0x08) /* bit 3 should always be clear */
  209. goto release;
  210. *sasr_3393 = WD_AUXILIARY_STATUS;  /* setup indirect address */
  211. if (*sasr_3393 == WD_AUXILIARY_STATUS) { /* shouldn't retain the write */
  212. *sasr_3393 = save_sasr; /* Oops - restore this byte */
  213. goto release;
  214. }
  215. if (*sasr_3393 != q) { /* should still read the same */
  216. *sasr_3393 = save_sasr; /* Oops - restore this byte */
  217. goto release;
  218. }
  219. if (*scmd_3393 != q) /* and so should the image at 0x1f */
  220. goto release;
  221.     /* Ok, we probably have a wd33c93, but let's check a few other places
  222.      * for good measure. Make sure that this works for both 'A and 'B    
  223.      * chip versions.
  224.      */
  225. *sasr_3393 = WD_SCSI_STATUS;
  226. q = *scmd_3393;
  227. *sasr_3393 = WD_SCSI_STATUS;
  228. *scmd_3393 = ~q;
  229. *sasr_3393 = WD_SCSI_STATUS;
  230. qq = *scmd_3393;
  231. *sasr_3393 = WD_SCSI_STATUS;
  232. *scmd_3393 = q;
  233. if (qq != q) /* should be read only */
  234. goto release;
  235. *sasr_3393 = 0x1e; /* this register is unimplemented */
  236. q = *scmd_3393;
  237. *sasr_3393 = 0x1e;
  238. *scmd_3393 = ~q;
  239. *sasr_3393 = 0x1e;
  240. qq = *scmd_3393;
  241. *sasr_3393 = 0x1e;
  242. *scmd_3393 = q;
  243. if (qq != q || qq != 0xff) /* should be read only, all 1's */
  244. goto release;
  245. *sasr_3393 = WD_TIMEOUT_PERIOD;
  246. q = *scmd_3393;
  247. *sasr_3393 = WD_TIMEOUT_PERIOD;
  248. *scmd_3393 = ~q;
  249. *sasr_3393 = WD_TIMEOUT_PERIOD;
  250. qq = *scmd_3393;
  251. *sasr_3393 = WD_TIMEOUT_PERIOD;
  252. *scmd_3393 = q;
  253. if (qq != (~q & 0xff)) /* should be read/write */
  254. goto release;
  255. #endif
  256. instance = scsi_register (tpnt, sizeof (struct WD33C93_hostdata));
  257. if(instance == NULL)
  258. goto release;
  259. instance->base = ZTWO_VADDR(address);
  260. instance->irq = IRQ_AMIGA_PORTS;
  261. instance->unique_id = z->slotaddr;
  262. if (gvp11_xfer_mask)
  263. HDATA(instance)->dma_xfer_mask = gvp11_xfer_mask;
  264. else
  265. HDATA(instance)->dma_xfer_mask = default_dma_xfer_mask;
  266. DMA(instance)->secret2 = 1;
  267. DMA(instance)->secret1 = 0;
  268. DMA(instance)->secret3 = 15;
  269. while (DMA(instance)->CNTR & GVP11_DMAC_BUSY) ;
  270. DMA(instance)->CNTR = 0;
  271. DMA(instance)->BANK = 0;
  272. epc = *(unsigned short *)(ZTWO_VADDR(address) + 0x8000);
  273. /*
  274.  * Check for 14MHz SCSI clock
  275.  */
  276. regs.SASR = &(DMA(instance)->SASR);
  277. regs.SCMD = &(DMA(instance)->SCMD);
  278. wd33c93_init(instance, regs, dma_setup, dma_stop,
  279.      (epc & GVP_SCSICLKMASK) ? WD33C93_FS_8_10
  280.      : WD33C93_FS_12_15);
  281. if (num_gvp11++ == 0) {
  282. first_instance = instance;
  283. gvp11_template = instance->hostt;
  284. request_irq(IRQ_AMIGA_PORTS, gvp11_intr, SA_SHIRQ,
  285.     "GVP11 SCSI", gvp11_intr);
  286. }
  287. DMA(instance)->CNTR = GVP11_DMAC_INT_ENABLE;
  288. continue;
  289. release:
  290. release_mem_region(address, 256);
  291.     }
  292.     return num_gvp11;
  293. }
  294. #define HOSTS_C
  295. #include "gvp11.h"
  296. static Scsi_Host_Template driver_template = GVP11_SCSI;
  297. #include "scsi_module.c"
  298. int gvp11_release(struct Scsi_Host *instance)
  299. {
  300. #ifdef MODULE
  301.     DMA(instance)->CNTR = 0;
  302.     release_mem_region(ZTWO_PADDR(instance->base), 256);
  303.     if (--num_gvp11 == 0)
  304.     free_irq(IRQ_AMIGA_PORTS, gvp11_intr);
  305.     wd33c93_release();
  306. #endif
  307.     return 1;
  308. }
  309. MODULE_LICENSE("GPL");