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

Linux/Unix编程

开发平台:

Unix_Linux

  1. /* 
  2.         fit2.c        (c) 1998  Grant R. Guenther <grant@torque.net>
  3.                           Under the terms of the GNU General Public License.
  4. fit2.c is a low-level protocol driver for the older version
  5.         of the Fidelity International Technology parallel port adapter.  
  6. This adapter is used in their TransDisk 2000 and older TransDisk
  7. 3000 portable hard-drives.  As far as I can tell, this device
  8. supports 4-bit mode _only_.  
  9. Newer models of the FIT products use an enhanced protocol.
  10. The "fit3" protocol module should support current drives.
  11. */
  12. #define FIT2_VERSION      "1.0"
  13. #include <linux/module.h>
  14. #include <linux/delay.h>
  15. #include <linux/kernel.h>
  16. #include <linux/types.h>
  17. #include <linux/wait.h>
  18. #include <asm/io.h>
  19. #include "paride.h"
  20. #define j44(a,b)                (((a>>4)&0x0f)|(b&0xf0))
  21. /* cont = 0 - access the IDE register file 
  22.    cont = 1 - access the IDE command set 
  23. NB:  The FIT adapter does not appear to use the control registers.
  24. So, we map ALT_STATUS to STATUS and NO-OP writes to the device
  25. control register - this means that IDE reset will not work on these
  26. devices.
  27. */
  28. static void  fit2_write_regr( PIA *pi, int cont, int regr, int val)
  29. { if (cont == 1) return;
  30. w2(0xc); w0(regr); w2(4); w0(val); w2(5); w0(0); w2(4);
  31. }
  32. static int fit2_read_regr( PIA *pi, int cont, int regr )
  33. { int  a, b, r;
  34. if (cont) {
  35.   if (regr != 6) return 0xff;
  36.   r = 7;
  37. } else r = regr + 0x10;
  38. w2(0xc); w0(r); w2(4); w2(5); 
  39.          w0(0); a = r1();
  40.          w0(1); b = r1();
  41. w2(4);
  42. return j44(a,b);
  43. }
  44. static void fit2_read_block( PIA *pi, char * buf, int count )
  45. { int  k, a, b, c, d;
  46. w2(0xc); w0(0x10);
  47. for (k=0;k<count/4;k++) {
  48. w2(4); w2(5);
  49. w0(0); a = r1(); w0(1); b = r1();
  50. w0(3); c = r1(); w0(2); d = r1(); 
  51. buf[4*k+0] = j44(a,b);
  52. buf[4*k+1] = j44(d,c);
  53.                 w2(4); w2(5);
  54.                        a = r1(); w0(3); b = r1();
  55.                 w0(1); c = r1(); w0(0); d = r1(); 
  56.                 buf[4*k+2] = j44(d,c);
  57.                 buf[4*k+3] = j44(a,b);
  58. }
  59. w2(4);
  60. }
  61. static void fit2_write_block( PIA *pi, char * buf, int count )
  62. { int k;
  63. w2(0xc); w0(0); 
  64. for (k=0;k<count/2;k++) {
  65. w2(4); w0(buf[2*k]); 
  66. w2(5); w0(buf[2*k+1]);
  67. }
  68. w2(4);
  69. }
  70. static void fit2_connect ( PIA *pi  )
  71. {       pi->saved_r0 = r0();
  72.         pi->saved_r2 = r2();
  73. w2(0xcc); 
  74. }
  75. static void fit2_disconnect ( PIA *pi )
  76. {       w0(pi->saved_r0);
  77.         w2(pi->saved_r2);
  78. static void fit2_log_adapter( PIA *pi, char * scratch, int verbose )
  79. {       printk("%s: fit2 %s, FIT 2000 adapter at 0x%x, delay %dn",
  80.                 pi->device,FIT2_VERSION,pi->port,pi->delay);
  81. }
  82. static void fit2_init_proto( PIA *pi)
  83. {       MOD_INC_USE_COUNT;
  84. }
  85. static void fit2_release_proto( PIA *pi)
  86. {       MOD_DEC_USE_COUNT;
  87. }
  88. struct pi_protocol fit2 = {"fit2",0,1,2,1,1,
  89.                            fit2_write_regr,
  90.                            fit2_read_regr,
  91.                            fit2_write_block,
  92.                            fit2_read_block,
  93.                            fit2_connect,
  94.                            fit2_disconnect,
  95.                            0,
  96.                            0,
  97.                            0,
  98.                            fit2_log_adapter,
  99.                            fit2_init_proto,
  100.                            fit2_release_proto
  101.                           };
  102. #ifdef MODULE
  103. int     init_module(void)
  104. {       return pi_register( &fit2 ) - 1;
  105. }
  106. void    cleanup_module(void)
  107. {       pi_unregister( &fit2 );
  108. }
  109. #endif
  110. /* end of fit2.c */
  111. MODULE_LICENSE("GPL");