Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

3 Commits   0 Branches   0 Tags
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2)         kbic.c    (c) 1997-8  Grant R. Guenther <grant@torque.net>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)                               Under the terms of the GNU General Public License.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)         This is a low-level driver for the KBIC-951A and KBIC-971A
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)         parallel to IDE adapter chips from KingByte Information Systems.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8) 	The chips are almost identical, however, the wakeup code 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9) 	required for the 971A interferes with the correct operation of
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10)         the 951A, so this driver registers itself twice, once for
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) 	each chip.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) /* Changes:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17)         1.01    GRG 1998.05.06 init_proto, release_proto
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) #define KBIC_VERSION      "1.01"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) #include <linux/types.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) #include <linux/wait.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) #include <asm/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) #include "paride.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) #define r12w()			(delay_p,inw(pi->port+1)&0xffff) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) #define j44(a,b)                ((((a>>4)&0x0f)|(b&0xf0))^0x88)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) #define j53(w)                  (((w>>3)&0x1f)|((w>>4)&0xe0))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) /* cont = 0 - access the IDE register file 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40)    cont = 1 - access the IDE command set 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) static int  cont_map[2] = { 0x80, 0x40 };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) static int kbic_read_regr( PIA *pi, int cont, int regr )
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) {       int     a, b, s;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49)         s = cont_map[cont];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) 	switch (pi->mode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 	case 0: w0(regr|0x18|s); w2(4); w2(6); w2(4); w2(1); w0(8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 	        a = r1(); w0(0x28); b = r1(); w2(4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 		return j44(a,b);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 	case 1: w0(regr|0x38|s); w2(4); w2(6); w2(4); w2(5); w0(8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 		a = r12w(); w2(4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 		return j53(a);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 	case 2: w0(regr|0x08|s); w2(4); w2(6); w2(4); w2(0xa5); w2(0xa1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 		a = r0(); w2(4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63)        		return a;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 	case 3:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 	case 4:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 	case 5: w0(0x20|s); w2(4); w2(6); w2(4); w3(regr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 		a = r4(); b = r4(); w2(4); w2(0); w2(4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 		return a;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 	return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) }       
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) static void  kbic_write_regr( PIA *pi, int cont, int regr, int val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) {       int  s;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79)         s = cont_map[cont];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81)         switch (pi->mode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 	case 0: 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84)         case 1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 	case 2:	w0(regr|0x10|s); w2(4); w2(6); w2(4); 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 		w0(val); w2(5); w2(4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 	case 3:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 	case 4:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 	case 5: w0(0x20|s); w2(4); w2(6); w2(4); w3(regr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 		w4(val); w4(val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 		w2(4); w2(0); w2(4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94)                 break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) static void k951_connect ( PIA *pi  )
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) { 	pi->saved_r0 = r0();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102)         pi->saved_r2 = r2();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103)         w2(4); 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) static void k951_disconnect ( PIA *pi )
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) {      	w0(pi->saved_r0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109)         w2(pi->saved_r2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) #define	CCP(x)	w2(0xc4);w0(0xaa);w0(0x55);w0(0);w0(0xff);w0(0x87);\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 		w0(0x78);w0(x);w2(0xc5);w2(0xc4);w0(0xff);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) static void k971_connect ( PIA *pi  )
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) { 	pi->saved_r0 = r0();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118)         pi->saved_r2 = r2();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 	CCP(0x20);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120)         w2(4); 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) static void k971_disconnect ( PIA *pi )
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) {       CCP(0x30);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 	w0(pi->saved_r0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127)         w2(pi->saved_r2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) /* counts must be congruent to 0 MOD 4, but all known applications
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131)    have this property.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) static void kbic_read_block( PIA *pi, char * buf, int count )
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) {       int     k, a, b;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138)         switch (pi->mode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140)         case 0: w0(0x98); w2(4); w2(6); w2(4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141)                 for (k=0;k<count/2;k++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 			w2(1); w0(8);    a = r1();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 			       w0(0x28); b = r1();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 			buf[2*k]   = j44(a,b);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 			w2(5);           b = r1();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 			       w0(8);    a = r1();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 			buf[2*k+1] = j44(a,b);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 			w2(4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149)                 } 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150)                 break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152)         case 1: w0(0xb8); w2(4); w2(6); w2(4); 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153)                 for (k=0;k<count/4;k++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154)                         w0(0xb8); 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 			w2(4); w2(5); 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156)                         w0(8);    buf[4*k]   = j53(r12w());
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 			w0(0xb8); buf[4*k+1] = j53(r12w());
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 			w2(4); w2(5);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 			          buf[4*k+3] = j53(r12w());
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 			w0(8);    buf[4*k+2] = j53(r12w());
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161)                 }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162)                 w2(4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163)                 break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165)         case 2: w0(0x88); w2(4); w2(6); w2(4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166)                 for (k=0;k<count/2;k++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167)                         w2(0xa0); w2(0xa1); buf[2*k] = r0();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168)                         w2(0xa5); buf[2*k+1] = r0();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169)                 }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170)                 w2(4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171)                 break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173)         case 3: w0(0xa0); w2(4); w2(6); w2(4); w3(0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174)                 for (k=0;k<count;k++) buf[k] = r4();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175)                 w2(4); w2(0); w2(4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176)                 break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 	case 4: w0(0xa0); w2(4); w2(6); w2(4); w3(0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179)                 for (k=0;k<count/2;k++) ((u16 *)buf)[k] = r4w();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180)                 w2(4); w2(0); w2(4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181)                 break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183)         case 5: w0(0xa0); w2(4); w2(6); w2(4); w3(0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184)                 for (k=0;k<count/4;k++) ((u32 *)buf)[k] = r4l();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185)                 w2(4); w2(0); w2(4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186)                 break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189)         }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) static void kbic_write_block( PIA *pi, char * buf, int count )
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) {       int     k;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196)         switch (pi->mode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198)         case 0:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199)         case 1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200)         case 2: w0(0x90); w2(4); w2(6); w2(4); 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 		for(k=0;k<count/2;k++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 			w0(buf[2*k+1]); w2(0); w2(4); 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 			w0(buf[2*k]);   w2(5); w2(4); 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207)         case 3: w0(0xa0); w2(4); w2(6); w2(4); w3(0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 		for(k=0;k<count/2;k++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 			w4(buf[2*k+1]); 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210)                         w4(buf[2*k]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211)                 }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) 		w2(4); w2(0); w2(4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 	case 4: w0(0xa0); w2(4); w2(6); w2(4); w3(0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216)                 for(k=0;k<count/2;k++) w4w(pi_swab16(buf,k));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217)                 w2(4); w2(0); w2(4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218)                 break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220)         case 5: w0(0xa0); w2(4); w2(6); w2(4); w3(0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221)                 for(k=0;k<count/4;k++) w4l(pi_swab32(buf,k));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222)                 w2(4); w2(0); w2(4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223)                 break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225)         }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) static void kbic_log_adapter( PIA *pi, char * scratch, 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 			      int verbose, char * chip )
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) {       char    *mode_string[6] = {"4-bit","5/3","8-bit",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) 				   "EPP-8","EPP_16","EPP-32"};
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235)         printk("%s: kbic %s, KingByte %s at 0x%x, ",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236)                 pi->device,KBIC_VERSION,chip,pi->port);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237)         printk("mode %d (%s), delay %d\n",pi->mode,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) 		mode_string[pi->mode],pi->delay);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) static void k951_log_adapter( PIA *pi, char * scratch, int verbose )
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) {	kbic_log_adapter(pi,scratch,verbose,"KBIC-951A");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) static void k971_log_adapter( PIA *pi, char * scratch, int verbose )
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) {       kbic_log_adapter(pi,scratch,verbose,"KBIC-971A");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) static struct pi_protocol k951 = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) 	.owner		= THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) 	.name		= "k951",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) 	.max_mode	= 6,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) 	.epp_first	= 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 	.default_delay	= 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) 	.max_units	= 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) 	.write_regr	= kbic_write_regr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) 	.read_regr	= kbic_read_regr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) 	.write_block	= kbic_write_block,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) 	.read_block	= kbic_read_block,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) 	.connect	= k951_connect,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) 	.disconnect	= k951_disconnect,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) 	.log_adapter	= k951_log_adapter,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) static struct pi_protocol k971 = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) 	.owner		= THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) 	.name		= "k971",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 	.max_mode	= 6,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) 	.epp_first	= 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) 	.default_delay	= 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) 	.max_units	= 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) 	.write_regr	= kbic_write_regr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) 	.read_regr	= kbic_read_regr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) 	.write_block	= kbic_write_block,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) 	.read_block	= kbic_read_block,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) 	.connect	= k971_connect,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) 	.disconnect	= k971_disconnect,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) 	.log_adapter	= k971_log_adapter,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) static int __init kbic_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) 	int rv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) 	rv = paride_register(&k951);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) 	if (rv < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) 		return rv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) 	rv = paride_register(&k971);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) 	if (rv < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) 		paride_unregister(&k951);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) 	return rv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) static void __exit kbic_exit(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) 	paride_unregister(&k951);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) 	paride_unregister(&k971);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) module_init(kbic_init)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) module_exit(kbic_exit)