|  | /* | 
|  | kbic.c    (c) 1997-8  Grant R. Guenther <grant@torque.net> | 
|  | Under the terms of the GNU General Public License. | 
|  |  | 
|  | This is a low-level driver for the KBIC-951A and KBIC-971A | 
|  | parallel to IDE adapter chips from KingByte Information Systems. | 
|  |  | 
|  | The chips are almost identical, however, the wakeup code | 
|  | required for the 971A interferes with the correct operation of | 
|  | the 951A, so this driver registers itself twice, once for | 
|  | each chip. | 
|  |  | 
|  | */ | 
|  |  | 
|  | /* Changes: | 
|  |  | 
|  | 1.01    GRG 1998.05.06 init_proto, release_proto | 
|  |  | 
|  | */ | 
|  |  | 
|  | #define KBIC_VERSION      "1.01" | 
|  |  | 
|  | #include <linux/module.h> | 
|  | #include <linux/init.h> | 
|  | #include <linux/delay.h> | 
|  | #include <linux/kernel.h> | 
|  | #include <linux/types.h> | 
|  | #include <linux/wait.h> | 
|  | #include <asm/io.h> | 
|  |  | 
|  | #include "paride.h" | 
|  |  | 
|  | #define r12w()			(delay_p,inw(pi->port+1)&0xffff) | 
|  |  | 
|  | #define j44(a,b)                ((((a>>4)&0x0f)|(b&0xf0))^0x88) | 
|  | #define j53(w)                  (((w>>3)&0x1f)|((w>>4)&0xe0)) | 
|  |  | 
|  |  | 
|  | /* cont = 0 - access the IDE register file | 
|  | cont = 1 - access the IDE command set | 
|  | */ | 
|  |  | 
|  | static int  cont_map[2] = { 0x80, 0x40 }; | 
|  |  | 
|  | static int kbic_read_regr( PIA *pi, int cont, int regr ) | 
|  |  | 
|  | {       int     a, b, s; | 
|  |  | 
|  | s = cont_map[cont]; | 
|  |  | 
|  | switch (pi->mode) { | 
|  |  | 
|  | case 0: w0(regr|0x18|s); w2(4); w2(6); w2(4); w2(1); w0(8); | 
|  | a = r1(); w0(0x28); b = r1(); w2(4); | 
|  | return j44(a,b); | 
|  |  | 
|  | case 1: w0(regr|0x38|s); w2(4); w2(6); w2(4); w2(5); w0(8); | 
|  | a = r12w(); w2(4); | 
|  | return j53(a); | 
|  |  | 
|  | case 2: w0(regr|0x08|s); w2(4); w2(6); w2(4); w2(0xa5); w2(0xa1); | 
|  | a = r0(); w2(4); | 
|  | return a; | 
|  |  | 
|  | case 3: | 
|  | case 4: | 
|  | case 5: w0(0x20|s); w2(4); w2(6); w2(4); w3(regr); | 
|  | a = r4(); b = r4(); w2(4); w2(0); w2(4); | 
|  | return a; | 
|  |  | 
|  | } | 
|  | return -1; | 
|  | } | 
|  |  | 
|  | static void  kbic_write_regr( PIA *pi, int cont, int regr, int val) | 
|  |  | 
|  | {       int  s; | 
|  |  | 
|  | s = cont_map[cont]; | 
|  |  | 
|  | switch (pi->mode) { | 
|  |  | 
|  | case 0: | 
|  | case 1: | 
|  | case 2:	w0(regr|0x10|s); w2(4); w2(6); w2(4); | 
|  | w0(val); w2(5); w2(4); | 
|  | break; | 
|  |  | 
|  | case 3: | 
|  | case 4: | 
|  | case 5: w0(0x20|s); w2(4); w2(6); w2(4); w3(regr); | 
|  | w4(val); w4(val); | 
|  | w2(4); w2(0); w2(4); | 
|  | break; | 
|  |  | 
|  | } | 
|  | } | 
|  |  | 
|  | static void k951_connect ( PIA *pi  ) | 
|  |  | 
|  | { 	pi->saved_r0 = r0(); | 
|  | pi->saved_r2 = r2(); | 
|  | w2(4); | 
|  | } | 
|  |  | 
|  | static void k951_disconnect ( PIA *pi ) | 
|  |  | 
|  | {      	w0(pi->saved_r0); | 
|  | w2(pi->saved_r2); | 
|  | } | 
|  |  | 
|  | #define	CCP(x)	w2(0xc4);w0(0xaa);w0(0x55);w0(0);w0(0xff);w0(0x87);\ | 
|  | w0(0x78);w0(x);w2(0xc5);w2(0xc4);w0(0xff); | 
|  |  | 
|  | static void k971_connect ( PIA *pi  ) | 
|  |  | 
|  | { 	pi->saved_r0 = r0(); | 
|  | pi->saved_r2 = r2(); | 
|  | CCP(0x20); | 
|  | w2(4); | 
|  | } | 
|  |  | 
|  | static void k971_disconnect ( PIA *pi ) | 
|  |  | 
|  | {       CCP(0x30); | 
|  | w0(pi->saved_r0); | 
|  | w2(pi->saved_r2); | 
|  | } | 
|  |  | 
|  | /* counts must be congruent to 0 MOD 4, but all known applications | 
|  | have this property. | 
|  | */ | 
|  |  | 
|  | static void kbic_read_block( PIA *pi, char * buf, int count ) | 
|  |  | 
|  | {       int     k, a, b; | 
|  |  | 
|  | switch (pi->mode) { | 
|  |  | 
|  | case 0: w0(0x98); w2(4); w2(6); w2(4); | 
|  | for (k=0;k<count/2;k++) { | 
|  | w2(1); w0(8);    a = r1(); | 
|  | w0(0x28); b = r1(); | 
|  | buf[2*k]   = j44(a,b); | 
|  | w2(5);           b = r1(); | 
|  | w0(8);    a = r1(); | 
|  | buf[2*k+1] = j44(a,b); | 
|  | w2(4); | 
|  | } | 
|  | break; | 
|  |  | 
|  | case 1: w0(0xb8); w2(4); w2(6); w2(4); | 
|  | for (k=0;k<count/4;k++) { | 
|  | w0(0xb8); | 
|  | w2(4); w2(5); | 
|  | w0(8);    buf[4*k]   = j53(r12w()); | 
|  | w0(0xb8); buf[4*k+1] = j53(r12w()); | 
|  | w2(4); w2(5); | 
|  | buf[4*k+3] = j53(r12w()); | 
|  | w0(8);    buf[4*k+2] = j53(r12w()); | 
|  | } | 
|  | w2(4); | 
|  | break; | 
|  |  | 
|  | case 2: w0(0x88); w2(4); w2(6); w2(4); | 
|  | for (k=0;k<count/2;k++) { | 
|  | w2(0xa0); w2(0xa1); buf[2*k] = r0(); | 
|  | w2(0xa5); buf[2*k+1] = r0(); | 
|  | } | 
|  | w2(4); | 
|  | break; | 
|  |  | 
|  | case 3: w0(0xa0); w2(4); w2(6); w2(4); w3(0); | 
|  | for (k=0;k<count;k++) buf[k] = r4(); | 
|  | w2(4); w2(0); w2(4); | 
|  | break; | 
|  |  | 
|  | case 4: w0(0xa0); w2(4); w2(6); w2(4); w3(0); | 
|  | for (k=0;k<count/2;k++) ((u16 *)buf)[k] = r4w(); | 
|  | w2(4); w2(0); w2(4); | 
|  | break; | 
|  |  | 
|  | case 5: w0(0xa0); w2(4); w2(6); w2(4); w3(0); | 
|  | for (k=0;k<count/4;k++) ((u32 *)buf)[k] = r4l(); | 
|  | w2(4); w2(0); w2(4); | 
|  | break; | 
|  |  | 
|  |  | 
|  | } | 
|  | } | 
|  |  | 
|  | static void kbic_write_block( PIA *pi, char * buf, int count ) | 
|  |  | 
|  | {       int     k; | 
|  |  | 
|  | switch (pi->mode) { | 
|  |  | 
|  | case 0: | 
|  | case 1: | 
|  | case 2: w0(0x90); w2(4); w2(6); w2(4); | 
|  | for(k=0;k<count/2;k++) { | 
|  | w0(buf[2*k+1]); w2(0); w2(4); | 
|  | w0(buf[2*k]);   w2(5); w2(4); | 
|  | } | 
|  | break; | 
|  |  | 
|  | case 3: w0(0xa0); w2(4); w2(6); w2(4); w3(0); | 
|  | for(k=0;k<count/2;k++) { | 
|  | w4(buf[2*k+1]); | 
|  | w4(buf[2*k]); | 
|  | } | 
|  | w2(4); w2(0); w2(4); | 
|  | break; | 
|  |  | 
|  | case 4: w0(0xa0); w2(4); w2(6); w2(4); w3(0); | 
|  | for(k=0;k<count/2;k++) w4w(pi_swab16(buf,k)); | 
|  | w2(4); w2(0); w2(4); | 
|  | break; | 
|  |  | 
|  | case 5: w0(0xa0); w2(4); w2(6); w2(4); w3(0); | 
|  | for(k=0;k<count/4;k++) w4l(pi_swab32(buf,k)); | 
|  | w2(4); w2(0); w2(4); | 
|  | break; | 
|  |  | 
|  | } | 
|  |  | 
|  | } | 
|  |  | 
|  | static void kbic_log_adapter( PIA *pi, char * scratch, | 
|  | int verbose, char * chip ) | 
|  |  | 
|  | {       char    *mode_string[6] = {"4-bit","5/3","8-bit", | 
|  | "EPP-8","EPP_16","EPP-32"}; | 
|  |  | 
|  | printk("%s: kbic %s, KingByte %s at 0x%x, ", | 
|  | pi->device,KBIC_VERSION,chip,pi->port); | 
|  | printk("mode %d (%s), delay %d\n",pi->mode, | 
|  | mode_string[pi->mode],pi->delay); | 
|  |  | 
|  | } | 
|  |  | 
|  | static void k951_log_adapter( PIA *pi, char * scratch, int verbose ) | 
|  |  | 
|  | {	kbic_log_adapter(pi,scratch,verbose,"KBIC-951A"); | 
|  | } | 
|  |  | 
|  | static void k971_log_adapter( PIA *pi, char * scratch, int verbose ) | 
|  |  | 
|  | {       kbic_log_adapter(pi,scratch,verbose,"KBIC-971A"); | 
|  | } | 
|  |  | 
|  | static struct pi_protocol k951 = { | 
|  | .owner		= THIS_MODULE, | 
|  | .name		= "k951", | 
|  | .max_mode	= 6, | 
|  | .epp_first	= 3, | 
|  | .default_delay	= 1, | 
|  | .max_units	= 1, | 
|  | .write_regr	= kbic_write_regr, | 
|  | .read_regr	= kbic_read_regr, | 
|  | .write_block	= kbic_write_block, | 
|  | .read_block	= kbic_read_block, | 
|  | .connect	= k951_connect, | 
|  | .disconnect	= k951_disconnect, | 
|  | .log_adapter	= k951_log_adapter, | 
|  | }; | 
|  |  | 
|  | static struct pi_protocol k971 = { | 
|  | .owner		= THIS_MODULE, | 
|  | .name		= "k971", | 
|  | .max_mode	= 6, | 
|  | .epp_first	= 3, | 
|  | .default_delay	= 1, | 
|  | .max_units	= 1, | 
|  | .write_regr	= kbic_write_regr, | 
|  | .read_regr	= kbic_read_regr, | 
|  | .write_block	= kbic_write_block, | 
|  | .read_block	= kbic_read_block, | 
|  | .connect	= k971_connect, | 
|  | .disconnect	= k971_disconnect, | 
|  | .log_adapter	= k971_log_adapter, | 
|  | }; | 
|  |  | 
|  | static int __init kbic_init(void) | 
|  | { | 
|  | int rv; | 
|  |  | 
|  | rv = paride_register(&k951); | 
|  | if (rv < 0) | 
|  | return rv; | 
|  | rv = paride_register(&k971); | 
|  | if (rv < 0) | 
|  | paride_unregister(&k951); | 
|  | return rv; | 
|  | } | 
|  |  | 
|  | static void __exit kbic_exit(void) | 
|  | { | 
|  | paride_unregister(&k951); | 
|  | paride_unregister(&k971); | 
|  | } | 
|  |  | 
|  | MODULE_LICENSE("GPL"); | 
|  | module_init(kbic_init) | 
|  | module_exit(kbic_exit) |