/* 	bpck.c	(c) 1996-8  Grant R. Guenther <grant@torque.net>		            Under the terms of the GNU General Public License.	bpck.c is a low-level protocol driver for the MicroSolutions 	"backpack" parallel port IDE adapter.  *//* Changes:	1.01	GRG 1998.05.05 init_proto, release_proto, pi->delay 	1.02    GRG 1998.08.15 default pi->delay returned to 4*/#define	BPCK_VERSION	"1.02" #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"#undef r2#undef w2#define PC			pi->private#define r2()			(PC=(in_p(2) & 0xff))#define w2(byte)  		{out_p(2,byte); PC = byte;}#define t2(pat)   		{PC ^= pat; out_p(2,PC);}#define e2()			{PC &= 0xfe; out_p(2,PC);}#define o2()			{PC |= 1; out_p(2,PC);}#define j44(l,h)     (((l>>3)&0x7)|((l>>4)&0x8)|((h<<1)&0x70)|(h&0x80))/* cont = 0 - access the IDE register file    cont = 1 - access the IDE command set    cont = 2 - use internal bpck register addressing*/static int  cont_map[3] = { 0x40, 0x48, 0 };static int bpck_read_regr( PIA *pi, int cont, int regr ){       int r, l, h;	r = regr + cont_map[cont];	switch (pi->mode) {	case 0: w0(r & 0xf); w0(r); t2(2); t2(4);	        l = r1();        	t2(4);        	h = r1();        	return j44(l,h);	case 1: w0(r & 0xf); w0(r); t2(2);	        e2(); t2(0x20);		t2(4); h = r0();	        t2(1); t2(0x20);	        return h;	case 2:	case 3:	case 4: w0(r); w2(9); w2(0); w2(0x20);		h = r4();		w2(0);		return h;	}	return -1;}	static void bpck_write_regr( PIA *pi, int cont, int regr, int val ){	int	r;        r = regr + cont_map[cont];	switch (pi->mode) {	case 0:	case 1: w0(r);		t2(2);		w0(val);		o2(); t2(4); t2(1);		break;	case 2:	case 3:	case 4: w0(r); w2(9); w2(0);		w0(val); w2(1); w2(3); w2(0);		break;	}}/* These macros access the bpck registers in native addressing */#define WR(r,v)		bpck_write_regr(pi,2,r,v)#define RR(r)		(bpck_read_regr(pi,2,r))static void bpck_write_block( PIA *pi, char * buf, int count ){	int i;	switch (pi->mode) {	case 0: WR(4,0x40);		w0(0x40); t2(2); t2(1);		for (i=0;i<count;i++) { w0(buf[i]); t2(4); }		WR(4,0);		break;	case 1: WR(4,0x50);                w0(0x40); t2(2); t2(1);                for (i=0;i<count;i++) { w0(buf[i]); t2(4); }                WR(4,0x10);		break;	case 2: WR(4,0x48);		w0(0x40); w2(9); w2(0); w2(1);		for (i=0;i<count;i++) w4(buf[i]);		w2(0);		WR(4,8);		break;        case 3: WR(4,0x48);                w0(0x40); w2(9); w2(0); w2(1);                for (i=0;i<count/2;i++) w4w(((u16 *)buf)[i]);                w2(0);                WR(4,8);                break;         case 4: WR(4,0x48);                w0(0x40); w2(9); w2(0); w2(1);                for (i=0;i<count/4;i++) w4l(((u32 *)buf)[i]);                w2(0);                WR(4,8);                break; 	}}static void bpck_read_block( PIA *pi, char * buf, int count ){	int i, l, h;	switch (pi->mode) {      	case 0: WR(4,0x40);		w0(0x40); t2(2);		for (i=0;i<count;i++) {		    t2(4); l = r1();		    t2(4); h = r1();		    buf[i] = j44(l,h);		}		WR(4,0);		break;	case 1: WR(4,0x50);		w0(0x40); t2(2); t2(0x20);      	        for(i=0;i<count;i++) { t2(4); buf[i] = r0(); }	        t2(1); t2(0x20);	        WR(4,0x10);		break;	case 2: WR(4,0x48);		w0(0x40); w2(9); w2(0); w2(0x20);		for (i=0;i<count;i++) buf[i] = r4();		w2(0);		WR(4,8);		break;        case 3: WR(4,0x48);                w0(0x40); w2(9); w2(0); w2(0x20);                for (i=0;i<count/2;i++) ((u16 *)buf)[i] = r4w();                w2(0);                WR(4,8);                break;        case 4: WR(4,0x48);                w0(0x40); w2(9); w2(0); w2(0x20);                for (i=0;i<count/4;i++) ((u32 *)buf)[i] = r4l();                w2(0);                WR(4,8);                break;	}}static int bpck_probe_unit ( PIA *pi ){	int o1, o0, f7, id;	int t, s;	id = pi->unit;	s = 0;	w2(4); w2(0xe); r2(); t2(2); 	o1 = r1()&0xf8;	o0 = r0();	w0(255-id); w2(4); w0(id);	t2(8); t2(8); t2(8);	t2(2); t = r1()&0xf8;	f7 = ((id % 8) == 7);	if ((f7) || (t != o1)) { t2(2); s = r1()&0xf8; }	if ((t == o1) && ((!f7) || (s == o1)))  {		w2(0x4c); w0(o0);		return 0;		}	t2(8); w0(0); t2(2); w2(0x4c); w0(o0);	return 1;}	static void bpck_connect ( PIA *pi  ){       pi->saved_r0 = r0();	w0(0xff-pi->unit); w2(4); w0(pi->unit);	t2(8); t2(8); t2(8); 	t2(2); t2(2);		switch (pi->mode) {	case 0: t2(8); WR(4,0);		break;	case 1: t2(8); WR(4,0x10);		break;	case 2:        case 3:	case 4: w2(0); WR(4,8);		break;	}	WR(5,8);	if (pi->devtype == PI_PCD) {		WR(0x46,0x10);		/* fiddle with ESS logic ??? */		WR(0x4c,0x38);		WR(0x4d,0x88);		WR(0x46,0xa0);		WR(0x41,0);		WR(0x4e,8);		}}static void bpck_disconnect ( PIA *pi ){	w0(0); 	if (pi->mode >= 2) { w2(9); w2(0); } else t2(2);	w2(0x4c); w0(pi->saved_r0);} static void bpck_force_spp ( PIA *pi )/* This fakes the EPP protocol to turn off EPP ... */{       pi->saved_r0 = r0();        w0(0xff-pi->unit); w2(4); w0(pi->unit);        t2(8); t2(8); t2(8);         t2(2); t2(2);        w2(0);         w0(4); w2(9); w2(0);         w0(0); w2(1); w2(3); w2(0);             w0(0); w2(9); w2(0);        w2(0x4c); w0(pi->saved_r0);}#define TEST_LEN  16static int bpck_test_proto( PIA *pi, char * scratch, int verbose ){	int i, e, l, h, om;	char buf[TEST_LEN];	bpck_force_spp(pi);	switch (pi->mode) {	case 0: bpck_connect(pi);		WR(0x13,0x7f);		w0(0x13); t2(2);		for(i=0;i<TEST_LEN;i++) {                    t2(4); l = r1();                    t2(4); h = r1();                    buf[i] = j44(l,h);		}		bpck_disconnect(pi);		break;        case 1: bpck_connect(pi);		WR(0x13,0x7f);                w0(0x13); t2(2); t2(0x20);                for(i=0;i<TEST_LEN;i++) { t2(4); buf[i] = r0(); }                t2(1); t2(0x20);		bpck_disconnect(pi);		break;	case 2:	case 3:	case 4: om = pi->mode;		pi->mode = 0;		bpck_connect(pi);		WR(7,3);		WR(4,8);		bpck_disconnect(pi);		pi->mode = om;		bpck_connect(pi);		w0(0x13); w2(9); w2(1); w0(0); w2(3); w2(0); w2(0xe0);		switch (pi->mode) {		  case 2: for (i=0;i<TEST_LEN;i++) buf[i] = r4();			  break;		  case 3: for (i=0;i<TEST_LEN/2;i++) ((u16 *)buf)[i] = r4w();                          break;		  case 4: for (i=0;i<TEST_LEN/4;i++) ((u32 *)buf)[i] = r4l();                          break;		}		w2(0);		WR(7,0);		bpck_disconnect(pi);		break;	}	if (verbose) {	    printk("%s: bpck: 0x%x unit %d mode %d: ",		   pi->device,pi->port,pi->unit,pi->mode);	    for (i=0;i<TEST_LEN;i++) printk("%3d",buf[i]);	    printk("\n");	}	e = 0;	for (i=0;i<TEST_LEN;i++) if (buf[i] != (i+1)) e++;	return e;}static void bpck_read_eeprom ( PIA *pi, char * buf ){       int i,j,k,n,p,v,f, om, od;	bpck_force_spp(pi);	om = pi->mode;  od = pi->delay;	pi->mode = 0; pi->delay = 6;	bpck_connect(pi);		n = 0;	WR(4,0);	for (i=0;i<64;i++) {	    WR(6,8);  	    WR(6,0xc);	    p = 0x100;	    for (k=0;k<9;k++) {		f = (((i + 0x180) & p) != 0) * 2;		WR(6,f+0xc); 		WR(6,f+0xd); 		WR(6,f+0xc);		p = (p >> 1);	    }	    for (j=0;j<2;j++) {		v = 0;		for (k=0;k<8;k++) {		    WR(6,0xc); 		    WR(6,0xd); 		    WR(6,0xc); 		    f = RR(0);		    v = 2*v + (f == 0x84);		}		buf[2*i+1-j] = v;	    }	}	WR(6,8);	WR(6,0);	WR(5,8);	bpck_disconnect(pi);        if (om >= 2) {                bpck_connect(pi);                WR(7,3);                WR(4,8);                bpck_disconnect(pi);        }	pi->mode = om; pi->delay = od;}static int bpck_test_port ( PIA *pi ) 	/* check for 8-bit port */{	int	i, r, m;	w2(0x2c); i = r0(); w0(255-i); r = r0(); w0(i);	m = -1;	if (r == i) m = 2;	if (r == (255-i)) m = 0;	w2(0xc); i = r0(); w0(255-i); r = r0(); w0(i);	if (r != (255-i)) m = -1;		if (m == 0) { w2(6); w2(0xc); r = r0(); w0(0xaa); w0(r); w0(0xaa); }	if (m == 2) { w2(0x26); w2(0xc); }	if (m == -1) return 0;	return 5;}static void bpck_log_adapter( PIA *pi, char * scratch, int verbose ){	char	*mode_string[5] = { "4-bit","8-bit","EPP-8",				    "EPP-16","EPP-32" };#ifdef DUMP_EEPROM	int i;#endif	bpck_read_eeprom(pi,scratch);#ifdef DUMP_EEPROM	if (verbose) {	   for(i=0;i<128;i++)		if ((scratch[i] < ' ') || (scratch[i] > '~'))		    scratch[i] = '.';	   printk("%s: bpck EEPROM: %64.64s\n",pi->device,scratch);	   printk("%s:              %64.64s\n",pi->device,&scratch[64]);	}#endif	printk("%s: bpck %s, backpack %8.8s unit %d",		pi->device,BPCK_VERSION,&scratch[110],pi->unit);	printk(" at 0x%x, mode %d (%s), delay %d\n",pi->port,		pi->mode,mode_string[pi->mode],pi->delay);}static struct pi_protocol bpck = {	.owner		= THIS_MODULE,	.name		= "bpck",	.max_mode	= 5,	.epp_first	= 2,	.default_delay	= 4,	.max_units	= 255,	.write_regr	= bpck_write_regr,	.read_regr	= bpck_read_regr,	.write_block	= bpck_write_block,	.read_block	= bpck_read_block,	.connect	= bpck_connect,	.disconnect	= bpck_disconnect,	.test_port	= bpck_test_port,	.probe_unit	= bpck_probe_unit,	.test_proto	= bpck_test_proto,	.log_adapter	= bpck_log_adapter,};static int __init bpck_init(void){	return pi_register(&bpck)-1;}static void __exit bpck_exit(void){	pi_unregister(&bpck);}MODULE_LICENSE("GPL");module_init(bpck_init)module_exit(bpck_exit)